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-2025 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 <linux/if_vlan.h> 24 #include <net/net_namespace.h> 25 #include <net/genetlink.h> 26 #include <net/cfg80211.h> 27 #include <net/sock.h> 28 #include <net/inet_connection_sock.h> 29 #include "core.h" 30 #include "nl80211.h" 31 #include "reg.h" 32 #include "rdev-ops.h" 33 34 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 35 struct genl_info *info, 36 struct cfg80211_crypto_settings *settings, 37 int cipher_limit); 38 39 /* the netlink family */ 40 static struct genl_family nl80211_fam; 41 42 /* multicast groups */ 43 enum nl80211_multicast_groups { 44 NL80211_MCGRP_CONFIG, 45 NL80211_MCGRP_SCAN, 46 NL80211_MCGRP_REGULATORY, 47 NL80211_MCGRP_MLME, 48 NL80211_MCGRP_VENDOR, 49 NL80211_MCGRP_NAN, 50 NL80211_MCGRP_TESTMODE /* keep last - ifdef! */ 51 }; 52 53 static const struct genl_multicast_group nl80211_mcgrps[] = { 54 [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG }, 55 [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN }, 56 [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG }, 57 [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME }, 58 [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR }, 59 [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN }, 60 #ifdef CONFIG_NL80211_TESTMODE 61 [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE } 62 #endif 63 }; 64 65 /* returns ERR_PTR values */ 66 static struct wireless_dev * 67 __cfg80211_wdev_from_attrs(struct cfg80211_registered_device *rdev, 68 struct net *netns, struct nlattr **attrs) 69 { 70 struct wireless_dev *result = NULL; 71 bool have_ifidx = attrs[NL80211_ATTR_IFINDEX]; 72 bool have_wdev_id = attrs[NL80211_ATTR_WDEV]; 73 u64 wdev_id = 0; 74 int wiphy_idx = -1; 75 int ifidx = -1; 76 77 if (!have_ifidx && !have_wdev_id) 78 return ERR_PTR(-EINVAL); 79 80 if (have_ifidx) 81 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]); 82 if (have_wdev_id) { 83 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]); 84 wiphy_idx = wdev_id >> 32; 85 } 86 87 if (rdev) { 88 struct wireless_dev *wdev; 89 90 lockdep_assert_held(&rdev->wiphy.mtx); 91 92 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 93 if (have_ifidx && wdev->netdev && 94 wdev->netdev->ifindex == ifidx) { 95 result = wdev; 96 break; 97 } 98 if (have_wdev_id && wdev->identifier == (u32)wdev_id) { 99 result = wdev; 100 break; 101 } 102 } 103 104 return result ?: ERR_PTR(-ENODEV); 105 } 106 107 ASSERT_RTNL(); 108 109 for_each_rdev(rdev) { 110 struct wireless_dev *wdev; 111 112 if (wiphy_net(&rdev->wiphy) != netns) 113 continue; 114 115 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx) 116 continue; 117 118 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 119 if (have_ifidx && wdev->netdev && 120 wdev->netdev->ifindex == ifidx) { 121 result = wdev; 122 break; 123 } 124 if (have_wdev_id && wdev->identifier == (u32)wdev_id) { 125 result = wdev; 126 break; 127 } 128 } 129 130 if (result) 131 break; 132 } 133 134 if (result) 135 return result; 136 return ERR_PTR(-ENODEV); 137 } 138 139 static struct cfg80211_registered_device * 140 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs) 141 { 142 struct cfg80211_registered_device *rdev = NULL, *tmp; 143 struct net_device *netdev; 144 145 ASSERT_RTNL(); 146 147 if (!attrs[NL80211_ATTR_WIPHY] && 148 !attrs[NL80211_ATTR_IFINDEX] && 149 !attrs[NL80211_ATTR_WDEV]) 150 return ERR_PTR(-EINVAL); 151 152 if (attrs[NL80211_ATTR_WIPHY]) 153 rdev = cfg80211_rdev_by_wiphy_idx( 154 nla_get_u32(attrs[NL80211_ATTR_WIPHY])); 155 156 if (attrs[NL80211_ATTR_WDEV]) { 157 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]); 158 struct wireless_dev *wdev; 159 bool found = false; 160 161 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32); 162 if (tmp) { 163 /* make sure wdev exists */ 164 list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) { 165 if (wdev->identifier != (u32)wdev_id) 166 continue; 167 found = true; 168 break; 169 } 170 171 if (!found) 172 tmp = NULL; 173 174 if (rdev && tmp != rdev) 175 return ERR_PTR(-EINVAL); 176 rdev = tmp; 177 } 178 } 179 180 if (attrs[NL80211_ATTR_IFINDEX]) { 181 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]); 182 183 netdev = __dev_get_by_index(netns, ifindex); 184 if (netdev) { 185 if (netdev->ieee80211_ptr) 186 tmp = wiphy_to_rdev( 187 netdev->ieee80211_ptr->wiphy); 188 else 189 tmp = NULL; 190 191 /* not wireless device -- return error */ 192 if (!tmp) 193 return ERR_PTR(-EINVAL); 194 195 /* mismatch -- return error */ 196 if (rdev && tmp != rdev) 197 return ERR_PTR(-EINVAL); 198 199 rdev = tmp; 200 } 201 } 202 203 if (!rdev) 204 return ERR_PTR(-ENODEV); 205 206 if (netns != wiphy_net(&rdev->wiphy)) 207 return ERR_PTR(-ENODEV); 208 209 return rdev; 210 } 211 212 /* 213 * This function returns a pointer to the driver 214 * that the genl_info item that is passed refers to. 215 * 216 * The result of this can be a PTR_ERR and hence must 217 * be checked with IS_ERR() for errors. 218 */ 219 static struct cfg80211_registered_device * 220 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info) 221 { 222 return __cfg80211_rdev_from_attrs(netns, info->attrs); 223 } 224 225 static int validate_beacon_head(const struct nlattr *attr, 226 struct netlink_ext_ack *extack) 227 { 228 const u8 *data = nla_data(attr); 229 unsigned int len = nla_len(attr); 230 const struct element *elem; 231 const struct ieee80211_mgmt *mgmt = (void *)data; 232 const struct ieee80211_ext *ext; 233 unsigned int fixedlen, hdrlen; 234 bool s1g_bcn; 235 236 if (len < offsetofend(typeof(*mgmt), frame_control)) 237 goto err; 238 239 s1g_bcn = ieee80211_is_s1g_beacon(mgmt->frame_control); 240 if (s1g_bcn) { 241 ext = (struct ieee80211_ext *)mgmt; 242 fixedlen = 243 offsetof(struct ieee80211_ext, u.s1g_beacon.variable) + 244 ieee80211_s1g_optional_len(ext->frame_control); 245 hdrlen = offsetof(struct ieee80211_ext, u.s1g_beacon); 246 } else { 247 fixedlen = offsetof(struct ieee80211_mgmt, 248 u.beacon.variable); 249 hdrlen = offsetof(struct ieee80211_mgmt, u.beacon); 250 } 251 252 if (len < fixedlen) 253 goto err; 254 255 if (ieee80211_hdrlen(mgmt->frame_control) != hdrlen) 256 goto err; 257 258 data += fixedlen; 259 len -= fixedlen; 260 261 for_each_element(elem, data, len) { 262 /* nothing */ 263 } 264 265 if (for_each_element_completed(elem, data, len)) 266 return 0; 267 268 err: 269 NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head"); 270 return -EINVAL; 271 } 272 273 static int validate_ie_attr(const struct nlattr *attr, 274 struct netlink_ext_ack *extack) 275 { 276 const u8 *data = nla_data(attr); 277 unsigned int len = nla_len(attr); 278 const struct element *elem; 279 280 for_each_element(elem, data, len) { 281 /* nothing */ 282 } 283 284 if (for_each_element_completed(elem, data, len)) 285 return 0; 286 287 NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements"); 288 return -EINVAL; 289 } 290 291 static int validate_he_capa(const struct nlattr *attr, 292 struct netlink_ext_ack *extack) 293 { 294 if (!ieee80211_he_capa_size_ok(nla_data(attr), nla_len(attr))) 295 return -EINVAL; 296 297 return 0; 298 } 299 300 static int validate_supported_selectors(const struct nlattr *attr, 301 struct netlink_ext_ack *extack) 302 { 303 const u8 *supported_selectors = nla_data(attr); 304 u8 supported_selectors_len = nla_len(attr); 305 306 /* The top bit must not be set as it is not part of the selector */ 307 for (int i = 0; i < supported_selectors_len; i++) { 308 if (supported_selectors[i] & 0x80) 309 return -EINVAL; 310 } 311 312 return 0; 313 } 314 315 static int validate_nan_cluster_id(const struct nlattr *attr, 316 struct netlink_ext_ack *extack) 317 { 318 const u8 *data = nla_data(attr); 319 unsigned int len = nla_len(attr); 320 static const u8 cluster_id_prefix[4] = {0x50, 0x6f, 0x9a, 0x1}; 321 322 if (len != ETH_ALEN) { 323 NL_SET_ERR_MSG_ATTR(extack, attr, "bad cluster id length"); 324 return -EINVAL; 325 } 326 327 if (memcmp(data, cluster_id_prefix, sizeof(cluster_id_prefix))) { 328 NL_SET_ERR_MSG_ATTR(extack, attr, "invalid cluster id prefix"); 329 return -EINVAL; 330 } 331 332 return 0; 333 } 334 335 /* policy for the attributes */ 336 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR]; 337 338 static const struct nla_policy 339 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = { 340 [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, }, 341 [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY, 342 .len = U8_MAX }, 343 [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY, 344 .len = U8_MAX }, 345 }; 346 347 static const struct nla_policy 348 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = { 349 [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG }, 350 [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 }, 351 [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] = 352 NLA_POLICY_MAX(NLA_U8, 15), 353 [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 }, 354 [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] = 355 NLA_POLICY_MAX(NLA_U8, 15), 356 [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] = { .type = NLA_U8 }, 357 [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 }, 358 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG }, 359 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG }, 360 [NL80211_PMSR_FTM_REQ_ATTR_TRIGGER_BASED] = { .type = NLA_FLAG }, 361 [NL80211_PMSR_FTM_REQ_ATTR_NON_TRIGGER_BASED] = { .type = NLA_FLAG }, 362 [NL80211_PMSR_FTM_REQ_ATTR_LMR_FEEDBACK] = { .type = NLA_FLAG }, 363 [NL80211_PMSR_FTM_REQ_ATTR_BSS_COLOR] = { .type = NLA_U8 }, 364 }; 365 366 static const struct nla_policy 367 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = { 368 [NL80211_PMSR_TYPE_FTM] = 369 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy), 370 }; 371 372 static const struct nla_policy 373 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = { 374 [NL80211_PMSR_REQ_ATTR_DATA] = 375 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy), 376 [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG }, 377 }; 378 379 static const struct nla_policy 380 nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = { 381 [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR, 382 [NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy), 383 [NL80211_PMSR_PEER_ATTR_REQ] = 384 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy), 385 [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT }, 386 }; 387 388 static const struct nla_policy 389 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = { 390 [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT }, 391 [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT }, 392 [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT }, 393 [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT }, 394 [NL80211_PMSR_ATTR_PEERS] = 395 NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy), 396 }; 397 398 static const struct nla_policy 399 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = { 400 [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] = 401 NLA_POLICY_RANGE(NLA_U8, 1, 20), 402 [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] = 403 NLA_POLICY_RANGE(NLA_U8, 1, 20), 404 [NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] = 405 NLA_POLICY_RANGE(NLA_U8, 1, 20), 406 [NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] = 407 NLA_POLICY_EXACT_LEN(8), 408 [NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] = 409 NLA_POLICY_EXACT_LEN(8), 410 [NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 }, 411 }; 412 413 static const struct nla_policy 414 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = { 415 [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63), 416 [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG }, 417 [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG }, 418 }; 419 420 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = { 421 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY, 422 .len = NL80211_MAX_SUPP_RATES }, 423 [NL80211_TXRATE_HT] = { .type = NLA_BINARY, 424 .len = NL80211_MAX_SUPP_HT_RATES }, 425 [NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)), 426 [NL80211_TXRATE_GI] = { .type = NLA_U8 }, 427 [NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)), 428 [NL80211_TXRATE_HE_GI] = NLA_POLICY_RANGE(NLA_U8, 429 NL80211_RATE_INFO_HE_GI_0_8, 430 NL80211_RATE_INFO_HE_GI_3_2), 431 [NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8, 432 NL80211_RATE_INFO_HE_1XLTF, 433 NL80211_RATE_INFO_HE_4XLTF), 434 [NL80211_TXRATE_EHT] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_eht)), 435 [NL80211_TXRATE_EHT_GI] = NLA_POLICY_RANGE(NLA_U8, 436 NL80211_RATE_INFO_EHT_GI_0_8, 437 NL80211_RATE_INFO_EHT_GI_3_2), 438 [NL80211_TXRATE_EHT_LTF] = NLA_POLICY_RANGE(NLA_U8, 439 NL80211_RATE_INFO_EHT_1XLTF, 440 NL80211_RATE_INFO_EHT_8XLTF), 441 442 }; 443 444 static const struct nla_policy 445 nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = { 446 [NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 }, 447 [NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 }, 448 [NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG }, 449 [NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff), 450 [NL80211_TID_CONFIG_ATTR_NOACK] = 451 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 452 [NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 453 [NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 454 [NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] = 455 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 456 [NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] = 457 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 458 [NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] = 459 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 460 [NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] = 461 NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED), 462 [NL80211_TID_CONFIG_ATTR_TX_RATE] = 463 NLA_POLICY_NESTED(nl80211_txattr_policy), 464 }; 465 466 static const struct nla_policy 467 nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = { 468 [NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000), 469 [NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000), 470 [NL80211_FILS_DISCOVERY_ATTR_TMPL] = 471 NLA_POLICY_RANGE(NLA_BINARY, 472 NL80211_FILS_DISCOVERY_TMPL_MIN_LEN, 473 IEEE80211_MAX_DATA_LEN), 474 }; 475 476 static const struct nla_policy 477 nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = { 478 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20), 479 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY, 480 .len = IEEE80211_MAX_DATA_LEN } 481 }; 482 483 static const struct nla_policy 484 sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = { 485 [NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 }, 486 [NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 }, 487 }; 488 489 static const struct nla_policy 490 sar_policy[NL80211_SAR_ATTR_MAX + 1] = { 491 [NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE), 492 [NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy), 493 }; 494 495 static const struct nla_policy 496 nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = { 497 [NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2), 498 [NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] = 499 NLA_POLICY_MIN(NLA_U8, 1), 500 [NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 }, 501 [NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 }, 502 [NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG }, 503 [NL80211_MBSSID_CONFIG_ATTR_TX_LINK_ID] = 504 NLA_POLICY_MAX(NLA_U8, IEEE80211_MLD_MAX_NUM_LINKS), 505 }; 506 507 static const struct nla_policy 508 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = { 509 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 }, 510 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 }, 511 }; 512 513 static const struct nla_policy 514 nl80211_s1g_short_beacon[NL80211_S1G_SHORT_BEACON_ATTR_MAX + 1] = { 515 [NL80211_S1G_SHORT_BEACON_ATTR_HEAD] = 516 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 517 IEEE80211_MAX_DATA_LEN), 518 [NL80211_S1G_SHORT_BEACON_ATTR_TAIL] = 519 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 520 IEEE80211_MAX_DATA_LEN), 521 }; 522 523 static const struct nla_policy 524 nl80211_nan_band_conf_policy[NL80211_NAN_BAND_CONF_ATTR_MAX + 1] = { 525 [NL80211_NAN_BAND_CONF_BAND] = NLA_POLICY_MAX(NLA_U8, 526 NUM_NL80211_BANDS - 1), 527 [NL80211_NAN_BAND_CONF_FREQ] = { .type = NLA_U16 }, 528 [NL80211_NAN_BAND_CONF_RSSI_CLOSE] = NLA_POLICY_MIN(NLA_S8, -59), 529 [NL80211_NAN_BAND_CONF_RSSI_MIDDLE] = NLA_POLICY_MIN(NLA_S8, -74), 530 [NL80211_NAN_BAND_CONF_WAKE_DW] = NLA_POLICY_MAX(NLA_U8, 5), 531 [NL80211_NAN_BAND_CONF_DISABLE_SCAN] = { .type = NLA_FLAG }, 532 }; 533 534 static const struct nla_policy 535 nl80211_nan_conf_policy[NL80211_NAN_CONF_ATTR_MAX + 1] = { 536 [NL80211_NAN_CONF_CLUSTER_ID] = 537 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_nan_cluster_id, 538 ETH_ALEN), 539 [NL80211_NAN_CONF_EXTRA_ATTRS] = { .type = NLA_BINARY, 540 .len = IEEE80211_MAX_DATA_LEN}, 541 [NL80211_NAN_CONF_VENDOR_ELEMS] = 542 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 543 IEEE80211_MAX_DATA_LEN), 544 [NL80211_NAN_CONF_BAND_CONFIGS] = 545 NLA_POLICY_NESTED_ARRAY(nl80211_nan_band_conf_policy), 546 [NL80211_NAN_CONF_SCAN_PERIOD] = { .type = NLA_U16 }, 547 [NL80211_NAN_CONF_SCAN_DWELL_TIME] = NLA_POLICY_RANGE(NLA_U16, 50, 512), 548 [NL80211_NAN_CONF_DISCOVERY_BEACON_INTERVAL] = 549 NLA_POLICY_RANGE(NLA_U8, 50, 200), 550 [NL80211_NAN_CONF_NOTIFY_DW] = { .type = NLA_FLAG }, 551 }; 552 553 static const struct netlink_range_validation nl80211_punct_bitmap_range = { 554 .min = 0, 555 .max = 0xffff, 556 }; 557 558 static const struct netlink_range_validation q_range = { 559 .max = INT_MAX, 560 }; 561 562 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = { 563 [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD }, 564 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 }, 565 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING, 566 .len = 20-1 }, 567 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED }, 568 569 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 }, 570 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 }, 571 [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8, 572 NL80211_EDMG_CHANNELS_MIN, 573 NL80211_EDMG_CHANNELS_MAX), 574 [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8, 575 NL80211_EDMG_BW_CONFIG_MIN, 576 NL80211_EDMG_BW_CONFIG_MAX), 577 578 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 }, 579 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 }, 580 [NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 581 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 }, 582 583 [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 584 [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 585 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 }, 586 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 }, 587 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 }, 588 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG }, 589 590 [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX), 591 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 }, 592 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 }, 593 594 [NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 595 [NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 596 597 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, }, 598 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY, 599 .len = WLAN_MAX_KEY_LEN }, 600 [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7), 601 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 }, 602 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG }, 603 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 604 [NL80211_ATTR_KEY_TYPE] = 605 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES), 606 607 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 }, 608 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 }, 609 [NL80211_ATTR_BEACON_HEAD] = 610 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 611 IEEE80211_MAX_DATA_LEN), 612 [NL80211_ATTR_BEACON_TAIL] = 613 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 614 IEEE80211_MAX_DATA_LEN), 615 [NL80211_ATTR_STA_AID] = 616 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 617 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED }, 618 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 }, 619 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY, 620 .len = NL80211_MAX_SUPP_RATES }, 621 [NL80211_ATTR_STA_PLINK_ACTION] = 622 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1), 623 [NL80211_ATTR_STA_TX_POWER_SETTING] = 624 NLA_POLICY_RANGE(NLA_U8, 625 NL80211_TX_POWER_AUTOMATIC, 626 NL80211_TX_POWER_FIXED), 627 [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 }, 628 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 }, 629 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ }, 630 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY, 631 .len = IEEE80211_MAX_MESH_ID_LEN }, 632 [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT, 633 634 /* allow 3 for NUL-termination, we used to declare this NLA_STRING */ 635 [NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3), 636 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED }, 637 638 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 }, 639 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 }, 640 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 }, 641 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY, 642 .len = NL80211_MAX_SUPP_RATES }, 643 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 }, 644 645 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED }, 646 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG }, 647 648 [NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN), 649 650 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 }, 651 [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY, 652 validate_ie_attr, 653 IEEE80211_MAX_DATA_LEN), 654 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED }, 655 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED }, 656 657 [NL80211_ATTR_SSID] = { .type = NLA_BINARY, 658 .len = IEEE80211_MAX_SSID_LEN }, 659 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 }, 660 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 }, 661 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG }, 662 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG }, 663 [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32, 664 NL80211_MFP_NO, 665 NL80211_MFP_OPTIONAL), 666 [NL80211_ATTR_STA_FLAGS2] = 667 NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)), 668 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG }, 669 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 }, 670 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG }, 671 [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG }, 672 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG }, 673 [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 }, 674 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 }, 675 [NL80211_ATTR_WPA_VERSIONS] = 676 NLA_POLICY_RANGE(NLA_U32, 0, 677 NL80211_WPA_VERSION_1 | 678 NL80211_WPA_VERSION_2 | 679 NL80211_WPA_VERSION_3), 680 [NL80211_ATTR_PID] = { .type = NLA_U32 }, 681 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 }, 682 [NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN), 683 [NL80211_ATTR_DURATION] = { .type = NLA_U32 }, 684 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 }, 685 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED }, 686 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY, 687 .len = IEEE80211_MAX_DATA_LEN }, 688 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, }, 689 [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32, 690 NL80211_PS_DISABLED, 691 NL80211_PS_ENABLED), 692 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, }, 693 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG }, 694 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 }, 695 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 }, 696 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 }, 697 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 }, 698 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 }, 699 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 }, 700 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 }, 701 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG }, 702 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 703 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED }, 704 [NL80211_ATTR_STA_PLINK_STATE] = 705 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1), 706 [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 }, 707 [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG }, 708 [NL80211_ATTR_MESH_PEER_AID] = 709 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 710 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 }, 711 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED }, 712 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED }, 713 [NL80211_ATTR_HIDDEN_SSID] = 714 NLA_POLICY_RANGE(NLA_U32, 715 NL80211_HIDDEN_SSID_NOT_IN_USE, 716 NL80211_HIDDEN_SSID_ZERO_CONTENTS), 717 [NL80211_ATTR_IE_PROBE_RESP] = 718 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 719 IEEE80211_MAX_DATA_LEN), 720 [NL80211_ATTR_IE_ASSOC_RESP] = 721 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 722 IEEE80211_MAX_DATA_LEN), 723 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG }, 724 [NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy), 725 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED }, 726 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG }, 727 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 }, 728 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 }, 729 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 }, 730 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG }, 731 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG }, 732 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG }, 733 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG }, 734 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY, 735 .len = IEEE80211_MAX_DATA_LEN }, 736 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 }, 737 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG }, 738 [NL80211_ATTR_HT_CAPABILITY_MASK] = { 739 .len = NL80211_HT_CAPABILITY_LEN 740 }, 741 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 }, 742 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 }, 743 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 }, 744 [NL80211_ATTR_WDEV] = { .type = NLA_U64 }, 745 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 }, 746 747 /* need to include at least Auth Transaction and Status Code */ 748 [NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4), 749 750 [NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN), 751 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 }, 752 [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127), 753 [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1), 754 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = 755 NLA_POLICY_RANGE(NLA_U32, 756 NL80211_MESH_POWER_UNKNOWN + 1, 757 NL80211_MESH_POWER_MAX), 758 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 }, 759 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED }, 760 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 }, 761 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, }, 762 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, }, 763 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG }, 764 [NL80211_ATTR_VHT_CAPABILITY_MASK] = { 765 .len = NL80211_VHT_CAPABILITY_LEN, 766 }, 767 [NL80211_ATTR_MDID] = { .type = NLA_U16 }, 768 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY, 769 .len = IEEE80211_MAX_DATA_LEN }, 770 [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 }, 771 [NL80211_ATTR_MAX_CRIT_PROT_DURATION] = 772 NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION), 773 [NL80211_ATTR_PEER_AID] = 774 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 775 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 }, 776 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG }, 777 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED }, 778 [NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY }, 779 [NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY }, 780 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2), 781 /* 782 * The value of the Length field of the Supported Operating 783 * Classes element is between 2 and 253. 784 */ 785 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = 786 NLA_POLICY_RANGE(NLA_BINARY, 2, 253), 787 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG }, 788 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 }, 789 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 }, 790 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 }, 791 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY }, 792 [NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY, 793 IEEE80211_QOS_MAP_LEN_MIN, 794 IEEE80211_QOS_MAP_LEN_MAX), 795 [NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 796 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 }, 797 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 }, 798 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG }, 799 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY }, 800 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG }, 801 [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1), 802 [NL80211_ATTR_USER_PRIO] = 803 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1), 804 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 }, 805 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 }, 806 [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 }, 807 [NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 808 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG }, 809 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 }, 810 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 }, 811 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG }, 812 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG }, 813 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED }, 814 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = 815 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1), 816 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = { 817 .len = VHT_MUMIMO_GROUPS_DATA_LEN 818 }, 819 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 820 [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1), 821 [NL80211_ATTR_BANDS] = { .type = NLA_U32 }, 822 [NL80211_ATTR_NAN_CONFIG] = NLA_POLICY_NESTED(nl80211_nan_conf_policy), 823 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED }, 824 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY, 825 .len = FILS_MAX_KEK_LEN }, 826 [NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN), 827 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, }, 828 [NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 829 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 }, 830 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = { 831 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 832 }, 833 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 }, 834 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY, 835 .len = FILS_ERP_MAX_USERNAME_LEN }, 836 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY, 837 .len = FILS_ERP_MAX_REALM_LEN }, 838 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 }, 839 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY, 840 .len = FILS_ERP_MAX_RRK_LEN }, 841 [NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2), 842 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN }, 843 [NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN), 844 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG }, 845 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG }, 846 847 [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 }, 848 [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 }, 849 [NL80211_ATTR_TXQ_QUANTUM] = NLA_POLICY_FULL_RANGE(NLA_U32, &q_range), 850 [NL80211_ATTR_HE_CAPABILITY] = 851 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa, 852 NL80211_HE_MAX_CAPABILITY_LEN), 853 [NL80211_ATTR_FTM_RESPONDER] = 854 NLA_POLICY_NESTED(nl80211_ftm_responder_policy), 855 [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1), 856 [NL80211_ATTR_PEER_MEASUREMENTS] = 857 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy), 858 [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1), 859 [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY, 860 .len = SAE_PASSWORD_MAX_LEN }, 861 [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG }, 862 [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy), 863 [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2), 864 [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy), 865 [NL80211_ATTR_TID_CONFIG] = 866 NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy), 867 [NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG }, 868 [NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1), 869 [NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100), 870 [NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG }, 871 [NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 872 [NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED }, 873 [NL80211_ATTR_HE_6GHZ_CAPABILITY] = 874 NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)), 875 [NL80211_ATTR_FILS_DISCOVERY] = 876 NLA_POLICY_NESTED(nl80211_fils_discovery_policy), 877 [NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] = 878 NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy), 879 [NL80211_ATTR_S1G_CAPABILITY] = 880 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 881 [NL80211_ATTR_S1G_CAPABILITY_MASK] = 882 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 883 [NL80211_ATTR_SAE_PWE] = 884 NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK, 885 NL80211_SAE_PWE_BOTH), 886 [NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT }, 887 [NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy), 888 [NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG }, 889 [NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 }, 890 [NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 }, 891 [NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 }, 892 [NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy), 893 [NL80211_ATTR_MBSSID_CONFIG] = 894 NLA_POLICY_NESTED(nl80211_mbssid_config_policy), 895 [NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED }, 896 [NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG }, 897 [NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 }, 898 [NL80211_ATTR_EHT_CAPABILITY] = 899 NLA_POLICY_RANGE(NLA_BINARY, 900 NL80211_EHT_MIN_CAPABILITY_LEN, 901 NL80211_EHT_MAX_CAPABILITY_LEN), 902 [NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG }, 903 [NL80211_ATTR_MLO_LINKS] = 904 NLA_POLICY_NESTED_ARRAY(nl80211_policy), 905 [NL80211_ATTR_MLO_LINK_ID] = 906 NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS - 1), 907 [NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN), 908 [NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG }, 909 [NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT }, 910 [NL80211_ATTR_EML_CAPABILITY] = { .type = NLA_U16 }, 911 [NL80211_ATTR_PUNCT_BITMAP] = 912 NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range), 913 914 [NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS] = { .type = NLA_U16 }, 915 [NL80211_ATTR_HW_TIMESTAMP_ENABLED] = { .type = NLA_FLAG }, 916 [NL80211_ATTR_EMA_RNR_ELEMS] = { .type = NLA_NESTED }, 917 [NL80211_ATTR_MLO_LINK_DISABLED] = { .type = NLA_FLAG }, 918 [NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA] = { .type = NLA_FLAG }, 919 [NL80211_ATTR_MLO_TTLM_DLINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 920 [NL80211_ATTR_MLO_TTLM_ULINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 921 [NL80211_ATTR_ASSOC_SPP_AMSDU] = { .type = NLA_FLAG }, 922 [NL80211_ATTR_VIF_RADIO_MASK] = { .type = NLA_U32 }, 923 [NL80211_ATTR_SUPPORTED_SELECTORS] = 924 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_supported_selectors, 925 NL80211_MAX_SUPP_SELECTORS), 926 [NL80211_ATTR_MLO_RECONF_REM_LINKS] = { .type = NLA_U16 }, 927 [NL80211_ATTR_EPCS] = { .type = NLA_FLAG }, 928 [NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS] = { .type = NLA_U16 }, 929 [NL80211_ATTR_WIPHY_RADIO_INDEX] = { .type = NLA_U8 }, 930 [NL80211_ATTR_S1G_LONG_BEACON_PERIOD] = NLA_POLICY_MIN(NLA_U8, 2), 931 [NL80211_ATTR_S1G_SHORT_BEACON] = 932 NLA_POLICY_NESTED(nl80211_s1g_short_beacon), 933 [NL80211_ATTR_BSS_PARAM] = { .type = NLA_FLAG }, 934 [NL80211_ATTR_S1G_PRIMARY_2MHZ] = { .type = NLA_FLAG }, 935 }; 936 937 /* policy for the key attributes */ 938 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = { 939 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN }, 940 [NL80211_KEY_IDX] = { .type = NLA_U8 }, 941 [NL80211_KEY_CIPHER] = { .type = NLA_U32 }, 942 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 943 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG }, 944 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG }, 945 [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1), 946 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 947 [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX), 948 }; 949 950 /* policy for the key default flags */ 951 static const struct nla_policy 952 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = { 953 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG }, 954 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG }, 955 }; 956 957 #ifdef CONFIG_PM 958 /* policy for WoWLAN attributes */ 959 static const struct nla_policy 960 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = { 961 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG }, 962 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG }, 963 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG }, 964 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED }, 965 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG }, 966 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG }, 967 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG }, 968 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG }, 969 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED }, 970 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED }, 971 }; 972 973 static const struct nla_policy 974 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = { 975 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 }, 976 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 }, 977 [NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 978 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 }, 979 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 }, 980 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 981 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = { 982 .len = sizeof(struct nl80211_wowlan_tcp_data_seq) 983 }, 984 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = { 985 .len = sizeof(struct nl80211_wowlan_tcp_data_token) 986 }, 987 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 }, 988 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 989 [NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1), 990 }; 991 #endif /* CONFIG_PM */ 992 993 /* policy for coalesce rule attributes */ 994 static const struct nla_policy 995 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = { 996 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 }, 997 [NL80211_ATTR_COALESCE_RULE_CONDITION] = 998 NLA_POLICY_RANGE(NLA_U32, 999 NL80211_COALESCE_CONDITION_MATCH, 1000 NL80211_COALESCE_CONDITION_NO_MATCH), 1001 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED }, 1002 }; 1003 1004 /* policy for GTK rekey offload attributes */ 1005 static const struct nla_policy 1006 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = { 1007 [NL80211_REKEY_DATA_KEK] = { 1008 .type = NLA_BINARY, 1009 .len = NL80211_KEK_EXT_LEN 1010 }, 1011 [NL80211_REKEY_DATA_KCK] = { 1012 .type = NLA_BINARY, 1013 .len = NL80211_KCK_EXT_LEN_32 1014 }, 1015 [NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN), 1016 [NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 }, 1017 }; 1018 1019 static const struct nla_policy 1020 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = { 1021 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY, 1022 .len = IEEE80211_MAX_SSID_LEN }, 1023 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 1024 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 }, 1025 }; 1026 1027 static const struct nla_policy 1028 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = { 1029 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 }, 1030 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 }, 1031 }; 1032 1033 static const struct nla_policy 1034 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = { 1035 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG }, 1036 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 }, 1037 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = { 1038 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 1039 }, 1040 }; 1041 1042 /* policy for NAN function attributes */ 1043 static const struct nla_policy 1044 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = { 1045 [NL80211_NAN_FUNC_TYPE] = 1046 NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE), 1047 [NL80211_NAN_FUNC_SERVICE_ID] = { 1048 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN }, 1049 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 }, 1050 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG }, 1051 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG }, 1052 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 }, 1053 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 }, 1054 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 1055 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG }, 1056 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 }, 1057 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY, 1058 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN }, 1059 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED }, 1060 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED }, 1061 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED }, 1062 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 }, 1063 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 }, 1064 }; 1065 1066 /* policy for Service Response Filter attributes */ 1067 static const struct nla_policy 1068 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = { 1069 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG }, 1070 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY, 1071 .len = NL80211_NAN_FUNC_SRF_MAX_LEN }, 1072 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 }, 1073 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED }, 1074 }; 1075 1076 /* policy for packet pattern attributes */ 1077 static const struct nla_policy 1078 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = { 1079 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, }, 1080 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, }, 1081 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 }, 1082 }; 1083 1084 static int nl80211_prepare_wdev_dump(struct netlink_callback *cb, 1085 struct cfg80211_registered_device **rdev, 1086 struct wireless_dev **wdev, 1087 struct nlattr **attrbuf) 1088 { 1089 int err; 1090 1091 if (!cb->args[0]) { 1092 struct nlattr **attrbuf_free = NULL; 1093 1094 if (!attrbuf) { 1095 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 1096 GFP_KERNEL); 1097 if (!attrbuf) 1098 return -ENOMEM; 1099 attrbuf_free = attrbuf; 1100 } 1101 1102 err = nlmsg_parse_deprecated(cb->nlh, 1103 GENL_HDRLEN + nl80211_fam.hdrsize, 1104 attrbuf, nl80211_fam.maxattr, 1105 nl80211_policy, NULL); 1106 if (err) { 1107 kfree(attrbuf_free); 1108 return err; 1109 } 1110 1111 rtnl_lock(); 1112 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk), 1113 attrbuf); 1114 kfree(attrbuf_free); 1115 if (IS_ERR(*wdev)) { 1116 rtnl_unlock(); 1117 return PTR_ERR(*wdev); 1118 } 1119 *rdev = wiphy_to_rdev((*wdev)->wiphy); 1120 mutex_lock(&(*rdev)->wiphy.mtx); 1121 rtnl_unlock(); 1122 /* 0 is the first index - add 1 to parse only once */ 1123 cb->args[0] = (*rdev)->wiphy_idx + 1; 1124 cb->args[1] = (*wdev)->identifier; 1125 } else { 1126 /* subtract the 1 again here */ 1127 struct wiphy *wiphy; 1128 struct wireless_dev *tmp; 1129 1130 rtnl_lock(); 1131 wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 1132 if (!wiphy) { 1133 rtnl_unlock(); 1134 return -ENODEV; 1135 } 1136 *rdev = wiphy_to_rdev(wiphy); 1137 *wdev = NULL; 1138 1139 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) { 1140 if (tmp->identifier == cb->args[1]) { 1141 *wdev = tmp; 1142 break; 1143 } 1144 } 1145 1146 if (!*wdev) { 1147 rtnl_unlock(); 1148 return -ENODEV; 1149 } 1150 mutex_lock(&(*rdev)->wiphy.mtx); 1151 rtnl_unlock(); 1152 } 1153 1154 return 0; 1155 } 1156 1157 /* message building helper */ 1158 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq, 1159 int flags, u8 cmd) 1160 { 1161 /* since there is no private header just add the generic one */ 1162 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd); 1163 } 1164 1165 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg, 1166 const struct ieee80211_reg_rule *rule) 1167 { 1168 int j; 1169 struct nlattr *nl_wmm_rules = 1170 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM); 1171 1172 if (!nl_wmm_rules) 1173 goto nla_put_failure; 1174 1175 for (j = 0; j < IEEE80211_NUM_ACS; j++) { 1176 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j); 1177 1178 if (!nl_wmm_rule) 1179 goto nla_put_failure; 1180 1181 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN, 1182 rule->wmm_rule.client[j].cw_min) || 1183 nla_put_u16(msg, NL80211_WMMR_CW_MAX, 1184 rule->wmm_rule.client[j].cw_max) || 1185 nla_put_u8(msg, NL80211_WMMR_AIFSN, 1186 rule->wmm_rule.client[j].aifsn) || 1187 nla_put_u16(msg, NL80211_WMMR_TXOP, 1188 rule->wmm_rule.client[j].cot)) 1189 goto nla_put_failure; 1190 1191 nla_nest_end(msg, nl_wmm_rule); 1192 } 1193 nla_nest_end(msg, nl_wmm_rules); 1194 1195 return 0; 1196 1197 nla_put_failure: 1198 return -ENOBUFS; 1199 } 1200 1201 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy, 1202 struct ieee80211_channel *chan, 1203 bool large) 1204 { 1205 /* Some channels must be completely excluded from the 1206 * list to protect old user-space tools from breaking 1207 */ 1208 if (!large && chan->flags & 1209 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ)) 1210 return 0; 1211 if (!large && chan->freq_offset) 1212 return 0; 1213 1214 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ, 1215 chan->center_freq)) 1216 goto nla_put_failure; 1217 1218 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset)) 1219 goto nla_put_failure; 1220 1221 if ((chan->flags & IEEE80211_CHAN_PSD) && 1222 nla_put_s8(msg, NL80211_FREQUENCY_ATTR_PSD, chan->psd)) 1223 goto nla_put_failure; 1224 1225 if ((chan->flags & IEEE80211_CHAN_DISABLED) && 1226 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED)) 1227 goto nla_put_failure; 1228 if (chan->flags & IEEE80211_CHAN_NO_IR) { 1229 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR)) 1230 goto nla_put_failure; 1231 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS)) 1232 goto nla_put_failure; 1233 } 1234 if (chan->flags & IEEE80211_CHAN_RADAR) { 1235 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR)) 1236 goto nla_put_failure; 1237 if (large) { 1238 u32 time; 1239 1240 time = elapsed_jiffies_msecs(chan->dfs_state_entered); 1241 1242 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE, 1243 chan->dfs_state)) 1244 goto nla_put_failure; 1245 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME, 1246 time)) 1247 goto nla_put_failure; 1248 if (nla_put_u32(msg, 1249 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME, 1250 chan->dfs_cac_ms)) 1251 goto nla_put_failure; 1252 } 1253 } 1254 1255 if (large) { 1256 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) && 1257 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS)) 1258 goto nla_put_failure; 1259 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) && 1260 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS)) 1261 goto nla_put_failure; 1262 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) && 1263 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ)) 1264 goto nla_put_failure; 1265 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) && 1266 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ)) 1267 goto nla_put_failure; 1268 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) && 1269 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY)) 1270 goto nla_put_failure; 1271 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) && 1272 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT)) 1273 goto nla_put_failure; 1274 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) && 1275 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ)) 1276 goto nla_put_failure; 1277 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) && 1278 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ)) 1279 goto nla_put_failure; 1280 if ((chan->flags & IEEE80211_CHAN_NO_HE) && 1281 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE)) 1282 goto nla_put_failure; 1283 if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) && 1284 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ)) 1285 goto nla_put_failure; 1286 if ((chan->flags & IEEE80211_CHAN_NO_EHT) && 1287 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT)) 1288 goto nla_put_failure; 1289 if ((chan->flags & IEEE80211_CHAN_DFS_CONCURRENT) && 1290 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DFS_CONCURRENT)) 1291 goto nla_put_failure; 1292 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_VLP_CLIENT) && 1293 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_VLP_CLIENT)) 1294 goto nla_put_failure; 1295 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_AFC_CLIENT) && 1296 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_AFC_CLIENT)) 1297 goto nla_put_failure; 1298 if ((chan->flags & IEEE80211_CHAN_CAN_MONITOR) && 1299 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_CAN_MONITOR)) 1300 goto nla_put_failure; 1301 if ((chan->flags & IEEE80211_CHAN_ALLOW_6GHZ_VLP_AP) && 1302 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_ALLOW_6GHZ_VLP_AP)) 1303 goto nla_put_failure; 1304 if ((chan->flags & IEEE80211_CHAN_ALLOW_20MHZ_ACTIVITY) && 1305 nla_put_flag(msg, 1306 NL80211_FREQUENCY_ATTR_ALLOW_20MHZ_ACTIVITY)) 1307 goto nla_put_failure; 1308 if ((chan->flags & IEEE80211_CHAN_NO_4MHZ) && 1309 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_4MHZ)) 1310 goto nla_put_failure; 1311 if ((chan->flags & IEEE80211_CHAN_NO_8MHZ) && 1312 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_8MHZ)) 1313 goto nla_put_failure; 1314 if ((chan->flags & IEEE80211_CHAN_NO_16MHZ) && 1315 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_16MHZ)) 1316 goto nla_put_failure; 1317 if ((chan->flags & IEEE80211_CHAN_S1G_NO_PRIMARY) && 1318 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_S1G_NO_PRIMARY)) 1319 goto nla_put_failure; 1320 } 1321 1322 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER, 1323 DBM_TO_MBM(chan->max_power))) 1324 goto nla_put_failure; 1325 1326 if (large) { 1327 const struct ieee80211_reg_rule *rule = 1328 freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq)); 1329 1330 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) { 1331 if (nl80211_msg_put_wmm_rules(msg, rule)) 1332 goto nla_put_failure; 1333 } 1334 } 1335 1336 return 0; 1337 1338 nla_put_failure: 1339 return -ENOBUFS; 1340 } 1341 1342 static bool nl80211_put_txq_stats(struct sk_buff *msg, 1343 struct cfg80211_txq_stats *txqstats, 1344 int attrtype) 1345 { 1346 struct nlattr *txqattr; 1347 1348 #define PUT_TXQVAL_U32(attr, memb) do { \ 1349 if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \ 1350 nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \ 1351 return false; \ 1352 } while (0) 1353 1354 txqattr = nla_nest_start_noflag(msg, attrtype); 1355 if (!txqattr) 1356 return false; 1357 1358 PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes); 1359 PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets); 1360 PUT_TXQVAL_U32(FLOWS, flows); 1361 PUT_TXQVAL_U32(DROPS, drops); 1362 PUT_TXQVAL_U32(ECN_MARKS, ecn_marks); 1363 PUT_TXQVAL_U32(OVERLIMIT, overlimit); 1364 PUT_TXQVAL_U32(OVERMEMORY, overmemory); 1365 PUT_TXQVAL_U32(COLLISIONS, collisions); 1366 PUT_TXQVAL_U32(TX_BYTES, tx_bytes); 1367 PUT_TXQVAL_U32(TX_PACKETS, tx_packets); 1368 PUT_TXQVAL_U32(MAX_FLOWS, max_flows); 1369 nla_nest_end(msg, txqattr); 1370 1371 #undef PUT_TXQVAL_U32 1372 return true; 1373 } 1374 1375 /* netlink command implementations */ 1376 1377 /** 1378 * nl80211_link_id - return link ID 1379 * @attrs: attributes to look at 1380 * 1381 * Returns: the link ID or 0 if not given 1382 * 1383 * Note this function doesn't do any validation of the link 1384 * ID validity wrt. links that were actually added, so it must 1385 * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID 1386 * or if additional validation is done. 1387 */ 1388 static unsigned int nl80211_link_id(struct nlattr **attrs) 1389 { 1390 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1391 1392 return nla_get_u8_default(linkid, 0); 1393 } 1394 1395 static int nl80211_link_id_or_invalid(struct nlattr **attrs) 1396 { 1397 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1398 1399 if (!linkid) 1400 return -1; 1401 1402 return nla_get_u8(linkid); 1403 } 1404 1405 struct key_parse { 1406 struct key_params p; 1407 int idx; 1408 int type; 1409 bool def, defmgmt, defbeacon; 1410 bool def_uni, def_multi; 1411 }; 1412 1413 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key, 1414 struct key_parse *k) 1415 { 1416 struct nlattr *tb[NL80211_KEY_MAX + 1]; 1417 int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key, 1418 nl80211_key_policy, 1419 info->extack); 1420 if (err) 1421 return err; 1422 1423 k->def = !!tb[NL80211_KEY_DEFAULT]; 1424 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT]; 1425 k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON]; 1426 1427 if (k->def) { 1428 k->def_uni = true; 1429 k->def_multi = true; 1430 } 1431 if (k->defmgmt || k->defbeacon) 1432 k->def_multi = true; 1433 1434 if (tb[NL80211_KEY_IDX]) 1435 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]); 1436 1437 if (tb[NL80211_KEY_DATA]) { 1438 k->p.key = nla_data(tb[NL80211_KEY_DATA]); 1439 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]); 1440 } 1441 1442 if (tb[NL80211_KEY_SEQ]) { 1443 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]); 1444 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]); 1445 } 1446 1447 if (tb[NL80211_KEY_CIPHER]) 1448 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]); 1449 1450 if (tb[NL80211_KEY_TYPE]) 1451 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]); 1452 1453 if (tb[NL80211_KEY_DEFAULT_TYPES]) { 1454 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1455 1456 err = nla_parse_nested_deprecated(kdt, 1457 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1458 tb[NL80211_KEY_DEFAULT_TYPES], 1459 nl80211_key_default_policy, 1460 info->extack); 1461 if (err) 1462 return err; 1463 1464 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1465 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1466 } 1467 1468 if (tb[NL80211_KEY_MODE]) 1469 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]); 1470 1471 return 0; 1472 } 1473 1474 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k) 1475 { 1476 if (info->attrs[NL80211_ATTR_KEY_DATA]) { 1477 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]); 1478 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]); 1479 } 1480 1481 if (info->attrs[NL80211_ATTR_KEY_SEQ]) { 1482 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]); 1483 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]); 1484 } 1485 1486 if (info->attrs[NL80211_ATTR_KEY_IDX]) 1487 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 1488 1489 if (info->attrs[NL80211_ATTR_KEY_CIPHER]) 1490 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]); 1491 1492 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT]; 1493 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT]; 1494 1495 if (k->def) { 1496 k->def_uni = true; 1497 k->def_multi = true; 1498 } 1499 if (k->defmgmt) 1500 k->def_multi = true; 1501 1502 if (info->attrs[NL80211_ATTR_KEY_TYPE]) 1503 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 1504 1505 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) { 1506 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1507 int err = nla_parse_nested_deprecated(kdt, 1508 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1509 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES], 1510 nl80211_key_default_policy, 1511 info->extack); 1512 if (err) 1513 return err; 1514 1515 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1516 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1517 } 1518 1519 return 0; 1520 } 1521 1522 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k) 1523 { 1524 int err; 1525 1526 memset(k, 0, sizeof(*k)); 1527 k->idx = -1; 1528 k->type = -1; 1529 1530 if (info->attrs[NL80211_ATTR_KEY]) 1531 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k); 1532 else 1533 err = nl80211_parse_key_old(info, k); 1534 1535 if (err) 1536 return err; 1537 1538 if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) + 1539 (k->defbeacon ? 1 : 0) > 1) { 1540 GENL_SET_ERR_MSG(info, 1541 "key with multiple default flags is invalid"); 1542 return -EINVAL; 1543 } 1544 1545 if (k->defmgmt || k->defbeacon) { 1546 if (k->def_uni || !k->def_multi) { 1547 GENL_SET_ERR_MSG(info, 1548 "defmgmt/defbeacon key must be mcast"); 1549 return -EINVAL; 1550 } 1551 } 1552 1553 if (k->idx != -1) { 1554 if (k->defmgmt) { 1555 if (k->idx < 4 || k->idx > 5) { 1556 GENL_SET_ERR_MSG(info, 1557 "defmgmt key idx not 4 or 5"); 1558 return -EINVAL; 1559 } 1560 } else if (k->defbeacon) { 1561 if (k->idx < 6 || k->idx > 7) { 1562 GENL_SET_ERR_MSG(info, 1563 "defbeacon key idx not 6 or 7"); 1564 return -EINVAL; 1565 } 1566 } else if (k->def) { 1567 if (k->idx < 0 || k->idx > 3) { 1568 GENL_SET_ERR_MSG(info, "def key idx not 0-3"); 1569 return -EINVAL; 1570 } 1571 } else { 1572 if (k->idx < 0 || k->idx > 7) { 1573 GENL_SET_ERR_MSG(info, "key idx not 0-7"); 1574 return -EINVAL; 1575 } 1576 } 1577 } 1578 1579 return 0; 1580 } 1581 1582 static struct cfg80211_cached_keys * 1583 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev, 1584 struct genl_info *info, bool *no_ht) 1585 { 1586 struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS]; 1587 struct key_parse parse; 1588 struct nlattr *key; 1589 struct cfg80211_cached_keys *result; 1590 int rem, err, def = 0; 1591 bool have_key = false; 1592 1593 nla_for_each_nested(key, keys, rem) { 1594 have_key = true; 1595 break; 1596 } 1597 1598 if (!have_key) 1599 return NULL; 1600 1601 result = kzalloc(sizeof(*result), GFP_KERNEL); 1602 if (!result) 1603 return ERR_PTR(-ENOMEM); 1604 1605 result->def = -1; 1606 1607 nla_for_each_nested(key, keys, rem) { 1608 memset(&parse, 0, sizeof(parse)); 1609 parse.idx = -1; 1610 1611 err = nl80211_parse_key_new(info, key, &parse); 1612 if (err) 1613 goto error; 1614 err = -EINVAL; 1615 if (!parse.p.key) 1616 goto error; 1617 if (parse.idx < 0 || parse.idx > 3) { 1618 GENL_SET_ERR_MSG(info, "key index out of range [0-3]"); 1619 goto error; 1620 } 1621 if (parse.def) { 1622 if (def) { 1623 GENL_SET_ERR_MSG(info, 1624 "only one key can be default"); 1625 goto error; 1626 } 1627 def = 1; 1628 result->def = parse.idx; 1629 if (!parse.def_uni || !parse.def_multi) 1630 goto error; 1631 } else if (parse.defmgmt) 1632 goto error; 1633 err = cfg80211_validate_key_settings(rdev, &parse.p, 1634 parse.idx, false, NULL); 1635 if (err) 1636 goto error; 1637 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 && 1638 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) { 1639 GENL_SET_ERR_MSG(info, "connect key must be WEP"); 1640 err = -EINVAL; 1641 goto error; 1642 } 1643 result->params[parse.idx].cipher = parse.p.cipher; 1644 result->params[parse.idx].key_len = parse.p.key_len; 1645 result->params[parse.idx].key = result->data[parse.idx]; 1646 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len); 1647 1648 /* must be WEP key if we got here */ 1649 if (no_ht) 1650 *no_ht = true; 1651 } 1652 1653 if (result->def < 0) { 1654 err = -EINVAL; 1655 GENL_SET_ERR_MSG(info, "need a default/TX key"); 1656 goto error; 1657 } 1658 1659 return result; 1660 error: 1661 kfree_sensitive(result); 1662 return ERR_PTR(err); 1663 } 1664 1665 static int nl80211_key_allowed(struct wireless_dev *wdev) 1666 { 1667 lockdep_assert_wiphy(wdev->wiphy); 1668 1669 switch (wdev->iftype) { 1670 case NL80211_IFTYPE_AP: 1671 case NL80211_IFTYPE_AP_VLAN: 1672 case NL80211_IFTYPE_P2P_GO: 1673 case NL80211_IFTYPE_MESH_POINT: 1674 break; 1675 case NL80211_IFTYPE_ADHOC: 1676 if (wdev->u.ibss.current_bss) 1677 return 0; 1678 return -ENOLINK; 1679 case NL80211_IFTYPE_STATION: 1680 case NL80211_IFTYPE_P2P_CLIENT: 1681 if (wdev->connected) 1682 return 0; 1683 return -ENOLINK; 1684 case NL80211_IFTYPE_NAN: 1685 if (wiphy_ext_feature_isset(wdev->wiphy, 1686 NL80211_EXT_FEATURE_SECURE_NAN)) 1687 return 0; 1688 return -EINVAL; 1689 case NL80211_IFTYPE_UNSPECIFIED: 1690 case NL80211_IFTYPE_OCB: 1691 case NL80211_IFTYPE_MONITOR: 1692 case NL80211_IFTYPE_P2P_DEVICE: 1693 case NL80211_IFTYPE_WDS: 1694 case NUM_NL80211_IFTYPES: 1695 return -EINVAL; 1696 } 1697 1698 return 0; 1699 } 1700 1701 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy, 1702 u32 freq) 1703 { 1704 struct ieee80211_channel *chan; 1705 1706 chan = ieee80211_get_channel_khz(wiphy, freq); 1707 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) 1708 return NULL; 1709 return chan; 1710 } 1711 1712 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes) 1713 { 1714 struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr); 1715 int i; 1716 1717 if (!nl_modes) 1718 goto nla_put_failure; 1719 1720 i = 0; 1721 while (ifmodes) { 1722 if ((ifmodes & 1) && nla_put_flag(msg, i)) 1723 goto nla_put_failure; 1724 ifmodes >>= 1; 1725 i++; 1726 } 1727 1728 nla_nest_end(msg, nl_modes); 1729 return 0; 1730 1731 nla_put_failure: 1732 return -ENOBUFS; 1733 } 1734 1735 static int nl80211_put_ifcomb_data(struct sk_buff *msg, bool large, int idx, 1736 const struct ieee80211_iface_combination *c, 1737 u16 nested) 1738 { 1739 struct nlattr *nl_combi, *nl_limits; 1740 int i; 1741 1742 nl_combi = nla_nest_start_noflag(msg, idx | nested); 1743 if (!nl_combi) 1744 goto nla_put_failure; 1745 1746 nl_limits = nla_nest_start_noflag(msg, NL80211_IFACE_COMB_LIMITS | 1747 nested); 1748 if (!nl_limits) 1749 goto nla_put_failure; 1750 1751 for (i = 0; i < c->n_limits; i++) { 1752 struct nlattr *nl_limit; 1753 1754 nl_limit = nla_nest_start_noflag(msg, i + 1); 1755 if (!nl_limit) 1756 goto nla_put_failure; 1757 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, c->limits[i].max)) 1758 goto nla_put_failure; 1759 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES, 1760 c->limits[i].types)) 1761 goto nla_put_failure; 1762 nla_nest_end(msg, nl_limit); 1763 } 1764 1765 nla_nest_end(msg, nl_limits); 1766 1767 if (c->beacon_int_infra_match && 1768 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH)) 1769 goto nla_put_failure; 1770 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS, 1771 c->num_different_channels) || 1772 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM, 1773 c->max_interfaces)) 1774 goto nla_put_failure; 1775 if (large && 1776 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS, 1777 c->radar_detect_widths) || 1778 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS, 1779 c->radar_detect_regions))) 1780 goto nla_put_failure; 1781 if (c->beacon_int_min_gcd && 1782 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD, 1783 c->beacon_int_min_gcd)) 1784 goto nla_put_failure; 1785 1786 nla_nest_end(msg, nl_combi); 1787 1788 return 0; 1789 nla_put_failure: 1790 return -ENOBUFS; 1791 } 1792 1793 static int nl80211_put_iface_combinations(struct wiphy *wiphy, 1794 struct sk_buff *msg, 1795 int attr, int radio, 1796 bool large, u16 nested) 1797 { 1798 const struct ieee80211_iface_combination *c; 1799 struct nlattr *nl_combis; 1800 int i, n; 1801 1802 nl_combis = nla_nest_start_noflag(msg, attr | nested); 1803 if (!nl_combis) 1804 goto nla_put_failure; 1805 1806 if (radio >= 0) { 1807 c = wiphy->radio[0].iface_combinations; 1808 n = wiphy->radio[0].n_iface_combinations; 1809 } else { 1810 c = wiphy->iface_combinations; 1811 n = wiphy->n_iface_combinations; 1812 } 1813 for (i = 0; i < n; i++) 1814 if (nl80211_put_ifcomb_data(msg, large, i + 1, &c[i], nested)) 1815 goto nla_put_failure; 1816 1817 nla_nest_end(msg, nl_combis); 1818 1819 return 0; 1820 nla_put_failure: 1821 return -ENOBUFS; 1822 } 1823 1824 #ifdef CONFIG_PM 1825 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev, 1826 struct sk_buff *msg) 1827 { 1828 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp; 1829 struct nlattr *nl_tcp; 1830 1831 if (!tcp) 1832 return 0; 1833 1834 nl_tcp = nla_nest_start_noflag(msg, 1835 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 1836 if (!nl_tcp) 1837 return -ENOBUFS; 1838 1839 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1840 tcp->data_payload_max)) 1841 return -ENOBUFS; 1842 1843 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1844 tcp->data_payload_max)) 1845 return -ENOBUFS; 1846 1847 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ)) 1848 return -ENOBUFS; 1849 1850 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 1851 sizeof(*tcp->tok), tcp->tok)) 1852 return -ENOBUFS; 1853 1854 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 1855 tcp->data_interval_max)) 1856 return -ENOBUFS; 1857 1858 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 1859 tcp->wake_payload_max)) 1860 return -ENOBUFS; 1861 1862 nla_nest_end(msg, nl_tcp); 1863 return 0; 1864 } 1865 1866 static int nl80211_send_wowlan(struct sk_buff *msg, 1867 struct cfg80211_registered_device *rdev, 1868 bool large) 1869 { 1870 struct nlattr *nl_wowlan; 1871 1872 if (!rdev->wiphy.wowlan) 1873 return 0; 1874 1875 nl_wowlan = nla_nest_start_noflag(msg, 1876 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED); 1877 if (!nl_wowlan) 1878 return -ENOBUFS; 1879 1880 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) && 1881 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 1882 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) && 1883 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 1884 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) && 1885 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 1886 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) && 1887 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) || 1888 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) && 1889 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 1890 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) && 1891 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 1892 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) && 1893 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 1894 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) && 1895 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 1896 return -ENOBUFS; 1897 1898 if (rdev->wiphy.wowlan->n_patterns) { 1899 struct nl80211_pattern_support pat = { 1900 .max_patterns = rdev->wiphy.wowlan->n_patterns, 1901 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len, 1902 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len, 1903 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset, 1904 }; 1905 1906 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 1907 sizeof(pat), &pat)) 1908 return -ENOBUFS; 1909 } 1910 1911 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) && 1912 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT, 1913 rdev->wiphy.wowlan->max_nd_match_sets)) 1914 return -ENOBUFS; 1915 1916 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg)) 1917 return -ENOBUFS; 1918 1919 nla_nest_end(msg, nl_wowlan); 1920 1921 return 0; 1922 } 1923 #endif 1924 1925 static int nl80211_send_coalesce(struct sk_buff *msg, 1926 struct cfg80211_registered_device *rdev) 1927 { 1928 struct nl80211_coalesce_rule_support rule; 1929 1930 if (!rdev->wiphy.coalesce) 1931 return 0; 1932 1933 rule.max_rules = rdev->wiphy.coalesce->n_rules; 1934 rule.max_delay = rdev->wiphy.coalesce->max_delay; 1935 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns; 1936 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len; 1937 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len; 1938 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset; 1939 1940 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule)) 1941 return -ENOBUFS; 1942 1943 return 0; 1944 } 1945 1946 static int 1947 nl80211_send_iftype_data(struct sk_buff *msg, 1948 const struct ieee80211_supported_band *sband, 1949 const struct ieee80211_sband_iftype_data *iftdata) 1950 { 1951 const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap; 1952 const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap; 1953 1954 if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES, 1955 iftdata->types_mask)) 1956 return -ENOBUFS; 1957 1958 if (he_cap->has_he) { 1959 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC, 1960 sizeof(he_cap->he_cap_elem.mac_cap_info), 1961 he_cap->he_cap_elem.mac_cap_info) || 1962 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY, 1963 sizeof(he_cap->he_cap_elem.phy_cap_info), 1964 he_cap->he_cap_elem.phy_cap_info) || 1965 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET, 1966 sizeof(he_cap->he_mcs_nss_supp), 1967 &he_cap->he_mcs_nss_supp) || 1968 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE, 1969 sizeof(he_cap->ppe_thres), he_cap->ppe_thres)) 1970 return -ENOBUFS; 1971 } 1972 1973 if (eht_cap->has_eht && he_cap->has_he) { 1974 u8 mcs_nss_size, ppe_thresh_size; 1975 u16 ppe_thres_hdr; 1976 bool is_ap; 1977 1978 is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) || 1979 iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO); 1980 1981 mcs_nss_size = 1982 ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 1983 &eht_cap->eht_cap_elem, 1984 is_ap); 1985 1986 ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]); 1987 ppe_thresh_size = 1988 ieee80211_eht_ppe_size(ppe_thres_hdr, 1989 eht_cap->eht_cap_elem.phy_cap_info); 1990 1991 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC, 1992 sizeof(eht_cap->eht_cap_elem.mac_cap_info), 1993 eht_cap->eht_cap_elem.mac_cap_info) || 1994 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY, 1995 sizeof(eht_cap->eht_cap_elem.phy_cap_info), 1996 eht_cap->eht_cap_elem.phy_cap_info) || 1997 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET, 1998 mcs_nss_size, &eht_cap->eht_mcs_nss_supp) || 1999 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE, 2000 ppe_thresh_size, eht_cap->eht_ppe_thres)) 2001 return -ENOBUFS; 2002 } 2003 2004 if (sband->band == NL80211_BAND_6GHZ && 2005 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA, 2006 sizeof(iftdata->he_6ghz_capa), 2007 &iftdata->he_6ghz_capa)) 2008 return -ENOBUFS; 2009 2010 if (iftdata->vendor_elems.data && iftdata->vendor_elems.len && 2011 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS, 2012 iftdata->vendor_elems.len, iftdata->vendor_elems.data)) 2013 return -ENOBUFS; 2014 2015 return 0; 2016 } 2017 2018 static int nl80211_send_band_rateinfo(struct sk_buff *msg, 2019 struct ieee80211_supported_band *sband, 2020 bool large) 2021 { 2022 struct nlattr *nl_rates, *nl_rate; 2023 struct ieee80211_rate *rate; 2024 int i; 2025 2026 /* add HT info */ 2027 if (sband->ht_cap.ht_supported && 2028 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET, 2029 sizeof(sband->ht_cap.mcs), 2030 &sband->ht_cap.mcs) || 2031 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA, 2032 sband->ht_cap.cap) || 2033 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR, 2034 sband->ht_cap.ampdu_factor) || 2035 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY, 2036 sband->ht_cap.ampdu_density))) 2037 return -ENOBUFS; 2038 2039 /* add VHT info */ 2040 if (sband->vht_cap.vht_supported && 2041 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET, 2042 sizeof(sband->vht_cap.vht_mcs), 2043 &sband->vht_cap.vht_mcs) || 2044 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA, 2045 sband->vht_cap.cap))) 2046 return -ENOBUFS; 2047 2048 if (large && sband->n_iftype_data) { 2049 struct nlattr *nl_iftype_data = 2050 nla_nest_start_noflag(msg, 2051 NL80211_BAND_ATTR_IFTYPE_DATA); 2052 const struct ieee80211_sband_iftype_data *iftd; 2053 int err; 2054 2055 if (!nl_iftype_data) 2056 return -ENOBUFS; 2057 2058 for_each_sband_iftype_data(sband, i, iftd) { 2059 struct nlattr *iftdata; 2060 2061 iftdata = nla_nest_start_noflag(msg, i + 1); 2062 if (!iftdata) 2063 return -ENOBUFS; 2064 2065 err = nl80211_send_iftype_data(msg, sband, iftd); 2066 if (err) 2067 return err; 2068 2069 nla_nest_end(msg, iftdata); 2070 } 2071 2072 nla_nest_end(msg, nl_iftype_data); 2073 } 2074 2075 /* add EDMG info */ 2076 if (large && sband->edmg_cap.channels && 2077 (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS, 2078 sband->edmg_cap.channels) || 2079 nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG, 2080 sband->edmg_cap.bw_config))) 2081 2082 return -ENOBUFS; 2083 2084 /* add bitrates */ 2085 nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES); 2086 if (!nl_rates) 2087 return -ENOBUFS; 2088 2089 for (i = 0; i < sband->n_bitrates; i++) { 2090 nl_rate = nla_nest_start_noflag(msg, i); 2091 if (!nl_rate) 2092 return -ENOBUFS; 2093 2094 rate = &sband->bitrates[i]; 2095 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE, 2096 rate->bitrate)) 2097 return -ENOBUFS; 2098 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) && 2099 nla_put_flag(msg, 2100 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE)) 2101 return -ENOBUFS; 2102 2103 nla_nest_end(msg, nl_rate); 2104 } 2105 2106 nla_nest_end(msg, nl_rates); 2107 2108 /* S1G capabilities */ 2109 if (sband->band == NL80211_BAND_S1GHZ && sband->s1g_cap.s1g && 2110 (nla_put(msg, NL80211_BAND_ATTR_S1G_CAPA, 2111 sizeof(sband->s1g_cap.cap), 2112 sband->s1g_cap.cap) || 2113 nla_put(msg, NL80211_BAND_ATTR_S1G_MCS_NSS_SET, 2114 sizeof(sband->s1g_cap.nss_mcs), 2115 sband->s1g_cap.nss_mcs))) 2116 return -ENOBUFS; 2117 2118 return 0; 2119 } 2120 2121 static int 2122 nl80211_send_mgmt_stypes(struct sk_buff *msg, 2123 const struct ieee80211_txrx_stypes *mgmt_stypes) 2124 { 2125 u16 stypes; 2126 struct nlattr *nl_ftypes, *nl_ifs; 2127 enum nl80211_iftype ift; 2128 int i; 2129 2130 if (!mgmt_stypes) 2131 return 0; 2132 2133 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES); 2134 if (!nl_ifs) 2135 return -ENOBUFS; 2136 2137 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2138 nl_ftypes = nla_nest_start_noflag(msg, ift); 2139 if (!nl_ftypes) 2140 return -ENOBUFS; 2141 i = 0; 2142 stypes = mgmt_stypes[ift].tx; 2143 while (stypes) { 2144 if ((stypes & 1) && 2145 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2146 (i << 4) | IEEE80211_FTYPE_MGMT)) 2147 return -ENOBUFS; 2148 stypes >>= 1; 2149 i++; 2150 } 2151 nla_nest_end(msg, nl_ftypes); 2152 } 2153 2154 nla_nest_end(msg, nl_ifs); 2155 2156 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES); 2157 if (!nl_ifs) 2158 return -ENOBUFS; 2159 2160 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2161 nl_ftypes = nla_nest_start_noflag(msg, ift); 2162 if (!nl_ftypes) 2163 return -ENOBUFS; 2164 i = 0; 2165 stypes = mgmt_stypes[ift].rx; 2166 while (stypes) { 2167 if ((stypes & 1) && 2168 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2169 (i << 4) | IEEE80211_FTYPE_MGMT)) 2170 return -ENOBUFS; 2171 stypes >>= 1; 2172 i++; 2173 } 2174 nla_nest_end(msg, nl_ftypes); 2175 } 2176 nla_nest_end(msg, nl_ifs); 2177 2178 return 0; 2179 } 2180 2181 #define CMD(op, n) \ 2182 do { \ 2183 if (rdev->ops->op) { \ 2184 i++; \ 2185 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \ 2186 goto nla_put_failure; \ 2187 } \ 2188 } while (0) 2189 2190 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev, 2191 struct sk_buff *msg) 2192 { 2193 int i = 0; 2194 2195 /* 2196 * do *NOT* add anything into this function, new things need to be 2197 * advertised only to new versions of userspace that can deal with 2198 * the split (and they can't possibly care about new features... 2199 */ 2200 CMD(add_virtual_intf, NEW_INTERFACE); 2201 CMD(change_virtual_intf, SET_INTERFACE); 2202 CMD(add_key, NEW_KEY); 2203 CMD(start_ap, START_AP); 2204 CMD(add_station, NEW_STATION); 2205 CMD(add_mpath, NEW_MPATH); 2206 CMD(update_mesh_config, SET_MESH_CONFIG); 2207 CMD(change_bss, SET_BSS); 2208 CMD(auth, AUTHENTICATE); 2209 CMD(assoc, ASSOCIATE); 2210 CMD(deauth, DEAUTHENTICATE); 2211 CMD(disassoc, DISASSOCIATE); 2212 CMD(join_ibss, JOIN_IBSS); 2213 CMD(join_mesh, JOIN_MESH); 2214 CMD(set_pmksa, SET_PMKSA); 2215 CMD(del_pmksa, DEL_PMKSA); 2216 CMD(flush_pmksa, FLUSH_PMKSA); 2217 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) 2218 CMD(remain_on_channel, REMAIN_ON_CHANNEL); 2219 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK); 2220 CMD(mgmt_tx, FRAME); 2221 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL); 2222 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) { 2223 i++; 2224 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS)) 2225 goto nla_put_failure; 2226 } 2227 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap || 2228 rdev->ops->join_mesh) { 2229 i++; 2230 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL)) 2231 goto nla_put_failure; 2232 } 2233 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) { 2234 CMD(tdls_mgmt, TDLS_MGMT); 2235 CMD(tdls_oper, TDLS_OPER); 2236 } 2237 if (rdev->wiphy.max_sched_scan_reqs) 2238 CMD(sched_scan_start, START_SCHED_SCAN); 2239 CMD(probe_client, PROBE_CLIENT); 2240 CMD(set_noack_map, SET_NOACK_MAP); 2241 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) { 2242 i++; 2243 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS)) 2244 goto nla_put_failure; 2245 } 2246 CMD(start_p2p_device, START_P2P_DEVICE); 2247 CMD(set_mcast_rate, SET_MCAST_RATE); 2248 #ifdef CONFIG_NL80211_TESTMODE 2249 CMD(testmode_cmd, TESTMODE); 2250 #endif 2251 2252 if (rdev->ops->connect || rdev->ops->auth) { 2253 i++; 2254 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT)) 2255 goto nla_put_failure; 2256 } 2257 2258 if (rdev->ops->disconnect || rdev->ops->deauth) { 2259 i++; 2260 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT)) 2261 goto nla_put_failure; 2262 } 2263 2264 return i; 2265 nla_put_failure: 2266 return -ENOBUFS; 2267 } 2268 2269 static int 2270 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap, 2271 struct sk_buff *msg) 2272 { 2273 struct nlattr *ftm; 2274 2275 if (!cap->ftm.supported) 2276 return 0; 2277 2278 ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM); 2279 if (!ftm) 2280 return -ENOBUFS; 2281 2282 if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP)) 2283 return -ENOBUFS; 2284 if (cap->ftm.non_asap && 2285 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP)) 2286 return -ENOBUFS; 2287 if (cap->ftm.request_lci && 2288 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI)) 2289 return -ENOBUFS; 2290 if (cap->ftm.request_civicloc && 2291 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC)) 2292 return -ENOBUFS; 2293 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES, 2294 cap->ftm.preambles)) 2295 return -ENOBUFS; 2296 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS, 2297 cap->ftm.bandwidths)) 2298 return -ENOBUFS; 2299 if (cap->ftm.max_bursts_exponent >= 0 && 2300 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT, 2301 cap->ftm.max_bursts_exponent)) 2302 return -ENOBUFS; 2303 if (cap->ftm.max_ftms_per_burst && 2304 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST, 2305 cap->ftm.max_ftms_per_burst)) 2306 return -ENOBUFS; 2307 if (cap->ftm.trigger_based && 2308 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED)) 2309 return -ENOBUFS; 2310 if (cap->ftm.non_trigger_based && 2311 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED)) 2312 return -ENOBUFS; 2313 2314 nla_nest_end(msg, ftm); 2315 return 0; 2316 } 2317 2318 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev, 2319 struct sk_buff *msg) 2320 { 2321 const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa; 2322 struct nlattr *pmsr, *caps; 2323 2324 if (!cap) 2325 return 0; 2326 2327 /* 2328 * we don't need to clean up anything here since the caller 2329 * will genlmsg_cancel() if we fail 2330 */ 2331 2332 pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS); 2333 if (!pmsr) 2334 return -ENOBUFS; 2335 2336 if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers)) 2337 return -ENOBUFS; 2338 2339 if (cap->report_ap_tsf && 2340 nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF)) 2341 return -ENOBUFS; 2342 2343 if (cap->randomize_mac_addr && 2344 nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR)) 2345 return -ENOBUFS; 2346 2347 caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA); 2348 if (!caps) 2349 return -ENOBUFS; 2350 2351 if (nl80211_send_pmsr_ftm_capa(cap, msg)) 2352 return -ENOBUFS; 2353 2354 nla_nest_end(msg, caps); 2355 nla_nest_end(msg, pmsr); 2356 2357 return 0; 2358 } 2359 2360 static int 2361 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev, 2362 struct sk_buff *msg) 2363 { 2364 int i; 2365 struct nlattr *nested, *nested_akms; 2366 const struct wiphy_iftype_akm_suites *iftype_akms; 2367 2368 if (!rdev->wiphy.num_iftype_akm_suites || 2369 !rdev->wiphy.iftype_akm_suites) 2370 return 0; 2371 2372 nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES); 2373 if (!nested) 2374 return -ENOBUFS; 2375 2376 for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) { 2377 nested_akms = nla_nest_start(msg, i + 1); 2378 if (!nested_akms) 2379 return -ENOBUFS; 2380 2381 iftype_akms = &rdev->wiphy.iftype_akm_suites[i]; 2382 2383 if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES, 2384 iftype_akms->iftypes_mask)) 2385 return -ENOBUFS; 2386 2387 if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES, 2388 sizeof(u32) * iftype_akms->n_akm_suites, 2389 iftype_akms->akm_suites)) { 2390 return -ENOBUFS; 2391 } 2392 nla_nest_end(msg, nested_akms); 2393 } 2394 2395 nla_nest_end(msg, nested); 2396 2397 return 0; 2398 } 2399 2400 static int 2401 nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev, 2402 struct sk_buff *msg) 2403 { 2404 struct nlattr *supp; 2405 2406 if (!rdev->wiphy.tid_config_support.vif && 2407 !rdev->wiphy.tid_config_support.peer) 2408 return 0; 2409 2410 supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG); 2411 if (!supp) 2412 return -ENOSPC; 2413 2414 if (rdev->wiphy.tid_config_support.vif && 2415 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP, 2416 rdev->wiphy.tid_config_support.vif, 2417 NL80211_TID_CONFIG_ATTR_PAD)) 2418 goto fail; 2419 2420 if (rdev->wiphy.tid_config_support.peer && 2421 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP, 2422 rdev->wiphy.tid_config_support.peer, 2423 NL80211_TID_CONFIG_ATTR_PAD)) 2424 goto fail; 2425 2426 /* for now we just use the same value ... makes more sense */ 2427 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT, 2428 rdev->wiphy.tid_config_support.max_retry)) 2429 goto fail; 2430 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG, 2431 rdev->wiphy.tid_config_support.max_retry)) 2432 goto fail; 2433 2434 nla_nest_end(msg, supp); 2435 2436 return 0; 2437 fail: 2438 nla_nest_cancel(msg, supp); 2439 return -ENOBUFS; 2440 } 2441 2442 static int 2443 nl80211_put_sar_specs(struct cfg80211_registered_device *rdev, 2444 struct sk_buff *msg) 2445 { 2446 struct nlattr *sar_capa, *specs, *sub_freq_range; 2447 u8 num_freq_ranges; 2448 int i; 2449 2450 if (!rdev->wiphy.sar_capa) 2451 return 0; 2452 2453 num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges; 2454 2455 sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC); 2456 if (!sar_capa) 2457 return -ENOSPC; 2458 2459 if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type)) 2460 goto fail; 2461 2462 specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS); 2463 if (!specs) 2464 goto fail; 2465 2466 /* report supported freq_ranges */ 2467 for (i = 0; i < num_freq_ranges; i++) { 2468 sub_freq_range = nla_nest_start(msg, i + 1); 2469 if (!sub_freq_range) 2470 goto fail; 2471 2472 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ, 2473 rdev->wiphy.sar_capa->freq_ranges[i].start_freq)) 2474 goto fail; 2475 2476 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ, 2477 rdev->wiphy.sar_capa->freq_ranges[i].end_freq)) 2478 goto fail; 2479 2480 nla_nest_end(msg, sub_freq_range); 2481 } 2482 2483 nla_nest_end(msg, specs); 2484 nla_nest_end(msg, sar_capa); 2485 2486 return 0; 2487 fail: 2488 nla_nest_cancel(msg, sar_capa); 2489 return -ENOBUFS; 2490 } 2491 2492 static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg) 2493 { 2494 struct nlattr *config; 2495 2496 if (!wiphy->mbssid_max_interfaces) 2497 return 0; 2498 2499 config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG); 2500 if (!config) 2501 return -ENOBUFS; 2502 2503 if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES, 2504 wiphy->mbssid_max_interfaces)) 2505 goto fail; 2506 2507 if (wiphy->ema_max_profile_periodicity && 2508 nla_put_u8(msg, 2509 NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY, 2510 wiphy->ema_max_profile_periodicity)) 2511 goto fail; 2512 2513 nla_nest_end(msg, config); 2514 return 0; 2515 2516 fail: 2517 nla_nest_cancel(msg, config); 2518 return -ENOBUFS; 2519 } 2520 2521 static int nl80211_put_radio(struct wiphy *wiphy, struct sk_buff *msg, int idx) 2522 { 2523 const struct wiphy_radio *r = &wiphy->radio[idx]; 2524 const struct wiphy_radio_cfg *rcfg = &wiphy->radio_cfg[idx]; 2525 struct nlattr *radio, *freq; 2526 int i; 2527 2528 radio = nla_nest_start(msg, idx); 2529 if (!radio) 2530 return -ENOBUFS; 2531 2532 if (nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_INDEX, idx)) 2533 goto nla_put_failure; 2534 2535 if (rcfg->rts_threshold && 2536 nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_RTS_THRESHOLD, 2537 rcfg->rts_threshold)) 2538 goto nla_put_failure; 2539 2540 if (r->antenna_mask && 2541 nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_ANTENNA_MASK, 2542 r->antenna_mask)) 2543 goto nla_put_failure; 2544 2545 for (i = 0; i < r->n_freq_range; i++) { 2546 const struct wiphy_radio_freq_range *range = &r->freq_range[i]; 2547 2548 freq = nla_nest_start(msg, NL80211_WIPHY_RADIO_ATTR_FREQ_RANGE); 2549 if (!freq) 2550 goto nla_put_failure; 2551 2552 if (nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_START, 2553 range->start_freq) || 2554 nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_END, 2555 range->end_freq)) 2556 goto nla_put_failure; 2557 2558 nla_nest_end(msg, freq); 2559 } 2560 2561 for (i = 0; i < r->n_iface_combinations; i++) 2562 if (nl80211_put_ifcomb_data(msg, true, 2563 NL80211_WIPHY_RADIO_ATTR_INTERFACE_COMBINATION, 2564 &r->iface_combinations[i], 2565 NLA_F_NESTED)) 2566 goto nla_put_failure; 2567 2568 nla_nest_end(msg, radio); 2569 2570 return 0; 2571 2572 nla_put_failure: 2573 return -ENOBUFS; 2574 } 2575 2576 static int nl80211_put_radios(struct wiphy *wiphy, struct sk_buff *msg) 2577 { 2578 struct nlattr *radios; 2579 int i; 2580 2581 if (!wiphy->n_radio) 2582 return 0; 2583 2584 radios = nla_nest_start(msg, NL80211_ATTR_WIPHY_RADIOS); 2585 if (!radios) 2586 return -ENOBUFS; 2587 2588 for (i = 0; i < wiphy->n_radio; i++) 2589 if (nl80211_put_radio(wiphy, msg, i)) 2590 goto fail; 2591 2592 nla_nest_end(msg, radios); 2593 2594 if (nl80211_put_iface_combinations(wiphy, msg, 2595 NL80211_ATTR_WIPHY_INTERFACE_COMBINATIONS, 2596 -1, true, NLA_F_NESTED)) 2597 return -ENOBUFS; 2598 2599 return 0; 2600 2601 fail: 2602 nla_nest_cancel(msg, radios); 2603 return -ENOBUFS; 2604 } 2605 2606 static int nl80211_put_nan_capa(struct wiphy *wiphy, struct sk_buff *msg) 2607 { 2608 struct nlattr *nan_caps; 2609 2610 nan_caps = nla_nest_start(msg, NL80211_ATTR_NAN_CAPABILITIES); 2611 if (!nan_caps) 2612 return -ENOBUFS; 2613 2614 if (wiphy->nan_capa.flags & WIPHY_NAN_FLAGS_CONFIGURABLE_SYNC && 2615 nla_put_flag(msg, NL80211_NAN_CAPA_CONFIGURABLE_SYNC)) 2616 goto fail; 2617 2618 if ((wiphy->nan_capa.flags & WIPHY_NAN_FLAGS_USERSPACE_DE) && 2619 nla_put_flag(msg, NL80211_NAN_CAPA_USERSPACE_DE)) 2620 goto fail; 2621 2622 if (nla_put_u8(msg, NL80211_NAN_CAPA_OP_MODE, 2623 wiphy->nan_capa.op_mode) || 2624 nla_put_u8(msg, NL80211_NAN_CAPA_NUM_ANTENNAS, 2625 wiphy->nan_capa.n_antennas) || 2626 nla_put_u16(msg, NL80211_NAN_CAPA_MAX_CHANNEL_SWITCH_TIME, 2627 wiphy->nan_capa.max_channel_switch_time) || 2628 nla_put_u8(msg, NL80211_NAN_CAPA_CAPABILITIES, 2629 wiphy->nan_capa.dev_capabilities)) 2630 goto fail; 2631 2632 nla_nest_end(msg, nan_caps); 2633 2634 return 0; 2635 2636 fail: 2637 nla_nest_cancel(msg, nan_caps); 2638 return -ENOBUFS; 2639 } 2640 2641 struct nl80211_dump_wiphy_state { 2642 s64 filter_wiphy; 2643 long start; 2644 long split_start, band_start, chan_start, capa_start; 2645 bool split; 2646 }; 2647 2648 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev, 2649 enum nl80211_commands cmd, 2650 struct sk_buff *msg, u32 portid, u32 seq, 2651 int flags, struct nl80211_dump_wiphy_state *state) 2652 { 2653 void *hdr; 2654 struct nlattr *nl_bands, *nl_band; 2655 struct nlattr *nl_freqs, *nl_freq; 2656 struct nlattr *nl_cmds; 2657 enum nl80211_band band; 2658 struct ieee80211_channel *chan; 2659 int i; 2660 const struct ieee80211_txrx_stypes *mgmt_stypes = 2661 rdev->wiphy.mgmt_stypes; 2662 u32 features; 2663 2664 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 2665 if (!hdr) 2666 return -ENOBUFS; 2667 2668 if (WARN_ON(!state)) 2669 return -EINVAL; 2670 2671 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 2672 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, 2673 wiphy_name(&rdev->wiphy)) || 2674 nla_put_u32(msg, NL80211_ATTR_GENERATION, 2675 cfg80211_rdev_list_generation)) 2676 goto nla_put_failure; 2677 2678 if (cmd != NL80211_CMD_NEW_WIPHY) 2679 goto finish; 2680 2681 switch (state->split_start) { 2682 case 0: 2683 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT, 2684 rdev->wiphy.retry_short) || 2685 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG, 2686 rdev->wiphy.retry_long) || 2687 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD, 2688 rdev->wiphy.frag_threshold) || 2689 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD, 2690 rdev->wiphy.rts_threshold) || 2691 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS, 2692 rdev->wiphy.coverage_class) || 2693 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS, 2694 rdev->wiphy.max_scan_ssids) || 2695 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS, 2696 rdev->wiphy.max_sched_scan_ssids) || 2697 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN, 2698 rdev->wiphy.max_scan_ie_len) || 2699 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN, 2700 rdev->wiphy.max_sched_scan_ie_len) || 2701 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS, 2702 rdev->wiphy.max_match_sets)) 2703 goto nla_put_failure; 2704 2705 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) && 2706 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN)) 2707 goto nla_put_failure; 2708 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) && 2709 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH)) 2710 goto nla_put_failure; 2711 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) && 2712 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD)) 2713 goto nla_put_failure; 2714 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) && 2715 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT)) 2716 goto nla_put_failure; 2717 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) && 2718 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT)) 2719 goto nla_put_failure; 2720 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) && 2721 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP)) 2722 goto nla_put_failure; 2723 state->split_start++; 2724 if (state->split) 2725 break; 2726 fallthrough; 2727 case 1: 2728 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES, 2729 sizeof(u32) * rdev->wiphy.n_cipher_suites, 2730 rdev->wiphy.cipher_suites)) 2731 goto nla_put_failure; 2732 2733 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS, 2734 rdev->wiphy.max_num_pmkids)) 2735 goto nla_put_failure; 2736 2737 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 2738 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE)) 2739 goto nla_put_failure; 2740 2741 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX, 2742 rdev->wiphy.available_antennas_tx) || 2743 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX, 2744 rdev->wiphy.available_antennas_rx)) 2745 goto nla_put_failure; 2746 2747 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) && 2748 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD, 2749 rdev->wiphy.probe_resp_offload)) 2750 goto nla_put_failure; 2751 2752 if ((rdev->wiphy.available_antennas_tx || 2753 rdev->wiphy.available_antennas_rx) && 2754 rdev->ops->get_antenna) { 2755 u32 tx_ant = 0, rx_ant = 0; 2756 int res; 2757 2758 res = rdev_get_antenna(rdev, -1, &tx_ant, &rx_ant); 2759 if (!res) { 2760 if (nla_put_u32(msg, 2761 NL80211_ATTR_WIPHY_ANTENNA_TX, 2762 tx_ant) || 2763 nla_put_u32(msg, 2764 NL80211_ATTR_WIPHY_ANTENNA_RX, 2765 rx_ant)) 2766 goto nla_put_failure; 2767 } 2768 } 2769 2770 state->split_start++; 2771 if (state->split) 2772 break; 2773 fallthrough; 2774 case 2: 2775 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES, 2776 rdev->wiphy.interface_modes)) 2777 goto nla_put_failure; 2778 state->split_start++; 2779 if (state->split) 2780 break; 2781 fallthrough; 2782 case 3: 2783 nl_bands = nla_nest_start_noflag(msg, 2784 NL80211_ATTR_WIPHY_BANDS); 2785 if (!nl_bands) 2786 goto nla_put_failure; 2787 2788 for (band = state->band_start; 2789 band < (state->split ? 2790 NUM_NL80211_BANDS : 2791 NL80211_BAND_60GHZ + 1); 2792 band++) { 2793 struct ieee80211_supported_band *sband; 2794 2795 /* omit higher bands for ancient software */ 2796 if (band > NL80211_BAND_5GHZ && !state->split) 2797 break; 2798 2799 sband = rdev->wiphy.bands[band]; 2800 2801 if (!sband) 2802 continue; 2803 2804 nl_band = nla_nest_start_noflag(msg, band); 2805 if (!nl_band) 2806 goto nla_put_failure; 2807 2808 switch (state->chan_start) { 2809 case 0: 2810 if (nl80211_send_band_rateinfo(msg, sband, 2811 state->split)) 2812 goto nla_put_failure; 2813 state->chan_start++; 2814 if (state->split) 2815 break; 2816 fallthrough; 2817 default: 2818 /* add frequencies */ 2819 nl_freqs = nla_nest_start_noflag(msg, 2820 NL80211_BAND_ATTR_FREQS); 2821 if (!nl_freqs) 2822 goto nla_put_failure; 2823 2824 for (i = state->chan_start - 1; 2825 i < sband->n_channels; 2826 i++) { 2827 nl_freq = nla_nest_start_noflag(msg, 2828 i); 2829 if (!nl_freq) 2830 goto nla_put_failure; 2831 2832 chan = &sband->channels[i]; 2833 2834 if (nl80211_msg_put_channel( 2835 msg, &rdev->wiphy, chan, 2836 state->split)) 2837 goto nla_put_failure; 2838 2839 nla_nest_end(msg, nl_freq); 2840 if (state->split) 2841 break; 2842 } 2843 if (i < sband->n_channels) 2844 state->chan_start = i + 2; 2845 else 2846 state->chan_start = 0; 2847 nla_nest_end(msg, nl_freqs); 2848 } 2849 2850 nla_nest_end(msg, nl_band); 2851 2852 if (state->split) { 2853 /* start again here */ 2854 if (state->chan_start) 2855 band--; 2856 break; 2857 } 2858 } 2859 nla_nest_end(msg, nl_bands); 2860 2861 if (band < NUM_NL80211_BANDS) 2862 state->band_start = band + 1; 2863 else 2864 state->band_start = 0; 2865 2866 /* if bands & channels are done, continue outside */ 2867 if (state->band_start == 0 && state->chan_start == 0) 2868 state->split_start++; 2869 if (state->split) 2870 break; 2871 fallthrough; 2872 case 4: 2873 nl_cmds = nla_nest_start_noflag(msg, 2874 NL80211_ATTR_SUPPORTED_COMMANDS); 2875 if (!nl_cmds) 2876 goto nla_put_failure; 2877 2878 i = nl80211_add_commands_unsplit(rdev, msg); 2879 if (i < 0) 2880 goto nla_put_failure; 2881 if (state->split) { 2882 CMD(crit_proto_start, CRIT_PROTOCOL_START); 2883 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP); 2884 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH) 2885 CMD(channel_switch, CHANNEL_SWITCH); 2886 CMD(set_qos_map, SET_QOS_MAP); 2887 if (rdev->wiphy.features & 2888 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION) 2889 CMD(add_tx_ts, ADD_TX_TS); 2890 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST); 2891 CMD(update_connect_params, UPDATE_CONNECT_PARAMS); 2892 CMD(update_ft_ies, UPDATE_FT_IES); 2893 if (rdev->wiphy.sar_capa) 2894 CMD(set_sar_specs, SET_SAR_SPECS); 2895 CMD(assoc_ml_reconf, ASSOC_MLO_RECONF); 2896 } 2897 #undef CMD 2898 2899 nla_nest_end(msg, nl_cmds); 2900 state->split_start++; 2901 if (state->split) 2902 break; 2903 fallthrough; 2904 case 5: 2905 if (rdev->ops->remain_on_channel && 2906 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) && 2907 nla_put_u32(msg, 2908 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION, 2909 rdev->wiphy.max_remain_on_channel_duration)) 2910 goto nla_put_failure; 2911 2912 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) && 2913 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK)) 2914 goto nla_put_failure; 2915 2916 state->split_start++; 2917 if (state->split) 2918 break; 2919 fallthrough; 2920 case 6: 2921 #ifdef CONFIG_PM 2922 if (nl80211_send_wowlan(msg, rdev, state->split)) 2923 goto nla_put_failure; 2924 state->split_start++; 2925 if (state->split) 2926 break; 2927 #else 2928 state->split_start++; 2929 #endif 2930 fallthrough; 2931 case 7: 2932 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES, 2933 rdev->wiphy.software_iftypes)) 2934 goto nla_put_failure; 2935 2936 if (nl80211_put_iface_combinations(&rdev->wiphy, msg, 2937 NL80211_ATTR_INTERFACE_COMBINATIONS, 2938 rdev->wiphy.n_radio ? 0 : -1, 2939 state->split, 0)) 2940 goto nla_put_failure; 2941 2942 state->split_start++; 2943 if (state->split) 2944 break; 2945 fallthrough; 2946 case 8: 2947 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) && 2948 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME, 2949 rdev->wiphy.ap_sme_capa)) 2950 goto nla_put_failure; 2951 2952 features = rdev->wiphy.features; 2953 /* 2954 * We can only add the per-channel limit information if the 2955 * dump is split, otherwise it makes it too big. Therefore 2956 * only advertise it in that case. 2957 */ 2958 if (state->split) 2959 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS; 2960 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features)) 2961 goto nla_put_failure; 2962 2963 if (rdev->wiphy.ht_capa_mod_mask && 2964 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK, 2965 sizeof(*rdev->wiphy.ht_capa_mod_mask), 2966 rdev->wiphy.ht_capa_mod_mask)) 2967 goto nla_put_failure; 2968 2969 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME && 2970 rdev->wiphy.max_acl_mac_addrs && 2971 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX, 2972 rdev->wiphy.max_acl_mac_addrs)) 2973 goto nla_put_failure; 2974 2975 /* 2976 * Any information below this point is only available to 2977 * applications that can deal with it being split. This 2978 * helps ensure that newly added capabilities don't break 2979 * older tools by overrunning their buffers. 2980 * 2981 * We still increment split_start so that in the split 2982 * case we'll continue with more data in the next round, 2983 * but break unconditionally so unsplit data stops here. 2984 */ 2985 if (state->split) 2986 state->split_start++; 2987 else 2988 state->split_start = 0; 2989 break; 2990 case 9: 2991 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes)) 2992 goto nla_put_failure; 2993 2994 if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS, 2995 rdev->wiphy.max_sched_scan_plans) || 2996 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL, 2997 rdev->wiphy.max_sched_scan_plan_interval) || 2998 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS, 2999 rdev->wiphy.max_sched_scan_plan_iterations)) 3000 goto nla_put_failure; 3001 3002 if (rdev->wiphy.extended_capabilities && 3003 (nla_put(msg, NL80211_ATTR_EXT_CAPA, 3004 rdev->wiphy.extended_capabilities_len, 3005 rdev->wiphy.extended_capabilities) || 3006 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 3007 rdev->wiphy.extended_capabilities_len, 3008 rdev->wiphy.extended_capabilities_mask))) 3009 goto nla_put_failure; 3010 3011 if (rdev->wiphy.vht_capa_mod_mask && 3012 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK, 3013 sizeof(*rdev->wiphy.vht_capa_mod_mask), 3014 rdev->wiphy.vht_capa_mod_mask)) 3015 goto nla_put_failure; 3016 3017 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 3018 rdev->wiphy.perm_addr)) 3019 goto nla_put_failure; 3020 3021 if (!is_zero_ether_addr(rdev->wiphy.addr_mask) && 3022 nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN, 3023 rdev->wiphy.addr_mask)) 3024 goto nla_put_failure; 3025 3026 if (rdev->wiphy.n_addresses > 1) { 3027 void *attr; 3028 3029 attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS); 3030 if (!attr) 3031 goto nla_put_failure; 3032 3033 for (i = 0; i < rdev->wiphy.n_addresses; i++) 3034 if (nla_put(msg, i + 1, ETH_ALEN, 3035 rdev->wiphy.addresses[i].addr)) 3036 goto nla_put_failure; 3037 3038 nla_nest_end(msg, attr); 3039 } 3040 3041 state->split_start++; 3042 break; 3043 case 10: 3044 if (nl80211_send_coalesce(msg, rdev)) 3045 goto nla_put_failure; 3046 3047 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) && 3048 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) || 3049 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ))) 3050 goto nla_put_failure; 3051 3052 if (rdev->wiphy.max_ap_assoc_sta && 3053 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA, 3054 rdev->wiphy.max_ap_assoc_sta)) 3055 goto nla_put_failure; 3056 3057 state->split_start++; 3058 break; 3059 case 11: 3060 if (rdev->wiphy.n_vendor_commands) { 3061 const struct nl80211_vendor_cmd_info *info; 3062 struct nlattr *nested; 3063 3064 nested = nla_nest_start_noflag(msg, 3065 NL80211_ATTR_VENDOR_DATA); 3066 if (!nested) 3067 goto nla_put_failure; 3068 3069 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 3070 info = &rdev->wiphy.vendor_commands[i].info; 3071 if (nla_put(msg, i + 1, sizeof(*info), info)) 3072 goto nla_put_failure; 3073 } 3074 nla_nest_end(msg, nested); 3075 } 3076 3077 if (rdev->wiphy.n_vendor_events) { 3078 const struct nl80211_vendor_cmd_info *info; 3079 struct nlattr *nested; 3080 3081 nested = nla_nest_start_noflag(msg, 3082 NL80211_ATTR_VENDOR_EVENTS); 3083 if (!nested) 3084 goto nla_put_failure; 3085 3086 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) { 3087 info = &rdev->wiphy.vendor_events[i]; 3088 if (nla_put(msg, i + 1, sizeof(*info), info)) 3089 goto nla_put_failure; 3090 } 3091 nla_nest_end(msg, nested); 3092 } 3093 state->split_start++; 3094 break; 3095 case 12: 3096 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH && 3097 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS, 3098 rdev->wiphy.max_num_csa_counters)) 3099 goto nla_put_failure; 3100 3101 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 3102 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 3103 goto nla_put_failure; 3104 3105 if (rdev->wiphy.max_sched_scan_reqs && 3106 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS, 3107 rdev->wiphy.max_sched_scan_reqs)) 3108 goto nla_put_failure; 3109 3110 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES, 3111 sizeof(rdev->wiphy.ext_features), 3112 rdev->wiphy.ext_features)) 3113 goto nla_put_failure; 3114 3115 if (rdev->wiphy.bss_param_support) { 3116 struct nlattr *nested; 3117 u32 parsup = rdev->wiphy.bss_param_support; 3118 3119 nested = nla_nest_start(msg, NL80211_ATTR_BSS_PARAM); 3120 if (!nested) 3121 goto nla_put_failure; 3122 3123 if ((parsup & WIPHY_BSS_PARAM_CTS_PROT) && 3124 nla_put_flag(msg, NL80211_ATTR_BSS_CTS_PROT)) 3125 goto nla_put_failure; 3126 if ((parsup & WIPHY_BSS_PARAM_SHORT_PREAMBLE) && 3127 nla_put_flag(msg, NL80211_ATTR_BSS_SHORT_PREAMBLE)) 3128 goto nla_put_failure; 3129 if ((parsup & WIPHY_BSS_PARAM_SHORT_SLOT_TIME) && 3130 nla_put_flag(msg, NL80211_ATTR_BSS_SHORT_SLOT_TIME)) 3131 goto nla_put_failure; 3132 if ((parsup & WIPHY_BSS_PARAM_BASIC_RATES) && 3133 nla_put_flag(msg, NL80211_ATTR_BSS_BASIC_RATES)) 3134 goto nla_put_failure; 3135 if ((parsup & WIPHY_BSS_PARAM_AP_ISOLATE) && 3136 nla_put_flag(msg, NL80211_ATTR_AP_ISOLATE)) 3137 goto nla_put_failure; 3138 if ((parsup & WIPHY_BSS_PARAM_HT_OPMODE) && 3139 nla_put_flag(msg, NL80211_ATTR_BSS_HT_OPMODE)) 3140 goto nla_put_failure; 3141 if ((parsup & WIPHY_BSS_PARAM_P2P_CTWINDOW) && 3142 nla_put_flag(msg, NL80211_ATTR_P2P_CTWINDOW)) 3143 goto nla_put_failure; 3144 if ((parsup & WIPHY_BSS_PARAM_P2P_OPPPS) && 3145 nla_put_flag(msg, NL80211_ATTR_P2P_OPPPS)) 3146 goto nla_put_failure; 3147 nla_nest_end(msg, nested); 3148 } 3149 if (rdev->wiphy.bss_select_support) { 3150 struct nlattr *nested; 3151 u32 bss_select_support = rdev->wiphy.bss_select_support; 3152 3153 nested = nla_nest_start_noflag(msg, 3154 NL80211_ATTR_BSS_SELECT); 3155 if (!nested) 3156 goto nla_put_failure; 3157 3158 i = 0; 3159 while (bss_select_support) { 3160 if ((bss_select_support & 1) && 3161 nla_put_flag(msg, i)) 3162 goto nla_put_failure; 3163 i++; 3164 bss_select_support >>= 1; 3165 } 3166 nla_nest_end(msg, nested); 3167 } 3168 3169 state->split_start++; 3170 break; 3171 case 13: 3172 if (rdev->wiphy.num_iftype_ext_capab && 3173 rdev->wiphy.iftype_ext_capab) { 3174 struct nlattr *nested_ext_capab, *nested; 3175 3176 nested = nla_nest_start_noflag(msg, 3177 NL80211_ATTR_IFTYPE_EXT_CAPA); 3178 if (!nested) 3179 goto nla_put_failure; 3180 3181 for (i = state->capa_start; 3182 i < rdev->wiphy.num_iftype_ext_capab; i++) { 3183 const struct wiphy_iftype_ext_capab *capab; 3184 3185 capab = &rdev->wiphy.iftype_ext_capab[i]; 3186 3187 nested_ext_capab = nla_nest_start_noflag(msg, 3188 i); 3189 if (!nested_ext_capab || 3190 nla_put_u32(msg, NL80211_ATTR_IFTYPE, 3191 capab->iftype) || 3192 nla_put(msg, NL80211_ATTR_EXT_CAPA, 3193 capab->extended_capabilities_len, 3194 capab->extended_capabilities) || 3195 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 3196 capab->extended_capabilities_len, 3197 capab->extended_capabilities_mask)) 3198 goto nla_put_failure; 3199 3200 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO && 3201 (nla_put_u16(msg, 3202 NL80211_ATTR_EML_CAPABILITY, 3203 capab->eml_capabilities) || 3204 nla_put_u16(msg, 3205 NL80211_ATTR_MLD_CAPA_AND_OPS, 3206 capab->mld_capa_and_ops))) 3207 goto nla_put_failure; 3208 3209 nla_nest_end(msg, nested_ext_capab); 3210 if (state->split) 3211 break; 3212 } 3213 nla_nest_end(msg, nested); 3214 if (i < rdev->wiphy.num_iftype_ext_capab) { 3215 state->capa_start = i + 1; 3216 break; 3217 } 3218 } 3219 3220 if (nla_put_u32(msg, NL80211_ATTR_BANDS, 3221 rdev->wiphy.nan_supported_bands)) 3222 goto nla_put_failure; 3223 3224 if (wiphy_ext_feature_isset(&rdev->wiphy, 3225 NL80211_EXT_FEATURE_TXQS)) { 3226 struct cfg80211_txq_stats txqstats = {}; 3227 int res; 3228 3229 res = rdev_get_txq_stats(rdev, NULL, &txqstats); 3230 if (!res && 3231 !nl80211_put_txq_stats(msg, &txqstats, 3232 NL80211_ATTR_TXQ_STATS)) 3233 goto nla_put_failure; 3234 3235 if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT, 3236 rdev->wiphy.txq_limit)) 3237 goto nla_put_failure; 3238 if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT, 3239 rdev->wiphy.txq_memory_limit)) 3240 goto nla_put_failure; 3241 if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM, 3242 rdev->wiphy.txq_quantum)) 3243 goto nla_put_failure; 3244 } 3245 3246 state->split_start++; 3247 break; 3248 case 14: 3249 if (nl80211_send_pmsr_capa(rdev, msg)) 3250 goto nla_put_failure; 3251 3252 state->split_start++; 3253 break; 3254 case 15: 3255 if (rdev->wiphy.akm_suites && 3256 nla_put(msg, NL80211_ATTR_AKM_SUITES, 3257 sizeof(u32) * rdev->wiphy.n_akm_suites, 3258 rdev->wiphy.akm_suites)) 3259 goto nla_put_failure; 3260 3261 if (nl80211_put_iftype_akm_suites(rdev, msg)) 3262 goto nla_put_failure; 3263 3264 if (nl80211_put_tid_config_support(rdev, msg)) 3265 goto nla_put_failure; 3266 state->split_start++; 3267 break; 3268 case 16: 3269 if (nl80211_put_sar_specs(rdev, msg)) 3270 goto nla_put_failure; 3271 3272 if (nl80211_put_mbssid_support(&rdev->wiphy, msg)) 3273 goto nla_put_failure; 3274 3275 if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES, 3276 rdev->wiphy.max_num_akm_suites)) 3277 goto nla_put_failure; 3278 3279 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO) 3280 nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT); 3281 3282 if (rdev->wiphy.hw_timestamp_max_peers && 3283 nla_put_u16(msg, NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS, 3284 rdev->wiphy.hw_timestamp_max_peers)) 3285 goto nla_put_failure; 3286 3287 state->split_start++; 3288 break; 3289 case 17: 3290 if (nl80211_put_radios(&rdev->wiphy, msg)) 3291 goto nla_put_failure; 3292 3293 state->split_start++; 3294 break; 3295 case 18: 3296 if (nl80211_put_nan_capa(&rdev->wiphy, msg)) 3297 goto nla_put_failure; 3298 3299 /* done */ 3300 state->split_start = 0; 3301 break; 3302 } 3303 finish: 3304 genlmsg_end(msg, hdr); 3305 return 0; 3306 3307 nla_put_failure: 3308 genlmsg_cancel(msg, hdr); 3309 return -EMSGSIZE; 3310 } 3311 3312 static int nl80211_dump_wiphy_parse(struct sk_buff *skb, 3313 struct netlink_callback *cb, 3314 struct nl80211_dump_wiphy_state *state) 3315 { 3316 struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 3317 int ret; 3318 3319 if (!tb) 3320 return -ENOMEM; 3321 3322 ret = nlmsg_parse_deprecated(cb->nlh, 3323 GENL_HDRLEN + nl80211_fam.hdrsize, 3324 tb, nl80211_fam.maxattr, 3325 nl80211_policy, NULL); 3326 /* ignore parse errors for backward compatibility */ 3327 if (ret) { 3328 ret = 0; 3329 goto out; 3330 } 3331 3332 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP]; 3333 if (tb[NL80211_ATTR_WIPHY]) 3334 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]); 3335 if (tb[NL80211_ATTR_WDEV]) 3336 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32; 3337 if (tb[NL80211_ATTR_IFINDEX]) { 3338 struct net_device *netdev; 3339 struct cfg80211_registered_device *rdev; 3340 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]); 3341 3342 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx); 3343 if (!netdev) { 3344 ret = -ENODEV; 3345 goto out; 3346 } 3347 if (netdev->ieee80211_ptr) { 3348 rdev = wiphy_to_rdev( 3349 netdev->ieee80211_ptr->wiphy); 3350 state->filter_wiphy = rdev->wiphy_idx; 3351 } 3352 } 3353 3354 ret = 0; 3355 out: 3356 kfree(tb); 3357 return ret; 3358 } 3359 3360 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb) 3361 { 3362 int idx = 0, ret; 3363 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0]; 3364 struct cfg80211_registered_device *rdev; 3365 3366 rtnl_lock(); 3367 if (!state) { 3368 state = kzalloc(sizeof(*state), GFP_KERNEL); 3369 if (!state) { 3370 rtnl_unlock(); 3371 return -ENOMEM; 3372 } 3373 state->filter_wiphy = -1; 3374 ret = nl80211_dump_wiphy_parse(skb, cb, state); 3375 if (ret) { 3376 kfree(state); 3377 rtnl_unlock(); 3378 return ret; 3379 } 3380 cb->args[0] = (long)state; 3381 } 3382 3383 for_each_rdev(rdev) { 3384 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 3385 continue; 3386 if (++idx <= state->start) 3387 continue; 3388 if (state->filter_wiphy != -1 && 3389 state->filter_wiphy != rdev->wiphy_idx) 3390 continue; 3391 wiphy_lock(&rdev->wiphy); 3392 /* attempt to fit multiple wiphy data chunks into the skb */ 3393 do { 3394 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, 3395 skb, 3396 NETLINK_CB(cb->skb).portid, 3397 cb->nlh->nlmsg_seq, 3398 NLM_F_MULTI, state); 3399 if (ret < 0) { 3400 /* 3401 * If sending the wiphy data didn't fit (ENOBUFS 3402 * or EMSGSIZE returned), this SKB is still 3403 * empty (so it's not too big because another 3404 * wiphy dataset is already in the skb) and 3405 * we've not tried to adjust the dump allocation 3406 * yet ... then adjust the alloc size to be 3407 * bigger, and return 1 but with the empty skb. 3408 * This results in an empty message being RX'ed 3409 * in userspace, but that is ignored. 3410 * 3411 * We can then retry with the larger buffer. 3412 */ 3413 if ((ret == -ENOBUFS || ret == -EMSGSIZE) && 3414 !skb->len && !state->split && 3415 cb->min_dump_alloc < 4096) { 3416 cb->min_dump_alloc = 4096; 3417 state->split_start = 0; 3418 wiphy_unlock(&rdev->wiphy); 3419 rtnl_unlock(); 3420 return 1; 3421 } 3422 idx--; 3423 break; 3424 } 3425 } while (state->split_start > 0); 3426 wiphy_unlock(&rdev->wiphy); 3427 break; 3428 } 3429 rtnl_unlock(); 3430 3431 state->start = idx; 3432 3433 return skb->len; 3434 } 3435 3436 static int nl80211_dump_wiphy_done(struct netlink_callback *cb) 3437 { 3438 kfree((void *)cb->args[0]); 3439 return 0; 3440 } 3441 3442 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info) 3443 { 3444 struct sk_buff *msg; 3445 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3446 struct nl80211_dump_wiphy_state state = {}; 3447 3448 msg = nlmsg_new(4096, GFP_KERNEL); 3449 if (!msg) 3450 return -ENOMEM; 3451 3452 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg, 3453 info->snd_portid, info->snd_seq, 0, 3454 &state) < 0) { 3455 nlmsg_free(msg); 3456 return -ENOBUFS; 3457 } 3458 3459 return genlmsg_reply(msg, info); 3460 } 3461 3462 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = { 3463 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 }, 3464 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 }, 3465 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 }, 3466 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 }, 3467 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 }, 3468 }; 3469 3470 static int parse_txq_params(struct nlattr *tb[], 3471 struct ieee80211_txq_params *txq_params) 3472 { 3473 u8 ac; 3474 3475 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] || 3476 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] || 3477 !tb[NL80211_TXQ_ATTR_AIFS]) 3478 return -EINVAL; 3479 3480 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]); 3481 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]); 3482 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]); 3483 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]); 3484 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]); 3485 3486 if (ac >= NL80211_NUM_ACS) 3487 return -EINVAL; 3488 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS); 3489 return 0; 3490 } 3491 3492 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev) 3493 { 3494 /* 3495 * You can only set the channel explicitly for some interfaces, 3496 * most have their channel managed via their respective 3497 * "establish a connection" command (connect, join, ...) 3498 * 3499 * For AP/GO and mesh mode, the channel can be set with the 3500 * channel userspace API, but is only stored and passed to the 3501 * low-level driver when the AP starts or the mesh is joined. 3502 * This is for backward compatibility, userspace can also give 3503 * the channel in the start-ap or join-mesh commands instead. 3504 * 3505 * Monitors are special as they are normally slaved to 3506 * whatever else is going on, so they have their own special 3507 * operation to set the monitor channel if possible. 3508 */ 3509 return !wdev || 3510 wdev->iftype == NL80211_IFTYPE_AP || 3511 wdev->iftype == NL80211_IFTYPE_MESH_POINT || 3512 wdev->iftype == NL80211_IFTYPE_MONITOR || 3513 wdev->iftype == NL80211_IFTYPE_P2P_GO; 3514 } 3515 3516 static int _nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3517 struct genl_info *info, bool monitor, 3518 struct cfg80211_chan_def *chandef) 3519 { 3520 struct netlink_ext_ack *extack = info->extack; 3521 struct nlattr **attrs = info->attrs; 3522 u32 control_freq; 3523 3524 if (!attrs[NL80211_ATTR_WIPHY_FREQ]) { 3525 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3526 "Frequency is missing"); 3527 return -EINVAL; 3528 } 3529 3530 control_freq = MHZ_TO_KHZ( 3531 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 3532 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 3533 control_freq += 3534 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 3535 3536 memset(chandef, 0, sizeof(*chandef)); 3537 chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq); 3538 chandef->width = NL80211_CHAN_WIDTH_20_NOHT; 3539 chandef->center_freq1 = KHZ_TO_MHZ(control_freq); 3540 chandef->freq1_offset = control_freq % 1000; 3541 chandef->center_freq2 = 0; 3542 chandef->s1g_primary_2mhz = false; 3543 3544 if (!chandef->chan) { 3545 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3546 "Unknown channel"); 3547 return -EINVAL; 3548 } 3549 3550 if (cfg80211_chandef_is_s1g(chandef)) 3551 chandef->width = NL80211_CHAN_WIDTH_1; 3552 3553 if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) { 3554 enum nl80211_channel_type chantype; 3555 3556 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]); 3557 3558 switch (chantype) { 3559 case NL80211_CHAN_NO_HT: 3560 case NL80211_CHAN_HT20: 3561 case NL80211_CHAN_HT40PLUS: 3562 case NL80211_CHAN_HT40MINUS: 3563 cfg80211_chandef_create(chandef, chandef->chan, 3564 chantype); 3565 /* user input for center_freq is incorrect */ 3566 if (attrs[NL80211_ATTR_CENTER_FREQ1] && 3567 chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) { 3568 NL_SET_ERR_MSG_ATTR(extack, 3569 attrs[NL80211_ATTR_CENTER_FREQ1], 3570 "bad center frequency 1"); 3571 return -EINVAL; 3572 } 3573 /* center_freq2 must be zero */ 3574 if (attrs[NL80211_ATTR_CENTER_FREQ2] && 3575 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) { 3576 NL_SET_ERR_MSG_ATTR(extack, 3577 attrs[NL80211_ATTR_CENTER_FREQ2], 3578 "center frequency 2 can't be used"); 3579 return -EINVAL; 3580 } 3581 break; 3582 default: 3583 NL_SET_ERR_MSG_ATTR(extack, 3584 attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE], 3585 "invalid channel type"); 3586 return -EINVAL; 3587 } 3588 } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) { 3589 chandef->width = nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]); 3590 if (attrs[NL80211_ATTR_CENTER_FREQ1]) { 3591 chandef->center_freq1 = 3592 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]); 3593 chandef->freq1_offset = nla_get_u32_default( 3594 attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET], 0); 3595 } 3596 3597 if (attrs[NL80211_ATTR_CENTER_FREQ2]) 3598 chandef->center_freq2 = 3599 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]); 3600 3601 chandef->s1g_primary_2mhz = nla_get_flag( 3602 attrs[NL80211_ATTR_S1G_PRIMARY_2MHZ]); 3603 } 3604 3605 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 3606 chandef->edmg.channels = 3607 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 3608 3609 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 3610 chandef->edmg.bw_config = 3611 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 3612 } else { 3613 chandef->edmg.bw_config = 0; 3614 chandef->edmg.channels = 0; 3615 } 3616 3617 if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) { 3618 chandef->punctured = 3619 nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]); 3620 3621 if (chandef->punctured && 3622 !wiphy_ext_feature_isset(&rdev->wiphy, 3623 NL80211_EXT_FEATURE_PUNCT)) { 3624 NL_SET_ERR_MSG(extack, 3625 "driver doesn't support puncturing"); 3626 return -EINVAL; 3627 } 3628 } 3629 3630 if (!cfg80211_chandef_valid(chandef)) { 3631 NL_SET_ERR_MSG(extack, "invalid channel definition"); 3632 return -EINVAL; 3633 } 3634 3635 if (!_cfg80211_chandef_usable(&rdev->wiphy, chandef, 3636 IEEE80211_CHAN_DISABLED, 3637 monitor ? IEEE80211_CHAN_CAN_MONITOR : 0)) { 3638 NL_SET_ERR_MSG(extack, "(extension) channel is disabled"); 3639 return -EINVAL; 3640 } 3641 3642 if ((chandef->width == NL80211_CHAN_WIDTH_5 || 3643 chandef->width == NL80211_CHAN_WIDTH_10) && 3644 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) { 3645 NL_SET_ERR_MSG(extack, "5/10 MHz not supported"); 3646 return -EINVAL; 3647 } 3648 3649 return 0; 3650 } 3651 3652 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3653 struct genl_info *info, 3654 struct cfg80211_chan_def *chandef) 3655 { 3656 return _nl80211_parse_chandef(rdev, info, false, chandef); 3657 } 3658 3659 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev, 3660 struct net_device *dev, 3661 struct genl_info *info, 3662 int _link_id) 3663 { 3664 struct cfg80211_chan_def chandef; 3665 int result; 3666 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR; 3667 struct wireless_dev *wdev = NULL; 3668 int link_id = _link_id; 3669 3670 if (dev) 3671 wdev = dev->ieee80211_ptr; 3672 if (!nl80211_can_set_dev_channel(wdev)) 3673 return -EOPNOTSUPP; 3674 if (wdev) 3675 iftype = wdev->iftype; 3676 3677 if (link_id < 0) { 3678 if (wdev && wdev->valid_links) 3679 return -EINVAL; 3680 link_id = 0; 3681 } 3682 3683 result = _nl80211_parse_chandef(rdev, info, 3684 iftype == NL80211_IFTYPE_MONITOR, 3685 &chandef); 3686 if (result) 3687 return result; 3688 3689 switch (iftype) { 3690 case NL80211_IFTYPE_AP: 3691 case NL80211_IFTYPE_P2P_GO: 3692 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 3693 iftype)) 3694 return -EINVAL; 3695 if (wdev->links[link_id].ap.beacon_interval) { 3696 struct ieee80211_channel *cur_chan; 3697 3698 if (!dev || !rdev->ops->set_ap_chanwidth || 3699 !(rdev->wiphy.features & 3700 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) 3701 return -EBUSY; 3702 3703 /* Only allow dynamic channel width changes */ 3704 cur_chan = wdev->links[link_id].ap.chandef.chan; 3705 if (chandef.chan != cur_chan) 3706 return -EBUSY; 3707 3708 /* only allow this for regular channel widths */ 3709 switch (wdev->links[link_id].ap.chandef.width) { 3710 case NL80211_CHAN_WIDTH_20_NOHT: 3711 case NL80211_CHAN_WIDTH_20: 3712 case NL80211_CHAN_WIDTH_40: 3713 case NL80211_CHAN_WIDTH_80: 3714 case NL80211_CHAN_WIDTH_80P80: 3715 case NL80211_CHAN_WIDTH_160: 3716 case NL80211_CHAN_WIDTH_320: 3717 break; 3718 default: 3719 return -EINVAL; 3720 } 3721 3722 switch (chandef.width) { 3723 case NL80211_CHAN_WIDTH_20_NOHT: 3724 case NL80211_CHAN_WIDTH_20: 3725 case NL80211_CHAN_WIDTH_40: 3726 case NL80211_CHAN_WIDTH_80: 3727 case NL80211_CHAN_WIDTH_80P80: 3728 case NL80211_CHAN_WIDTH_160: 3729 case NL80211_CHAN_WIDTH_320: 3730 break; 3731 default: 3732 return -EINVAL; 3733 } 3734 3735 result = rdev_set_ap_chanwidth(rdev, dev, link_id, 3736 &chandef); 3737 if (result) 3738 return result; 3739 wdev->links[link_id].ap.chandef = chandef; 3740 } else { 3741 wdev->u.ap.preset_chandef = chandef; 3742 } 3743 return 0; 3744 case NL80211_IFTYPE_MESH_POINT: 3745 return cfg80211_set_mesh_channel(rdev, wdev, &chandef); 3746 case NL80211_IFTYPE_MONITOR: 3747 return cfg80211_set_monitor_channel(rdev, dev, &chandef); 3748 default: 3749 break; 3750 } 3751 3752 return -EINVAL; 3753 } 3754 3755 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info) 3756 { 3757 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3758 int link_id = nl80211_link_id_or_invalid(info->attrs); 3759 struct net_device *netdev = info->user_ptr[1]; 3760 3761 return __nl80211_set_channel(rdev, netdev, info, link_id); 3762 } 3763 3764 static int nl80211_set_wiphy_radio(struct genl_info *info, 3765 struct cfg80211_registered_device *rdev, 3766 int radio_idx) 3767 { 3768 u32 rts_threshold = 0, old_rts, changed = 0; 3769 int result; 3770 3771 if (!rdev->ops->set_wiphy_params) 3772 return -EOPNOTSUPP; 3773 3774 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3775 rts_threshold = nla_get_u32( 3776 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3777 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3778 } 3779 3780 old_rts = rdev->wiphy.radio_cfg[radio_idx].rts_threshold; 3781 3782 rdev->wiphy.radio_cfg[radio_idx].rts_threshold = rts_threshold; 3783 3784 result = rdev_set_wiphy_params(rdev, radio_idx, changed); 3785 if (result) 3786 rdev->wiphy.radio_cfg[radio_idx].rts_threshold = old_rts; 3787 3788 return 0; 3789 } 3790 3791 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info) 3792 { 3793 struct cfg80211_registered_device *rdev = NULL; 3794 struct net_device *netdev = NULL; 3795 struct wireless_dev *wdev; 3796 int result = 0, rem_txq_params = 0; 3797 struct nlattr *nl_txq_params; 3798 u32 changed; 3799 u8 retry_short = 0, retry_long = 0; 3800 u32 frag_threshold = 0, rts_threshold = 0; 3801 u8 coverage_class = 0; 3802 u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0; 3803 int radio_idx = -1; 3804 3805 rtnl_lock(); 3806 /* 3807 * Try to find the wiphy and netdev. Normally this 3808 * function shouldn't need the netdev, but this is 3809 * done for backward compatibility -- previously 3810 * setting the channel was done per wiphy, but now 3811 * it is per netdev. Previous userland like hostapd 3812 * also passed a netdev to set_wiphy, so that it is 3813 * possible to let that go to the right netdev! 3814 */ 3815 3816 if (info->attrs[NL80211_ATTR_IFINDEX]) { 3817 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]); 3818 3819 netdev = __dev_get_by_index(genl_info_net(info), ifindex); 3820 if (netdev && netdev->ieee80211_ptr) 3821 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy); 3822 else 3823 netdev = NULL; 3824 } 3825 3826 if (!netdev) { 3827 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info), 3828 info->attrs); 3829 if (IS_ERR(rdev)) { 3830 rtnl_unlock(); 3831 return PTR_ERR(rdev); 3832 } 3833 wdev = NULL; 3834 netdev = NULL; 3835 result = 0; 3836 } else 3837 wdev = netdev->ieee80211_ptr; 3838 3839 guard(wiphy)(&rdev->wiphy); 3840 3841 /* 3842 * end workaround code, by now the rdev is available 3843 * and locked, and wdev may or may not be NULL. 3844 */ 3845 3846 if (info->attrs[NL80211_ATTR_WIPHY_NAME]) 3847 result = cfg80211_dev_rename( 3848 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME])); 3849 rtnl_unlock(); 3850 3851 if (result) 3852 return result; 3853 3854 if (info->attrs[NL80211_ATTR_WIPHY_RADIO_INDEX]) { 3855 /* Radio idx is not expected for non-multi radio wiphy */ 3856 if (rdev->wiphy.n_radio <= 0) 3857 return -EINVAL; 3858 3859 radio_idx = nla_get_u8( 3860 info->attrs[NL80211_ATTR_WIPHY_RADIO_INDEX]); 3861 if (radio_idx >= rdev->wiphy.n_radio) 3862 return -EINVAL; 3863 3864 return nl80211_set_wiphy_radio(info, rdev, radio_idx); 3865 } 3866 3867 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) { 3868 struct ieee80211_txq_params txq_params; 3869 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1]; 3870 3871 if (!rdev->ops->set_txq_params) 3872 return -EOPNOTSUPP; 3873 3874 if (!netdev) 3875 return -EINVAL; 3876 3877 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 3878 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 3879 return -EINVAL; 3880 3881 if (!netif_running(netdev)) 3882 return -ENETDOWN; 3883 3884 nla_for_each_nested(nl_txq_params, 3885 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS], 3886 rem_txq_params) { 3887 result = nla_parse_nested_deprecated(tb, 3888 NL80211_TXQ_ATTR_MAX, 3889 nl_txq_params, 3890 txq_params_policy, 3891 info->extack); 3892 if (result) 3893 return result; 3894 3895 result = parse_txq_params(tb, &txq_params); 3896 if (result) 3897 return result; 3898 3899 txq_params.link_id = 3900 nl80211_link_id_or_invalid(info->attrs); 3901 3902 if (txq_params.link_id >= 0 && 3903 !(netdev->ieee80211_ptr->valid_links & 3904 BIT(txq_params.link_id))) 3905 result = -ENOLINK; 3906 else if (txq_params.link_id >= 0 && 3907 !netdev->ieee80211_ptr->valid_links) 3908 result = -EINVAL; 3909 else 3910 result = rdev_set_txq_params(rdev, netdev, 3911 &txq_params); 3912 if (result) 3913 return result; 3914 } 3915 } 3916 3917 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 3918 int link_id = nl80211_link_id_or_invalid(info->attrs); 3919 3920 if (wdev) { 3921 result = __nl80211_set_channel( 3922 rdev, 3923 nl80211_can_set_dev_channel(wdev) ? netdev : NULL, 3924 info, link_id); 3925 } else { 3926 result = __nl80211_set_channel(rdev, netdev, info, link_id); 3927 } 3928 3929 if (result) 3930 return result; 3931 } 3932 3933 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) { 3934 struct wireless_dev *txp_wdev = wdev; 3935 enum nl80211_tx_power_setting type; 3936 int idx, mbm = 0; 3937 3938 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER)) 3939 txp_wdev = NULL; 3940 3941 if (!rdev->ops->set_tx_power) 3942 return -EOPNOTSUPP; 3943 3944 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING; 3945 type = nla_get_u32(info->attrs[idx]); 3946 3947 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] && 3948 (type != NL80211_TX_POWER_AUTOMATIC)) 3949 return -EINVAL; 3950 3951 if (type != NL80211_TX_POWER_AUTOMATIC) { 3952 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL; 3953 mbm = nla_get_u32(info->attrs[idx]); 3954 } 3955 3956 result = rdev_set_tx_power(rdev, txp_wdev, radio_idx, type, 3957 mbm); 3958 if (result) 3959 return result; 3960 } 3961 3962 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] && 3963 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) { 3964 u32 tx_ant, rx_ant; 3965 3966 if ((!rdev->wiphy.available_antennas_tx && 3967 !rdev->wiphy.available_antennas_rx) || 3968 !rdev->ops->set_antenna) 3969 return -EOPNOTSUPP; 3970 3971 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]); 3972 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]); 3973 3974 /* reject antenna configurations which don't match the 3975 * available antenna masks, except for the "all" mask */ 3976 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) || 3977 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) 3978 return -EINVAL; 3979 3980 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx; 3981 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx; 3982 3983 result = rdev_set_antenna(rdev, radio_idx, tx_ant, rx_ant); 3984 if (result) 3985 return result; 3986 } 3987 3988 changed = 0; 3989 3990 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) { 3991 retry_short = nla_get_u8( 3992 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]); 3993 3994 changed |= WIPHY_PARAM_RETRY_SHORT; 3995 } 3996 3997 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) { 3998 retry_long = nla_get_u8( 3999 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]); 4000 4001 changed |= WIPHY_PARAM_RETRY_LONG; 4002 } 4003 4004 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) { 4005 frag_threshold = nla_get_u32( 4006 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]); 4007 if (frag_threshold < 256) 4008 return -EINVAL; 4009 4010 if (frag_threshold != (u32) -1) { 4011 /* 4012 * Fragments (apart from the last one) are required to 4013 * have even length. Make the fragmentation code 4014 * simpler by stripping LSB should someone try to use 4015 * odd threshold value. 4016 */ 4017 frag_threshold &= ~0x1; 4018 } 4019 changed |= WIPHY_PARAM_FRAG_THRESHOLD; 4020 } 4021 4022 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 4023 rts_threshold = nla_get_u32( 4024 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 4025 changed |= WIPHY_PARAM_RTS_THRESHOLD; 4026 } 4027 4028 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) { 4029 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) 4030 return -EINVAL; 4031 4032 coverage_class = nla_get_u8( 4033 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]); 4034 changed |= WIPHY_PARAM_COVERAGE_CLASS; 4035 } 4036 4037 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 4038 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) 4039 return -EOPNOTSUPP; 4040 4041 changed |= WIPHY_PARAM_DYN_ACK; 4042 } 4043 4044 if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) { 4045 if (!wiphy_ext_feature_isset(&rdev->wiphy, 4046 NL80211_EXT_FEATURE_TXQS)) 4047 return -EOPNOTSUPP; 4048 4049 txq_limit = nla_get_u32( 4050 info->attrs[NL80211_ATTR_TXQ_LIMIT]); 4051 changed |= WIPHY_PARAM_TXQ_LIMIT; 4052 } 4053 4054 if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) { 4055 if (!wiphy_ext_feature_isset(&rdev->wiphy, 4056 NL80211_EXT_FEATURE_TXQS)) 4057 return -EOPNOTSUPP; 4058 4059 txq_memory_limit = nla_get_u32( 4060 info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]); 4061 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT; 4062 } 4063 4064 if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) { 4065 if (!wiphy_ext_feature_isset(&rdev->wiphy, 4066 NL80211_EXT_FEATURE_TXQS)) 4067 return -EOPNOTSUPP; 4068 4069 txq_quantum = nla_get_u32( 4070 info->attrs[NL80211_ATTR_TXQ_QUANTUM]); 4071 changed |= WIPHY_PARAM_TXQ_QUANTUM; 4072 } 4073 4074 if (changed) { 4075 u8 old_retry_short, old_retry_long; 4076 u32 old_frag_threshold, old_rts_threshold; 4077 u8 old_coverage_class, i; 4078 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum; 4079 u32 *old_radio_rts_threshold = NULL; 4080 4081 if (!rdev->ops->set_wiphy_params) 4082 return -EOPNOTSUPP; 4083 4084 if (rdev->wiphy.n_radio) { 4085 old_radio_rts_threshold = kcalloc(rdev->wiphy.n_radio, 4086 sizeof(u32), 4087 GFP_KERNEL); 4088 if (!old_radio_rts_threshold) 4089 return -ENOMEM; 4090 } 4091 4092 old_retry_short = rdev->wiphy.retry_short; 4093 old_retry_long = rdev->wiphy.retry_long; 4094 old_frag_threshold = rdev->wiphy.frag_threshold; 4095 old_rts_threshold = rdev->wiphy.rts_threshold; 4096 if (old_radio_rts_threshold) { 4097 for (i = 0 ; i < rdev->wiphy.n_radio; i++) 4098 old_radio_rts_threshold[i] = 4099 rdev->wiphy.radio_cfg[i].rts_threshold; 4100 } 4101 old_coverage_class = rdev->wiphy.coverage_class; 4102 old_txq_limit = rdev->wiphy.txq_limit; 4103 old_txq_memory_limit = rdev->wiphy.txq_memory_limit; 4104 old_txq_quantum = rdev->wiphy.txq_quantum; 4105 4106 if (changed & WIPHY_PARAM_RETRY_SHORT) 4107 rdev->wiphy.retry_short = retry_short; 4108 if (changed & WIPHY_PARAM_RETRY_LONG) 4109 rdev->wiphy.retry_long = retry_long; 4110 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) 4111 rdev->wiphy.frag_threshold = frag_threshold; 4112 if ((changed & WIPHY_PARAM_RTS_THRESHOLD) && 4113 old_radio_rts_threshold) { 4114 rdev->wiphy.rts_threshold = rts_threshold; 4115 for (i = 0 ; i < rdev->wiphy.n_radio; i++) 4116 rdev->wiphy.radio_cfg[i].rts_threshold = 4117 rdev->wiphy.rts_threshold; 4118 } 4119 if (changed & WIPHY_PARAM_COVERAGE_CLASS) 4120 rdev->wiphy.coverage_class = coverage_class; 4121 if (changed & WIPHY_PARAM_TXQ_LIMIT) 4122 rdev->wiphy.txq_limit = txq_limit; 4123 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT) 4124 rdev->wiphy.txq_memory_limit = txq_memory_limit; 4125 if (changed & WIPHY_PARAM_TXQ_QUANTUM) 4126 rdev->wiphy.txq_quantum = txq_quantum; 4127 4128 result = rdev_set_wiphy_params(rdev, radio_idx, changed); 4129 if (result) { 4130 rdev->wiphy.retry_short = old_retry_short; 4131 rdev->wiphy.retry_long = old_retry_long; 4132 rdev->wiphy.frag_threshold = old_frag_threshold; 4133 rdev->wiphy.rts_threshold = old_rts_threshold; 4134 if (old_radio_rts_threshold) { 4135 for (i = 0 ; i < rdev->wiphy.n_radio; i++) 4136 rdev->wiphy.radio_cfg[i].rts_threshold = 4137 old_radio_rts_threshold[i]; 4138 } 4139 rdev->wiphy.coverage_class = old_coverage_class; 4140 rdev->wiphy.txq_limit = old_txq_limit; 4141 rdev->wiphy.txq_memory_limit = old_txq_memory_limit; 4142 rdev->wiphy.txq_quantum = old_txq_quantum; 4143 } 4144 4145 kfree(old_radio_rts_threshold); 4146 return result; 4147 } 4148 4149 return 0; 4150 } 4151 4152 int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef) 4153 { 4154 if (WARN_ON(!cfg80211_chandef_valid(chandef))) 4155 return -EINVAL; 4156 4157 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 4158 chandef->chan->center_freq)) 4159 return -ENOBUFS; 4160 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 4161 chandef->chan->freq_offset)) 4162 return -ENOBUFS; 4163 switch (chandef->width) { 4164 case NL80211_CHAN_WIDTH_20_NOHT: 4165 case NL80211_CHAN_WIDTH_20: 4166 case NL80211_CHAN_WIDTH_40: 4167 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 4168 cfg80211_get_chandef_type(chandef))) 4169 return -ENOBUFS; 4170 break; 4171 default: 4172 break; 4173 } 4174 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width)) 4175 return -ENOBUFS; 4176 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1)) 4177 return -ENOBUFS; 4178 if (chandef->center_freq2 && 4179 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2)) 4180 return -ENOBUFS; 4181 if (chandef->punctured && 4182 nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, chandef->punctured)) 4183 return -ENOBUFS; 4184 if (chandef->s1g_primary_2mhz && 4185 nla_put_flag(msg, NL80211_ATTR_S1G_PRIMARY_2MHZ)) 4186 return -ENOBUFS; 4187 4188 return 0; 4189 } 4190 EXPORT_SYMBOL(nl80211_send_chandef); 4191 4192 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags, 4193 struct cfg80211_registered_device *rdev, 4194 struct wireless_dev *wdev, 4195 enum nl80211_commands cmd) 4196 { 4197 struct net_device *dev = wdev->netdev; 4198 void *hdr; 4199 4200 lockdep_assert_wiphy(&rdev->wiphy); 4201 4202 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE && 4203 cmd != NL80211_CMD_DEL_INTERFACE && 4204 cmd != NL80211_CMD_SET_INTERFACE); 4205 4206 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 4207 if (!hdr) 4208 return -1; 4209 4210 if (dev && 4211 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4212 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name))) 4213 goto nla_put_failure; 4214 4215 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 4216 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) || 4217 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 4218 NL80211_ATTR_PAD) || 4219 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) || 4220 nla_put_u32(msg, NL80211_ATTR_GENERATION, 4221 rdev->devlist_generation ^ 4222 (cfg80211_rdev_list_generation << 2)) || 4223 nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr) || 4224 nla_put_u32(msg, NL80211_ATTR_VIF_RADIO_MASK, wdev->radio_mask)) 4225 goto nla_put_failure; 4226 4227 if (rdev->ops->get_channel && !wdev->valid_links) { 4228 struct cfg80211_chan_def chandef = {}; 4229 int ret; 4230 4231 ret = rdev_get_channel(rdev, wdev, 0, &chandef); 4232 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 4233 goto nla_put_failure; 4234 } 4235 4236 if (rdev->ops->get_tx_power && !wdev->valid_links) { 4237 int dbm, ret; 4238 4239 ret = rdev_get_tx_power(rdev, wdev, -1, 0, &dbm); 4240 if (ret == 0 && 4241 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 4242 DBM_TO_MBM(dbm))) 4243 goto nla_put_failure; 4244 } 4245 4246 switch (wdev->iftype) { 4247 case NL80211_IFTYPE_AP: 4248 case NL80211_IFTYPE_P2P_GO: 4249 if (wdev->u.ap.ssid_len && 4250 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 4251 wdev->u.ap.ssid)) 4252 goto nla_put_failure; 4253 break; 4254 case NL80211_IFTYPE_STATION: 4255 case NL80211_IFTYPE_P2P_CLIENT: 4256 if (wdev->u.client.ssid_len && 4257 nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len, 4258 wdev->u.client.ssid)) 4259 goto nla_put_failure; 4260 break; 4261 case NL80211_IFTYPE_ADHOC: 4262 if (wdev->u.ibss.ssid_len && 4263 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len, 4264 wdev->u.ibss.ssid)) 4265 goto nla_put_failure; 4266 break; 4267 default: 4268 /* nothing */ 4269 break; 4270 } 4271 4272 if (rdev->ops->get_txq_stats) { 4273 struct cfg80211_txq_stats txqstats = {}; 4274 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats); 4275 4276 if (ret == 0 && 4277 !nl80211_put_txq_stats(msg, &txqstats, 4278 NL80211_ATTR_TXQ_STATS)) 4279 goto nla_put_failure; 4280 } 4281 4282 if (wdev->valid_links) { 4283 unsigned int link_id; 4284 struct nlattr *links = nla_nest_start(msg, 4285 NL80211_ATTR_MLO_LINKS); 4286 4287 if (!links) 4288 goto nla_put_failure; 4289 4290 for_each_valid_link(wdev, link_id) { 4291 struct nlattr *link = nla_nest_start(msg, link_id + 1); 4292 struct cfg80211_chan_def chandef = {}; 4293 int ret; 4294 4295 if (!link) 4296 goto nla_put_failure; 4297 4298 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 4299 goto nla_put_failure; 4300 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 4301 wdev->links[link_id].addr)) 4302 goto nla_put_failure; 4303 4304 ret = rdev_get_channel(rdev, wdev, link_id, &chandef); 4305 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 4306 goto nla_put_failure; 4307 4308 if (rdev->ops->get_tx_power) { 4309 int dbm, ret; 4310 4311 ret = rdev_get_tx_power(rdev, wdev, -1, link_id, &dbm); 4312 if (ret == 0 && 4313 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 4314 DBM_TO_MBM(dbm))) 4315 goto nla_put_failure; 4316 } 4317 nla_nest_end(msg, link); 4318 } 4319 4320 nla_nest_end(msg, links); 4321 } 4322 4323 genlmsg_end(msg, hdr); 4324 return 0; 4325 4326 nla_put_failure: 4327 genlmsg_cancel(msg, hdr); 4328 return -EMSGSIZE; 4329 } 4330 4331 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb) 4332 { 4333 int wp_idx = 0; 4334 int if_idx = 0; 4335 int wp_start = cb->args[0]; 4336 int if_start = cb->args[1]; 4337 int filter_wiphy = -1; 4338 struct cfg80211_registered_device *rdev; 4339 struct wireless_dev *wdev; 4340 int ret; 4341 4342 rtnl_lock(); 4343 if (!cb->args[2]) { 4344 struct nl80211_dump_wiphy_state state = { 4345 .filter_wiphy = -1, 4346 }; 4347 4348 ret = nl80211_dump_wiphy_parse(skb, cb, &state); 4349 if (ret) 4350 goto out_unlock; 4351 4352 filter_wiphy = state.filter_wiphy; 4353 4354 /* 4355 * if filtering, set cb->args[2] to +1 since 0 is the default 4356 * value needed to determine that parsing is necessary. 4357 */ 4358 if (filter_wiphy >= 0) 4359 cb->args[2] = filter_wiphy + 1; 4360 else 4361 cb->args[2] = -1; 4362 } else if (cb->args[2] > 0) { 4363 filter_wiphy = cb->args[2] - 1; 4364 } 4365 4366 for_each_rdev(rdev) { 4367 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 4368 continue; 4369 if (wp_idx < wp_start) { 4370 wp_idx++; 4371 continue; 4372 } 4373 4374 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx) 4375 continue; 4376 4377 if_idx = 0; 4378 4379 guard(wiphy)(&rdev->wiphy); 4380 4381 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 4382 if (if_idx < if_start) { 4383 if_idx++; 4384 continue; 4385 } 4386 4387 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid, 4388 cb->nlh->nlmsg_seq, NLM_F_MULTI, 4389 rdev, wdev, 4390 NL80211_CMD_NEW_INTERFACE) < 0) 4391 goto out; 4392 4393 if_idx++; 4394 } 4395 4396 if_start = 0; 4397 wp_idx++; 4398 } 4399 out: 4400 cb->args[0] = wp_idx; 4401 cb->args[1] = if_idx; 4402 4403 ret = skb->len; 4404 out_unlock: 4405 rtnl_unlock(); 4406 4407 return ret; 4408 } 4409 4410 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info) 4411 { 4412 struct sk_buff *msg; 4413 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4414 struct wireless_dev *wdev = info->user_ptr[1]; 4415 4416 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4417 if (!msg) 4418 return -ENOMEM; 4419 4420 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4421 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4422 nlmsg_free(msg); 4423 return -ENOBUFS; 4424 } 4425 4426 return genlmsg_reply(msg, info); 4427 } 4428 4429 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = { 4430 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG }, 4431 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG }, 4432 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG }, 4433 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG }, 4434 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG }, 4435 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG }, 4436 [NL80211_MNTR_FLAG_SKIP_TX] = { .type = NLA_FLAG }, 4437 }; 4438 4439 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags) 4440 { 4441 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1]; 4442 int flag; 4443 4444 *mntrflags = 0; 4445 4446 if (!nla) 4447 return -EINVAL; 4448 4449 if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL)) 4450 return -EINVAL; 4451 4452 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++) 4453 if (flags[flag]) 4454 *mntrflags |= (1<<flag); 4455 4456 /* cooked monitor mode is incompatible with other modes */ 4457 if (*mntrflags & MONITOR_FLAG_COOK_FRAMES && 4458 *mntrflags != MONITOR_FLAG_COOK_FRAMES) 4459 return -EOPNOTSUPP; 4460 4461 *mntrflags |= MONITOR_FLAG_CHANGED; 4462 4463 return 0; 4464 } 4465 4466 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev, 4467 enum nl80211_iftype type, 4468 struct genl_info *info, 4469 struct vif_params *params) 4470 { 4471 bool change = false; 4472 int err; 4473 4474 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) { 4475 if (type != NL80211_IFTYPE_MONITOR) 4476 return -EINVAL; 4477 4478 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS], 4479 ¶ms->flags); 4480 if (err) 4481 return err; 4482 4483 change = true; 4484 } 4485 4486 /* MONITOR_FLAG_COOK_FRAMES is deprecated, refuse cooperation */ 4487 if (params->flags & MONITOR_FLAG_COOK_FRAMES) 4488 return -EOPNOTSUPP; 4489 4490 if (params->flags & MONITOR_FLAG_ACTIVE && 4491 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR)) 4492 return -EOPNOTSUPP; 4493 4494 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) { 4495 const u8 *mumimo_groups; 4496 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4497 4498 if (type != NL80211_IFTYPE_MONITOR) 4499 return -EINVAL; 4500 4501 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4502 return -EOPNOTSUPP; 4503 4504 mumimo_groups = 4505 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]); 4506 4507 /* bits 0 and 63 are reserved and must be zero */ 4508 if ((mumimo_groups[0] & BIT(0)) || 4509 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7))) 4510 return -EINVAL; 4511 4512 params->vht_mumimo_groups = mumimo_groups; 4513 change = true; 4514 } 4515 4516 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) { 4517 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4518 4519 if (type != NL80211_IFTYPE_MONITOR) 4520 return -EINVAL; 4521 4522 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4523 return -EOPNOTSUPP; 4524 4525 params->vht_mumimo_follow_addr = 4526 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]); 4527 change = true; 4528 } 4529 4530 return change ? 1 : 0; 4531 } 4532 4533 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev, 4534 struct net_device *netdev, u8 use_4addr, 4535 enum nl80211_iftype iftype) 4536 { 4537 if (!use_4addr) { 4538 if (netdev && netif_is_bridge_port(netdev)) 4539 return -EBUSY; 4540 return 0; 4541 } 4542 4543 switch (iftype) { 4544 case NL80211_IFTYPE_AP_VLAN: 4545 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP) 4546 return 0; 4547 break; 4548 case NL80211_IFTYPE_STATION: 4549 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION) 4550 return 0; 4551 break; 4552 default: 4553 break; 4554 } 4555 4556 return -EOPNOTSUPP; 4557 } 4558 4559 static int nl80211_parse_vif_radio_mask(struct genl_info *info, 4560 u32 *radio_mask) 4561 { 4562 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4563 struct nlattr *attr = info->attrs[NL80211_ATTR_VIF_RADIO_MASK]; 4564 u32 mask, allowed; 4565 4566 if (!attr) { 4567 *radio_mask = 0; 4568 return 0; 4569 } 4570 4571 allowed = BIT(rdev->wiphy.n_radio) - 1; 4572 mask = nla_get_u32(attr); 4573 if (mask & ~allowed) 4574 return -EINVAL; 4575 if (!mask) 4576 mask = allowed; 4577 *radio_mask = mask; 4578 4579 return 1; 4580 } 4581 4582 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info) 4583 { 4584 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4585 struct vif_params params; 4586 int err; 4587 enum nl80211_iftype otype, ntype; 4588 struct net_device *dev = info->user_ptr[1]; 4589 struct wireless_dev *wdev = dev->ieee80211_ptr; 4590 u32 radio_mask = 0; 4591 bool change = false; 4592 4593 memset(¶ms, 0, sizeof(params)); 4594 4595 otype = ntype = dev->ieee80211_ptr->iftype; 4596 4597 if (info->attrs[NL80211_ATTR_IFTYPE]) { 4598 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4599 if (otype != ntype) 4600 change = true; 4601 } 4602 4603 if (info->attrs[NL80211_ATTR_MESH_ID]) { 4604 if (ntype != NL80211_IFTYPE_MESH_POINT) 4605 return -EINVAL; 4606 if (otype != NL80211_IFTYPE_MESH_POINT) 4607 return -EINVAL; 4608 if (netif_running(dev)) 4609 return -EBUSY; 4610 4611 wdev->u.mesh.id_up_len = 4612 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4613 memcpy(wdev->u.mesh.id, 4614 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4615 wdev->u.mesh.id_up_len); 4616 } 4617 4618 if (info->attrs[NL80211_ATTR_4ADDR]) { 4619 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4620 change = true; 4621 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype); 4622 if (err) 4623 return err; 4624 } else { 4625 params.use_4addr = -1; 4626 } 4627 4628 err = nl80211_parse_mon_options(rdev, ntype, info, ¶ms); 4629 if (err < 0) 4630 return err; 4631 if (err > 0) 4632 change = true; 4633 4634 err = nl80211_parse_vif_radio_mask(info, &radio_mask); 4635 if (err < 0) 4636 return err; 4637 if (err && netif_running(dev)) 4638 return -EBUSY; 4639 4640 if (change) 4641 err = cfg80211_change_iface(rdev, dev, ntype, ¶ms); 4642 else 4643 err = 0; 4644 4645 if (!err && params.use_4addr != -1) 4646 dev->ieee80211_ptr->use_4addr = params.use_4addr; 4647 4648 if (radio_mask) 4649 wdev->radio_mask = radio_mask; 4650 4651 if (change && !err) 4652 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE); 4653 4654 return err; 4655 } 4656 4657 static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4658 { 4659 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4660 struct vif_params params; 4661 struct wireless_dev *wdev; 4662 struct sk_buff *msg; 4663 u32 radio_mask; 4664 int err; 4665 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED; 4666 4667 memset(¶ms, 0, sizeof(params)); 4668 4669 if (!info->attrs[NL80211_ATTR_IFNAME]) 4670 return -EINVAL; 4671 4672 if (info->attrs[NL80211_ATTR_IFTYPE]) 4673 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4674 4675 if (!rdev->ops->add_virtual_intf) 4676 return -EOPNOTSUPP; 4677 4678 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN || 4679 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) && 4680 info->attrs[NL80211_ATTR_MAC]) { 4681 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC], 4682 ETH_ALEN); 4683 if (!is_valid_ether_addr(params.macaddr)) 4684 return -EADDRNOTAVAIL; 4685 } 4686 4687 if (info->attrs[NL80211_ATTR_4ADDR]) { 4688 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4689 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type); 4690 if (err) 4691 return err; 4692 } 4693 4694 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0)) 4695 return -EOPNOTSUPP; 4696 4697 err = nl80211_parse_mon_options(rdev, type, info, ¶ms); 4698 if (err < 0) 4699 return err; 4700 4701 err = nl80211_parse_vif_radio_mask(info, &radio_mask); 4702 if (err < 0) 4703 return err; 4704 4705 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4706 if (!msg) 4707 return -ENOMEM; 4708 4709 wdev = rdev_add_virtual_intf(rdev, 4710 nla_data(info->attrs[NL80211_ATTR_IFNAME]), 4711 NET_NAME_USER, type, ¶ms); 4712 if (WARN_ON(!wdev)) { 4713 nlmsg_free(msg); 4714 return -EPROTO; 4715 } else if (IS_ERR(wdev)) { 4716 nlmsg_free(msg); 4717 return PTR_ERR(wdev); 4718 } 4719 4720 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 4721 wdev->owner_nlportid = info->snd_portid; 4722 4723 switch (type) { 4724 case NL80211_IFTYPE_MESH_POINT: 4725 if (!info->attrs[NL80211_ATTR_MESH_ID]) 4726 break; 4727 wdev->u.mesh.id_up_len = 4728 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4729 memcpy(wdev->u.mesh.id, 4730 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4731 wdev->u.mesh.id_up_len); 4732 break; 4733 case NL80211_IFTYPE_NAN: 4734 case NL80211_IFTYPE_P2P_DEVICE: 4735 /* 4736 * P2P Device and NAN do not have a netdev, so don't go 4737 * through the netdev notifier and must be added here 4738 */ 4739 cfg80211_init_wdev(wdev); 4740 cfg80211_register_wdev(rdev, wdev); 4741 break; 4742 default: 4743 break; 4744 } 4745 4746 if (radio_mask) 4747 wdev->radio_mask = radio_mask; 4748 4749 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4750 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4751 nlmsg_free(msg); 4752 return -ENOBUFS; 4753 } 4754 4755 return genlmsg_reply(msg, info); 4756 } 4757 4758 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4759 { 4760 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4761 4762 /* to avoid failing a new interface creation due to pending removal */ 4763 cfg80211_destroy_ifaces(rdev); 4764 4765 guard(wiphy)(&rdev->wiphy); 4766 4767 return _nl80211_new_interface(skb, info); 4768 } 4769 4770 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info) 4771 { 4772 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4773 struct wireless_dev *wdev = info->user_ptr[1]; 4774 4775 if (!rdev->ops->del_virtual_intf) 4776 return -EOPNOTSUPP; 4777 4778 /* 4779 * We hold RTNL, so this is safe, without RTNL opencount cannot 4780 * reach 0, and thus the rdev cannot be deleted. 4781 * 4782 * We need to do it for the dev_close(), since that will call 4783 * the netdev notifiers, and we need to acquire the mutex there 4784 * but don't know if we get there from here or from some other 4785 * place (e.g. "ip link set ... down"). 4786 */ 4787 mutex_unlock(&rdev->wiphy.mtx); 4788 4789 /* 4790 * If we remove a wireless device without a netdev then clear 4791 * user_ptr[1] so that nl80211_post_doit won't dereference it 4792 * to check if it needs to do dev_put(). Otherwise it crashes 4793 * since the wdev has been freed, unlike with a netdev where 4794 * we need the dev_put() for the netdev to really be freed. 4795 */ 4796 if (!wdev->netdev) 4797 info->user_ptr[1] = NULL; 4798 else 4799 dev_close(wdev->netdev); 4800 4801 mutex_lock(&rdev->wiphy.mtx); 4802 4803 return cfg80211_remove_virtual_intf(rdev, wdev); 4804 } 4805 4806 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info) 4807 { 4808 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4809 struct net_device *dev = info->user_ptr[1]; 4810 u16 noack_map; 4811 4812 if (!info->attrs[NL80211_ATTR_NOACK_MAP]) 4813 return -EINVAL; 4814 4815 if (!rdev->ops->set_noack_map) 4816 return -EOPNOTSUPP; 4817 4818 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]); 4819 4820 return rdev_set_noack_map(rdev, dev, noack_map); 4821 } 4822 4823 static int nl80211_validate_key_link_id(struct genl_info *info, 4824 struct wireless_dev *wdev, 4825 int link_id, bool pairwise) 4826 { 4827 if (pairwise) { 4828 if (link_id != -1) { 4829 GENL_SET_ERR_MSG(info, 4830 "link ID not allowed for pairwise key"); 4831 return -EINVAL; 4832 } 4833 4834 return 0; 4835 } 4836 4837 if (wdev->valid_links) { 4838 if (link_id == -1) { 4839 GENL_SET_ERR_MSG(info, 4840 "link ID must for MLO group key"); 4841 return -EINVAL; 4842 } 4843 if (!(wdev->valid_links & BIT(link_id))) { 4844 GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key"); 4845 return -EINVAL; 4846 } 4847 } else if (link_id != -1) { 4848 GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key"); 4849 return -EINVAL; 4850 } 4851 4852 return 0; 4853 } 4854 4855 struct get_key_cookie { 4856 struct sk_buff *msg; 4857 int error; 4858 int idx; 4859 }; 4860 4861 static void get_key_callback(void *c, struct key_params *params) 4862 { 4863 struct nlattr *key; 4864 struct get_key_cookie *cookie = c; 4865 4866 if ((params->seq && 4867 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ, 4868 params->seq_len, params->seq)) || 4869 (params->cipher && 4870 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER, 4871 params->cipher))) 4872 goto nla_put_failure; 4873 4874 key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY); 4875 if (!key) 4876 goto nla_put_failure; 4877 4878 if ((params->seq && 4879 nla_put(cookie->msg, NL80211_KEY_SEQ, 4880 params->seq_len, params->seq)) || 4881 (params->cipher && 4882 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER, 4883 params->cipher))) 4884 goto nla_put_failure; 4885 4886 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx)) 4887 goto nla_put_failure; 4888 4889 nla_nest_end(cookie->msg, key); 4890 4891 return; 4892 nla_put_failure: 4893 cookie->error = 1; 4894 } 4895 4896 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info) 4897 { 4898 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4899 int err; 4900 struct net_device *dev = info->user_ptr[1]; 4901 u8 key_idx = 0; 4902 const u8 *mac_addr = NULL; 4903 bool pairwise; 4904 struct get_key_cookie cookie = { 4905 .error = 0, 4906 }; 4907 void *hdr; 4908 struct sk_buff *msg; 4909 bool bigtk_support = false; 4910 int link_id = nl80211_link_id_or_invalid(info->attrs); 4911 struct wireless_dev *wdev = dev->ieee80211_ptr; 4912 4913 if (wiphy_ext_feature_isset(&rdev->wiphy, 4914 NL80211_EXT_FEATURE_BEACON_PROTECTION)) 4915 bigtk_support = true; 4916 4917 if ((wdev->iftype == NL80211_IFTYPE_STATION || 4918 wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) && 4919 wiphy_ext_feature_isset(&rdev->wiphy, 4920 NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT)) 4921 bigtk_support = true; 4922 4923 if (info->attrs[NL80211_ATTR_KEY_IDX]) { 4924 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 4925 4926 if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) { 4927 GENL_SET_ERR_MSG(info, "BIGTK not supported"); 4928 return -EINVAL; 4929 } 4930 } 4931 4932 if (info->attrs[NL80211_ATTR_MAC]) 4933 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4934 4935 pairwise = !!mac_addr; 4936 if (info->attrs[NL80211_ATTR_KEY_TYPE]) { 4937 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 4938 4939 if (kt != NL80211_KEYTYPE_GROUP && 4940 kt != NL80211_KEYTYPE_PAIRWISE) 4941 return -EINVAL; 4942 pairwise = kt == NL80211_KEYTYPE_PAIRWISE; 4943 } 4944 4945 if (!rdev->ops->get_key) 4946 return -EOPNOTSUPP; 4947 4948 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4949 return -ENOENT; 4950 4951 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4952 if (!msg) 4953 return -ENOMEM; 4954 4955 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 4956 NL80211_CMD_NEW_KEY); 4957 if (!hdr) 4958 goto nla_put_failure; 4959 4960 cookie.msg = msg; 4961 cookie.idx = key_idx; 4962 4963 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4964 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx)) 4965 goto nla_put_failure; 4966 if (mac_addr && 4967 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr)) 4968 goto nla_put_failure; 4969 4970 err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise); 4971 if (err) 4972 goto free_msg; 4973 4974 err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr, 4975 &cookie, get_key_callback); 4976 4977 if (err) 4978 goto free_msg; 4979 4980 if (cookie.error) 4981 goto nla_put_failure; 4982 4983 genlmsg_end(msg, hdr); 4984 return genlmsg_reply(msg, info); 4985 4986 nla_put_failure: 4987 err = -ENOBUFS; 4988 free_msg: 4989 nlmsg_free(msg); 4990 return err; 4991 } 4992 4993 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info) 4994 { 4995 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4996 struct key_parse key; 4997 int err; 4998 struct net_device *dev = info->user_ptr[1]; 4999 int link_id = nl80211_link_id_or_invalid(info->attrs); 5000 struct wireless_dev *wdev = dev->ieee80211_ptr; 5001 5002 err = nl80211_parse_key(info, &key); 5003 if (err) 5004 return err; 5005 5006 if (key.idx < 0) 5007 return -EINVAL; 5008 5009 /* Only support setting default key and 5010 * Extended Key ID action NL80211_KEY_SET_TX. 5011 */ 5012 if (!key.def && !key.defmgmt && !key.defbeacon && 5013 !(key.p.mode == NL80211_KEY_SET_TX)) 5014 return -EINVAL; 5015 5016 if (key.def) { 5017 if (!rdev->ops->set_default_key) 5018 return -EOPNOTSUPP; 5019 5020 err = nl80211_key_allowed(wdev); 5021 if (err) 5022 return err; 5023 5024 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 5025 if (err) 5026 return err; 5027 5028 err = rdev_set_default_key(rdev, dev, link_id, key.idx, 5029 key.def_uni, key.def_multi); 5030 5031 if (err) 5032 return err; 5033 5034 #ifdef CONFIG_CFG80211_WEXT 5035 wdev->wext.default_key = key.idx; 5036 #endif 5037 return 0; 5038 } else if (key.defmgmt) { 5039 if (key.def_uni || !key.def_multi) 5040 return -EINVAL; 5041 5042 if (!rdev->ops->set_default_mgmt_key) 5043 return -EOPNOTSUPP; 5044 5045 err = nl80211_key_allowed(wdev); 5046 if (err) 5047 return err; 5048 5049 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 5050 if (err) 5051 return err; 5052 5053 err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx); 5054 if (err) 5055 return err; 5056 5057 #ifdef CONFIG_CFG80211_WEXT 5058 wdev->wext.default_mgmt_key = key.idx; 5059 #endif 5060 return 0; 5061 } else if (key.defbeacon) { 5062 if (key.def_uni || !key.def_multi) 5063 return -EINVAL; 5064 5065 if (!rdev->ops->set_default_beacon_key) 5066 return -EOPNOTSUPP; 5067 5068 err = nl80211_key_allowed(wdev); 5069 if (err) 5070 return err; 5071 5072 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 5073 if (err) 5074 return err; 5075 5076 return rdev_set_default_beacon_key(rdev, dev, link_id, key.idx); 5077 } else if (key.p.mode == NL80211_KEY_SET_TX && 5078 wiphy_ext_feature_isset(&rdev->wiphy, 5079 NL80211_EXT_FEATURE_EXT_KEY_ID)) { 5080 u8 *mac_addr = NULL; 5081 5082 if (info->attrs[NL80211_ATTR_MAC]) 5083 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5084 5085 if (!mac_addr || key.idx < 0 || key.idx > 1) 5086 return -EINVAL; 5087 5088 err = nl80211_validate_key_link_id(info, wdev, link_id, true); 5089 if (err) 5090 return err; 5091 5092 return rdev_add_key(rdev, dev, link_id, key.idx, 5093 NL80211_KEYTYPE_PAIRWISE, 5094 mac_addr, &key.p); 5095 } 5096 5097 return -EINVAL; 5098 } 5099 5100 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info) 5101 { 5102 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5103 int err; 5104 struct net_device *dev = info->user_ptr[1]; 5105 struct key_parse key; 5106 const u8 *mac_addr = NULL; 5107 int link_id = nl80211_link_id_or_invalid(info->attrs); 5108 struct wireless_dev *wdev = dev->ieee80211_ptr; 5109 5110 err = nl80211_parse_key(info, &key); 5111 if (err) 5112 return err; 5113 5114 if (!key.p.key) { 5115 GENL_SET_ERR_MSG(info, "no key"); 5116 return -EINVAL; 5117 } 5118 5119 if (info->attrs[NL80211_ATTR_MAC]) 5120 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5121 5122 if (key.type == -1) { 5123 if (mac_addr) 5124 key.type = NL80211_KEYTYPE_PAIRWISE; 5125 else 5126 key.type = NL80211_KEYTYPE_GROUP; 5127 } 5128 5129 /* for now */ 5130 if (key.type != NL80211_KEYTYPE_PAIRWISE && 5131 key.type != NL80211_KEYTYPE_GROUP) { 5132 GENL_SET_ERR_MSG(info, "key type not pairwise or group"); 5133 return -EINVAL; 5134 } 5135 5136 if (key.type == NL80211_KEYTYPE_GROUP && 5137 info->attrs[NL80211_ATTR_VLAN_ID]) 5138 key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 5139 5140 if (!rdev->ops->add_key) 5141 return -EOPNOTSUPP; 5142 5143 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, 5144 key.type == NL80211_KEYTYPE_PAIRWISE, 5145 mac_addr)) { 5146 GENL_SET_ERR_MSG(info, "key setting validation failed"); 5147 return -EINVAL; 5148 } 5149 5150 err = nl80211_key_allowed(wdev); 5151 if (err) 5152 GENL_SET_ERR_MSG(info, "key not allowed"); 5153 5154 if (!err) 5155 err = nl80211_validate_key_link_id(info, wdev, link_id, 5156 key.type == NL80211_KEYTYPE_PAIRWISE); 5157 5158 if (!err) { 5159 err = rdev_add_key(rdev, dev, link_id, key.idx, 5160 key.type == NL80211_KEYTYPE_PAIRWISE, 5161 mac_addr, &key.p); 5162 if (err) 5163 GENL_SET_ERR_MSG(info, "key addition failed"); 5164 } 5165 5166 return err; 5167 } 5168 5169 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info) 5170 { 5171 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5172 int err; 5173 struct net_device *dev = info->user_ptr[1]; 5174 u8 *mac_addr = NULL; 5175 struct key_parse key; 5176 int link_id = nl80211_link_id_or_invalid(info->attrs); 5177 struct wireless_dev *wdev = dev->ieee80211_ptr; 5178 5179 err = nl80211_parse_key(info, &key); 5180 if (err) 5181 return err; 5182 5183 if (info->attrs[NL80211_ATTR_MAC]) 5184 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5185 5186 if (key.type == -1) { 5187 if (mac_addr) 5188 key.type = NL80211_KEYTYPE_PAIRWISE; 5189 else 5190 key.type = NL80211_KEYTYPE_GROUP; 5191 } 5192 5193 /* for now */ 5194 if (key.type != NL80211_KEYTYPE_PAIRWISE && 5195 key.type != NL80211_KEYTYPE_GROUP) 5196 return -EINVAL; 5197 5198 if (!cfg80211_valid_key_idx(rdev, key.idx, 5199 key.type == NL80211_KEYTYPE_PAIRWISE)) 5200 return -EINVAL; 5201 5202 if (!rdev->ops->del_key) 5203 return -EOPNOTSUPP; 5204 5205 err = nl80211_key_allowed(wdev); 5206 5207 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr && 5208 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 5209 err = -ENOENT; 5210 5211 if (!err) 5212 err = nl80211_validate_key_link_id(info, wdev, link_id, 5213 key.type == NL80211_KEYTYPE_PAIRWISE); 5214 5215 if (!err) 5216 err = rdev_del_key(rdev, dev, link_id, key.idx, 5217 key.type == NL80211_KEYTYPE_PAIRWISE, 5218 mac_addr); 5219 5220 #ifdef CONFIG_CFG80211_WEXT 5221 if (!err) { 5222 if (key.idx == wdev->wext.default_key) 5223 wdev->wext.default_key = -1; 5224 else if (key.idx == wdev->wext.default_mgmt_key) 5225 wdev->wext.default_mgmt_key = -1; 5226 } 5227 #endif 5228 5229 return err; 5230 } 5231 5232 /* This function returns an error or the number of nested attributes */ 5233 static int validate_acl_mac_addrs(struct nlattr *nl_attr) 5234 { 5235 struct nlattr *attr; 5236 int n_entries = 0, tmp; 5237 5238 nla_for_each_nested(attr, nl_attr, tmp) { 5239 if (nla_len(attr) != ETH_ALEN) 5240 return -EINVAL; 5241 5242 n_entries++; 5243 } 5244 5245 return n_entries; 5246 } 5247 5248 /* 5249 * This function parses ACL information and allocates memory for ACL data. 5250 * On successful return, the calling function is responsible to free the 5251 * ACL buffer returned by this function. 5252 */ 5253 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy, 5254 struct genl_info *info) 5255 { 5256 enum nl80211_acl_policy acl_policy; 5257 struct nlattr *attr; 5258 struct cfg80211_acl_data *acl; 5259 int i = 0, n_entries, tmp; 5260 5261 if (!wiphy->max_acl_mac_addrs) 5262 return ERR_PTR(-EOPNOTSUPP); 5263 5264 if (!info->attrs[NL80211_ATTR_ACL_POLICY]) 5265 return ERR_PTR(-EINVAL); 5266 5267 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]); 5268 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED && 5269 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED) 5270 return ERR_PTR(-EINVAL); 5271 5272 if (!info->attrs[NL80211_ATTR_MAC_ADDRS]) 5273 return ERR_PTR(-EINVAL); 5274 5275 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]); 5276 if (n_entries < 0) 5277 return ERR_PTR(n_entries); 5278 5279 if (n_entries > wiphy->max_acl_mac_addrs) 5280 return ERR_PTR(-EOPNOTSUPP); 5281 5282 acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL); 5283 if (!acl) 5284 return ERR_PTR(-ENOMEM); 5285 acl->n_acl_entries = n_entries; 5286 5287 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) { 5288 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN); 5289 i++; 5290 } 5291 acl->acl_policy = acl_policy; 5292 5293 return acl; 5294 } 5295 5296 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info) 5297 { 5298 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5299 struct net_device *dev = info->user_ptr[1]; 5300 struct cfg80211_acl_data *acl; 5301 int err; 5302 5303 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 5304 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 5305 return -EOPNOTSUPP; 5306 5307 if (!dev->ieee80211_ptr->links[0].ap.beacon_interval) 5308 return -EINVAL; 5309 5310 acl = parse_acl_data(&rdev->wiphy, info); 5311 if (IS_ERR(acl)) 5312 return PTR_ERR(acl); 5313 5314 err = rdev_set_mac_acl(rdev, dev, acl); 5315 5316 kfree(acl); 5317 5318 return err; 5319 } 5320 5321 static u32 rateset_to_mask(struct ieee80211_supported_band *sband, 5322 u8 *rates, u8 rates_len) 5323 { 5324 u8 i; 5325 u32 mask = 0; 5326 5327 for (i = 0; i < rates_len; i++) { 5328 int rate = (rates[i] & 0x7f) * 5; 5329 int ridx; 5330 5331 for (ridx = 0; ridx < sband->n_bitrates; ridx++) { 5332 struct ieee80211_rate *srate = 5333 &sband->bitrates[ridx]; 5334 if (rate == srate->bitrate) { 5335 mask |= 1 << ridx; 5336 break; 5337 } 5338 } 5339 if (ridx == sband->n_bitrates) 5340 return 0; /* rate not found */ 5341 } 5342 5343 return mask; 5344 } 5345 5346 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband, 5347 u8 *rates, u8 rates_len, 5348 u8 mcs[IEEE80211_HT_MCS_MASK_LEN]) 5349 { 5350 u8 i; 5351 5352 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN); 5353 5354 for (i = 0; i < rates_len; i++) { 5355 int ridx, rbit; 5356 5357 ridx = rates[i] / 8; 5358 rbit = BIT(rates[i] % 8); 5359 5360 /* check validity */ 5361 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN)) 5362 return false; 5363 5364 /* check availability */ 5365 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN); 5366 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit) 5367 mcs[ridx] |= rbit; 5368 else 5369 return false; 5370 } 5371 5372 return true; 5373 } 5374 5375 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map) 5376 { 5377 u16 mcs_mask = 0; 5378 5379 switch (vht_mcs_map) { 5380 case IEEE80211_VHT_MCS_NOT_SUPPORTED: 5381 break; 5382 case IEEE80211_VHT_MCS_SUPPORT_0_7: 5383 mcs_mask = 0x00FF; 5384 break; 5385 case IEEE80211_VHT_MCS_SUPPORT_0_8: 5386 mcs_mask = 0x01FF; 5387 break; 5388 case IEEE80211_VHT_MCS_SUPPORT_0_9: 5389 mcs_mask = 0x03FF; 5390 break; 5391 default: 5392 break; 5393 } 5394 5395 return mcs_mask; 5396 } 5397 5398 static void vht_build_mcs_mask(u16 vht_mcs_map, 5399 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX]) 5400 { 5401 u8 nss; 5402 5403 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) { 5404 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03); 5405 vht_mcs_map >>= 2; 5406 } 5407 } 5408 5409 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband, 5410 struct nl80211_txrate_vht *txrate, 5411 u16 mcs[NL80211_VHT_NSS_MAX]) 5412 { 5413 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5414 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {}; 5415 u8 i; 5416 5417 if (!sband->vht_cap.vht_supported) 5418 return false; 5419 5420 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX); 5421 5422 /* Build vht_mcs_mask from VHT capabilities */ 5423 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5424 5425 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5426 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5427 mcs[i] = txrate->mcs[i]; 5428 else 5429 return false; 5430 } 5431 5432 return true; 5433 } 5434 5435 static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map) 5436 { 5437 switch (he_mcs_map) { 5438 case IEEE80211_HE_MCS_NOT_SUPPORTED: 5439 return 0; 5440 case IEEE80211_HE_MCS_SUPPORT_0_7: 5441 return 0x00FF; 5442 case IEEE80211_HE_MCS_SUPPORT_0_9: 5443 return 0x03FF; 5444 case IEEE80211_HE_MCS_SUPPORT_0_11: 5445 return 0xFFF; 5446 default: 5447 break; 5448 } 5449 return 0; 5450 } 5451 5452 static void he_build_mcs_mask(u16 he_mcs_map, 5453 u16 he_mcs_mask[NL80211_HE_NSS_MAX]) 5454 { 5455 u8 nss; 5456 5457 for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) { 5458 he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03); 5459 he_mcs_map >>= 2; 5460 } 5461 } 5462 5463 static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id, 5464 const struct ieee80211_sta_he_cap *he_cap) 5465 { 5466 struct net_device *dev = info->user_ptr[1]; 5467 struct wireless_dev *wdev = dev->ieee80211_ptr; 5468 struct cfg80211_chan_def *chandef; 5469 __le16 tx_mcs; 5470 5471 chandef = wdev_chandef(wdev, link_id); 5472 if (!chandef) { 5473 /* 5474 * This is probably broken, but we never maintained 5475 * a chandef in these cases, so it always was. 5476 */ 5477 return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80); 5478 } 5479 5480 switch (chandef->width) { 5481 case NL80211_CHAN_WIDTH_80P80: 5482 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80; 5483 break; 5484 case NL80211_CHAN_WIDTH_160: 5485 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160; 5486 break; 5487 default: 5488 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80; 5489 break; 5490 } 5491 5492 return le16_to_cpu(tx_mcs); 5493 } 5494 5495 static bool he_set_mcs_mask(struct genl_info *info, 5496 struct wireless_dev *wdev, 5497 struct ieee80211_supported_band *sband, 5498 struct nl80211_txrate_he *txrate, 5499 u16 mcs[NL80211_HE_NSS_MAX], 5500 unsigned int link_id) 5501 { 5502 const struct ieee80211_sta_he_cap *he_cap; 5503 u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {}; 5504 u16 tx_mcs_map = 0; 5505 u8 i; 5506 5507 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5508 if (!he_cap) 5509 return false; 5510 5511 memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX); 5512 5513 tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5514 5515 /* Build he_mcs_mask from HE capabilities */ 5516 he_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5517 5518 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5519 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5520 mcs[i] = txrate->mcs[i]; 5521 else 5522 return false; 5523 } 5524 5525 return true; 5526 } 5527 5528 static void eht_build_mcs_mask(struct genl_info *info, 5529 const struct ieee80211_sta_eht_cap *eht_cap, 5530 u8 mcs_nss_len, u16 *mcs_mask) 5531 { 5532 struct net_device *dev = info->user_ptr[1]; 5533 struct wireless_dev *wdev = dev->ieee80211_ptr; 5534 u8 nss, mcs_7 = 0, mcs_9 = 0, mcs_11 = 0, mcs_13 = 0; 5535 unsigned int link_id = nl80211_link_id(info->attrs); 5536 5537 if (mcs_nss_len == 4) { 5538 const struct ieee80211_eht_mcs_nss_supp_20mhz_only *mcs = 5539 &eht_cap->eht_mcs_nss_supp.only_20mhz; 5540 5541 mcs_7 = u8_get_bits(mcs->rx_tx_mcs7_max_nss, 5542 IEEE80211_EHT_MCS_NSS_TX); 5543 mcs_9 = u8_get_bits(mcs->rx_tx_mcs9_max_nss, 5544 IEEE80211_EHT_MCS_NSS_TX); 5545 mcs_11 = u8_get_bits(mcs->rx_tx_mcs11_max_nss, 5546 IEEE80211_EHT_MCS_NSS_TX); 5547 mcs_13 = u8_get_bits(mcs->rx_tx_mcs13_max_nss, 5548 IEEE80211_EHT_MCS_NSS_TX); 5549 5550 } else { 5551 const struct ieee80211_eht_mcs_nss_supp_bw *mcs; 5552 enum nl80211_chan_width width; 5553 5554 switch (wdev->iftype) { 5555 case NL80211_IFTYPE_ADHOC: 5556 width = wdev->u.ibss.chandef.width; 5557 break; 5558 case NL80211_IFTYPE_MESH_POINT: 5559 width = wdev->u.mesh.chandef.width; 5560 break; 5561 case NL80211_IFTYPE_OCB: 5562 width = wdev->u.ocb.chandef.width; 5563 break; 5564 default: 5565 if (wdev->valid_links) 5566 width = wdev->links[link_id].ap.chandef.width; 5567 else 5568 width = wdev->u.ap.preset_chandef.width; 5569 break; 5570 } 5571 5572 switch (width) { 5573 case NL80211_CHAN_WIDTH_320: 5574 mcs = &eht_cap->eht_mcs_nss_supp.bw._320; 5575 break; 5576 case NL80211_CHAN_WIDTH_160: 5577 mcs = &eht_cap->eht_mcs_nss_supp.bw._160; 5578 break; 5579 default: 5580 mcs = &eht_cap->eht_mcs_nss_supp.bw._80; 5581 break; 5582 } 5583 5584 mcs_7 = u8_get_bits(mcs->rx_tx_mcs9_max_nss, 5585 IEEE80211_EHT_MCS_NSS_TX); 5586 mcs_9 = u8_get_bits(mcs->rx_tx_mcs9_max_nss, 5587 IEEE80211_EHT_MCS_NSS_TX); 5588 mcs_11 = u8_get_bits(mcs->rx_tx_mcs11_max_nss, 5589 IEEE80211_EHT_MCS_NSS_TX); 5590 mcs_13 = u8_get_bits(mcs->rx_tx_mcs13_max_nss, 5591 IEEE80211_EHT_MCS_NSS_TX); 5592 } 5593 5594 /* Enable MCS 14 for NSS 0 */ 5595 if (eht_cap->eht_cap_elem.phy_cap_info[6] & 5596 IEEE80211_EHT_PHY_CAP6_EHT_DUP_6GHZ_SUPP) 5597 mcs_mask[0] |= 0x4000; 5598 5599 /* Enable MCS 15 for NSS 0 */ 5600 mcs_mask[0] |= 0x8000; 5601 5602 for (nss = 0; nss < NL80211_EHT_NSS_MAX; nss++) { 5603 if (!mcs_7) 5604 continue; 5605 mcs_mask[nss] |= 0x00FF; 5606 mcs_7--; 5607 5608 if (!mcs_9) 5609 continue; 5610 mcs_mask[nss] |= 0x0300; 5611 mcs_9--; 5612 5613 if (!mcs_11) 5614 continue; 5615 mcs_mask[nss] |= 0x0C00; 5616 mcs_11--; 5617 5618 if (!mcs_13) 5619 continue; 5620 mcs_mask[nss] |= 0x3000; 5621 mcs_13--; 5622 } 5623 } 5624 5625 static bool eht_set_mcs_mask(struct genl_info *info, struct wireless_dev *wdev, 5626 struct ieee80211_supported_band *sband, 5627 struct nl80211_txrate_eht *txrate, 5628 u16 mcs[NL80211_EHT_NSS_MAX]) 5629 { 5630 const struct ieee80211_sta_he_cap *he_cap; 5631 const struct ieee80211_sta_eht_cap *eht_cap; 5632 u16 tx_mcs_mask[NL80211_EHT_NSS_MAX] = { 0 }; 5633 u8 i, mcs_nss_len; 5634 5635 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5636 if (!he_cap) 5637 return false; 5638 5639 eht_cap = ieee80211_get_eht_iftype_cap(sband, wdev->iftype); 5640 if (!eht_cap) 5641 return false; 5642 5643 /* Checks for MCS 14 */ 5644 if (txrate->mcs[0] & 0x4000) { 5645 if (sband->band != NL80211_BAND_6GHZ) 5646 return false; 5647 5648 if (!(eht_cap->eht_cap_elem.phy_cap_info[6] & 5649 IEEE80211_EHT_PHY_CAP6_EHT_DUP_6GHZ_SUPP)) 5650 return false; 5651 } 5652 5653 mcs_nss_len = ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 5654 &eht_cap->eht_cap_elem, 5655 wdev->iftype == 5656 NL80211_IFTYPE_STATION); 5657 5658 if (mcs_nss_len == 3) { 5659 /* Supported iftypes for setting non-20 MHZ only EHT MCS */ 5660 switch (wdev->iftype) { 5661 case NL80211_IFTYPE_ADHOC: 5662 case NL80211_IFTYPE_AP: 5663 case NL80211_IFTYPE_P2P_GO: 5664 case NL80211_IFTYPE_MESH_POINT: 5665 case NL80211_IFTYPE_OCB: 5666 break; 5667 default: 5668 return false; 5669 } 5670 } 5671 5672 /* Build eht_mcs_mask from EHT and HE capabilities */ 5673 eht_build_mcs_mask(info, eht_cap, mcs_nss_len, tx_mcs_mask); 5674 5675 memset(mcs, 0, sizeof(u16) * NL80211_EHT_NSS_MAX); 5676 for (i = 0; i < NL80211_EHT_NSS_MAX; i++) { 5677 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5678 mcs[i] = txrate->mcs[i]; 5679 else 5680 return false; 5681 } 5682 5683 return true; 5684 } 5685 5686 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info, 5687 struct nlattr *attrs[], 5688 enum nl80211_attrs attr, 5689 struct cfg80211_bitrate_mask *mask, 5690 struct net_device *dev, 5691 bool default_all_enabled, 5692 unsigned int link_id) 5693 { 5694 struct nlattr *tb[NL80211_TXRATE_MAX + 1]; 5695 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5696 struct wireless_dev *wdev = dev->ieee80211_ptr; 5697 int rem, i; 5698 struct nlattr *tx_rates; 5699 struct ieee80211_supported_band *sband; 5700 u16 vht_tx_mcs_map, he_tx_mcs_map; 5701 5702 memset(mask, 0, sizeof(*mask)); 5703 /* Default to all rates enabled */ 5704 for (i = 0; i < NUM_NL80211_BANDS; i++) { 5705 const struct ieee80211_sta_he_cap *he_cap; 5706 const struct ieee80211_sta_eht_cap *eht_cap; 5707 u8 mcs_nss_len; 5708 5709 if (!default_all_enabled) 5710 break; 5711 5712 sband = rdev->wiphy.bands[i]; 5713 5714 if (!sband) 5715 continue; 5716 5717 mask->control[i].legacy = (1 << sband->n_bitrates) - 1; 5718 memcpy(mask->control[i].ht_mcs, 5719 sband->ht_cap.mcs.rx_mask, 5720 sizeof(mask->control[i].ht_mcs)); 5721 5722 if (sband->vht_cap.vht_supported) { 5723 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5724 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs); 5725 } 5726 5727 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5728 if (!he_cap) 5729 continue; 5730 5731 he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5732 he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs); 5733 5734 mask->control[i].he_gi = 0xFF; 5735 mask->control[i].he_ltf = 0xFF; 5736 5737 eht_cap = ieee80211_get_eht_iftype_cap(sband, wdev->iftype); 5738 if (!eht_cap) 5739 continue; 5740 5741 mcs_nss_len = ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 5742 &eht_cap->eht_cap_elem, 5743 wdev->iftype == 5744 NL80211_IFTYPE_STATION); 5745 5746 eht_build_mcs_mask(info, eht_cap, mcs_nss_len, 5747 mask->control[i].eht_mcs); 5748 5749 mask->control[i].eht_gi = 0xFF; 5750 mask->control[i].eht_ltf = 0xFF; 5751 } 5752 5753 /* if no rates are given set it back to the defaults */ 5754 if (!attrs[attr]) 5755 goto out; 5756 5757 /* The nested attribute uses enum nl80211_band as the index. This maps 5758 * directly to the enum nl80211_band values used in cfg80211. 5759 */ 5760 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8); 5761 nla_for_each_nested(tx_rates, attrs[attr], rem) { 5762 enum nl80211_band band = nla_type(tx_rates); 5763 int err; 5764 5765 if (band < 0 || band >= NUM_NL80211_BANDS) 5766 return -EINVAL; 5767 sband = rdev->wiphy.bands[band]; 5768 if (sband == NULL) 5769 return -EINVAL; 5770 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX, 5771 tx_rates, 5772 nl80211_txattr_policy, 5773 info->extack); 5774 if (err) 5775 return err; 5776 if (tb[NL80211_TXRATE_LEGACY]) { 5777 mask->control[band].legacy = rateset_to_mask( 5778 sband, 5779 nla_data(tb[NL80211_TXRATE_LEGACY]), 5780 nla_len(tb[NL80211_TXRATE_LEGACY])); 5781 if ((mask->control[band].legacy == 0) && 5782 nla_len(tb[NL80211_TXRATE_LEGACY])) 5783 return -EINVAL; 5784 } 5785 if (tb[NL80211_TXRATE_HT]) { 5786 if (!ht_rateset_to_mask( 5787 sband, 5788 nla_data(tb[NL80211_TXRATE_HT]), 5789 nla_len(tb[NL80211_TXRATE_HT]), 5790 mask->control[band].ht_mcs)) 5791 return -EINVAL; 5792 } 5793 5794 if (tb[NL80211_TXRATE_VHT]) { 5795 if (!vht_set_mcs_mask( 5796 sband, 5797 nla_data(tb[NL80211_TXRATE_VHT]), 5798 mask->control[band].vht_mcs)) 5799 return -EINVAL; 5800 } 5801 5802 if (tb[NL80211_TXRATE_GI]) { 5803 mask->control[band].gi = 5804 nla_get_u8(tb[NL80211_TXRATE_GI]); 5805 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI) 5806 return -EINVAL; 5807 } 5808 if (tb[NL80211_TXRATE_HE] && 5809 !he_set_mcs_mask(info, wdev, sband, 5810 nla_data(tb[NL80211_TXRATE_HE]), 5811 mask->control[band].he_mcs, 5812 link_id)) 5813 return -EINVAL; 5814 5815 if (tb[NL80211_TXRATE_HE_GI]) 5816 mask->control[band].he_gi = 5817 nla_get_u8(tb[NL80211_TXRATE_HE_GI]); 5818 if (tb[NL80211_TXRATE_HE_LTF]) 5819 mask->control[band].he_ltf = 5820 nla_get_u8(tb[NL80211_TXRATE_HE_LTF]); 5821 5822 if (tb[NL80211_TXRATE_EHT] && 5823 !eht_set_mcs_mask(info, wdev, sband, 5824 nla_data(tb[NL80211_TXRATE_EHT]), 5825 mask->control[band].eht_mcs)) 5826 return -EINVAL; 5827 5828 if (tb[NL80211_TXRATE_EHT_GI]) 5829 mask->control[band].eht_gi = 5830 nla_get_u8(tb[NL80211_TXRATE_EHT_GI]); 5831 if (tb[NL80211_TXRATE_EHT_LTF]) 5832 mask->control[band].eht_ltf = 5833 nla_get_u8(tb[NL80211_TXRATE_EHT_LTF]); 5834 5835 if (mask->control[band].legacy == 0) { 5836 /* don't allow empty legacy rates if HT, VHT, HE or EHT 5837 * are not even supported. 5838 */ 5839 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported || 5840 rdev->wiphy.bands[band]->vht_cap.vht_supported || 5841 ieee80211_get_he_iftype_cap(sband, wdev->iftype) || 5842 ieee80211_get_eht_iftype_cap(sband, wdev->iftype))) 5843 return -EINVAL; 5844 5845 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) 5846 if (mask->control[band].ht_mcs[i]) 5847 goto out; 5848 5849 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) 5850 if (mask->control[band].vht_mcs[i]) 5851 goto out; 5852 5853 for (i = 0; i < NL80211_HE_NSS_MAX; i++) 5854 if (mask->control[band].he_mcs[i]) 5855 goto out; 5856 5857 for (i = 0; i < NL80211_EHT_NSS_MAX; i++) 5858 if (mask->control[band].eht_mcs[i]) 5859 goto out; 5860 5861 /* legacy and mcs rates may not be both empty */ 5862 return -EINVAL; 5863 } 5864 } 5865 5866 out: 5867 return 0; 5868 } 5869 5870 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev, 5871 enum nl80211_band band, 5872 struct cfg80211_bitrate_mask *beacon_rate) 5873 { 5874 u32 count_ht, count_vht, count_he, count_eht, i; 5875 u32 rate = beacon_rate->control[band].legacy; 5876 5877 /* Allow only one rate */ 5878 if (hweight32(rate) > 1) 5879 return -EINVAL; 5880 5881 count_ht = 0; 5882 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) { 5883 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) { 5884 return -EINVAL; 5885 } else if (beacon_rate->control[band].ht_mcs[i]) { 5886 count_ht++; 5887 if (count_ht > 1) 5888 return -EINVAL; 5889 } 5890 if (count_ht && rate) 5891 return -EINVAL; 5892 } 5893 5894 count_vht = 0; 5895 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5896 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) { 5897 return -EINVAL; 5898 } else if (beacon_rate->control[band].vht_mcs[i]) { 5899 count_vht++; 5900 if (count_vht > 1) 5901 return -EINVAL; 5902 } 5903 if (count_vht && rate) 5904 return -EINVAL; 5905 } 5906 5907 count_he = 0; 5908 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5909 if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) { 5910 return -EINVAL; 5911 } else if (beacon_rate->control[band].he_mcs[i]) { 5912 count_he++; 5913 if (count_he > 1) 5914 return -EINVAL; 5915 } 5916 if (count_he && rate) 5917 return -EINVAL; 5918 } 5919 5920 count_eht = 0; 5921 for (i = 0; i < NL80211_EHT_NSS_MAX; i++) { 5922 if (hweight16(beacon_rate->control[band].eht_mcs[i]) > 1) { 5923 return -EINVAL; 5924 } else if (beacon_rate->control[band].eht_mcs[i]) { 5925 count_eht++; 5926 if (count_eht > 1) 5927 return -EINVAL; 5928 } 5929 if (count_eht && rate) 5930 return -EINVAL; 5931 } 5932 5933 if ((count_ht && count_vht && count_he && count_eht) || 5934 (!rate && !count_ht && !count_vht && !count_he && !count_eht)) 5935 return -EINVAL; 5936 5937 if (rate && 5938 !wiphy_ext_feature_isset(&rdev->wiphy, 5939 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) 5940 return -EINVAL; 5941 if (count_ht && 5942 !wiphy_ext_feature_isset(&rdev->wiphy, 5943 NL80211_EXT_FEATURE_BEACON_RATE_HT)) 5944 return -EINVAL; 5945 if (count_vht && 5946 !wiphy_ext_feature_isset(&rdev->wiphy, 5947 NL80211_EXT_FEATURE_BEACON_RATE_VHT)) 5948 return -EINVAL; 5949 if (count_he && 5950 !wiphy_ext_feature_isset(&rdev->wiphy, 5951 NL80211_EXT_FEATURE_BEACON_RATE_HE)) 5952 return -EINVAL; 5953 5954 if (count_eht && 5955 !wiphy_ext_feature_isset(&rdev->wiphy, 5956 NL80211_EXT_FEATURE_BEACON_RATE_EHT)) 5957 return -EINVAL; 5958 5959 return 0; 5960 } 5961 5962 static int nl80211_parse_mbssid_config(struct wiphy *wiphy, 5963 struct net_device *dev, 5964 unsigned int link_id, 5965 struct nlattr *attrs, 5966 struct cfg80211_mbssid_config *config, 5967 u8 num_elems) 5968 { 5969 struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1]; 5970 int tx_link_id = -1; 5971 5972 if (!wiphy->mbssid_max_interfaces) 5973 return -EOPNOTSUPP; 5974 5975 if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL, 5976 NULL) || 5977 !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]) 5978 return -EINVAL; 5979 5980 config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]); 5981 if (config->ema) { 5982 if (!wiphy->ema_max_profile_periodicity) 5983 return -EOPNOTSUPP; 5984 5985 if (num_elems > wiphy->ema_max_profile_periodicity) 5986 return -EINVAL; 5987 } 5988 5989 config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]); 5990 if (config->index >= wiphy->mbssid_max_interfaces || 5991 (!config->index && !num_elems)) 5992 return -EINVAL; 5993 5994 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_LINK_ID]) 5995 tx_link_id = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_TX_LINK_ID]); 5996 5997 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) { 5998 u32 tx_ifindex = 5999 nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]); 6000 6001 if ((!config->index && tx_ifindex != dev->ifindex) || 6002 (config->index && tx_ifindex == dev->ifindex)) 6003 return -EINVAL; 6004 6005 if (tx_ifindex != dev->ifindex) { 6006 struct net_device *tx_netdev = 6007 dev_get_by_index(wiphy_net(wiphy), tx_ifindex); 6008 6009 if (!tx_netdev || !tx_netdev->ieee80211_ptr || 6010 tx_netdev->ieee80211_ptr->wiphy != wiphy || 6011 tx_netdev->ieee80211_ptr->iftype != 6012 NL80211_IFTYPE_AP) { 6013 dev_put(tx_netdev); 6014 return -EINVAL; 6015 } 6016 6017 config->tx_wdev = tx_netdev->ieee80211_ptr; 6018 /* Caller should call dev_put(config->tx_wdev) from this point */ 6019 6020 if (config->tx_wdev->valid_links) { 6021 if (tx_link_id == -1 || 6022 !(config->tx_wdev->valid_links & BIT(tx_link_id))) 6023 return -ENOLINK; 6024 6025 config->tx_link_id = tx_link_id; 6026 } 6027 } else { 6028 if (tx_link_id >= 0 && tx_link_id != link_id) 6029 return -EINVAL; 6030 6031 config->tx_wdev = dev->ieee80211_ptr; 6032 } 6033 } else if (!config->index) { 6034 if (tx_link_id >= 0 && tx_link_id != link_id) 6035 return -EINVAL; 6036 6037 config->tx_wdev = dev->ieee80211_ptr; 6038 } else { 6039 return -EINVAL; 6040 } 6041 6042 return 0; 6043 } 6044 6045 static struct cfg80211_mbssid_elems * 6046 nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs) 6047 { 6048 struct nlattr *nl_elems; 6049 struct cfg80211_mbssid_elems *elems; 6050 int rem_elems; 6051 u8 i = 0, num_elems = 0; 6052 6053 if (!wiphy->mbssid_max_interfaces) 6054 return ERR_PTR(-EINVAL); 6055 6056 nla_for_each_nested(nl_elems, attrs, rem_elems) { 6057 if (num_elems >= 255) 6058 return ERR_PTR(-EINVAL); 6059 num_elems++; 6060 } 6061 6062 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 6063 if (!elems) 6064 return ERR_PTR(-ENOMEM); 6065 elems->cnt = num_elems; 6066 6067 nla_for_each_nested(nl_elems, attrs, rem_elems) { 6068 elems->elem[i].data = nla_data(nl_elems); 6069 elems->elem[i].len = nla_len(nl_elems); 6070 i++; 6071 } 6072 return elems; 6073 } 6074 6075 static struct cfg80211_rnr_elems * 6076 nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs, 6077 struct netlink_ext_ack *extack) 6078 { 6079 struct nlattr *nl_elems; 6080 struct cfg80211_rnr_elems *elems; 6081 int rem_elems; 6082 u8 i = 0, num_elems = 0; 6083 6084 nla_for_each_nested(nl_elems, attrs, rem_elems) { 6085 int ret; 6086 6087 ret = validate_ie_attr(nl_elems, extack); 6088 if (ret) 6089 return ERR_PTR(ret); 6090 6091 num_elems++; 6092 } 6093 6094 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 6095 if (!elems) 6096 return ERR_PTR(-ENOMEM); 6097 elems->cnt = num_elems; 6098 6099 nla_for_each_nested(nl_elems, attrs, rem_elems) { 6100 elems->elem[i].data = nla_data(nl_elems); 6101 elems->elem[i].len = nla_len(nl_elems); 6102 i++; 6103 } 6104 return elems; 6105 } 6106 6107 static int nl80211_parse_he_bss_color(struct nlattr *attrs, 6108 struct cfg80211_he_bss_color *he_bss_color) 6109 { 6110 struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1]; 6111 int err; 6112 6113 err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs, 6114 he_bss_color_policy, NULL); 6115 if (err) 6116 return err; 6117 6118 if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]) 6119 return -EINVAL; 6120 6121 he_bss_color->color = 6122 nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]); 6123 he_bss_color->enabled = 6124 !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]); 6125 he_bss_color->partial = 6126 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]); 6127 6128 return 0; 6129 } 6130 6131 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev, 6132 struct nlattr *attrs[], 6133 struct cfg80211_beacon_data *bcn, 6134 struct netlink_ext_ack *extack) 6135 { 6136 bool haveinfo = false; 6137 int err; 6138 6139 memset(bcn, 0, sizeof(*bcn)); 6140 6141 bcn->link_id = nl80211_link_id(attrs); 6142 6143 if (attrs[NL80211_ATTR_BEACON_HEAD]) { 6144 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]); 6145 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]); 6146 if (!bcn->head_len) 6147 return -EINVAL; 6148 haveinfo = true; 6149 } 6150 6151 if (attrs[NL80211_ATTR_BEACON_TAIL]) { 6152 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]); 6153 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]); 6154 haveinfo = true; 6155 } 6156 6157 if (!haveinfo) 6158 return -EINVAL; 6159 6160 if (attrs[NL80211_ATTR_IE]) { 6161 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]); 6162 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]); 6163 } 6164 6165 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) { 6166 bcn->proberesp_ies = 6167 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]); 6168 bcn->proberesp_ies_len = 6169 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]); 6170 } 6171 6172 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) { 6173 bcn->assocresp_ies = 6174 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 6175 bcn->assocresp_ies_len = 6176 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 6177 } 6178 6179 if (attrs[NL80211_ATTR_PROBE_RESP]) { 6180 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]); 6181 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]); 6182 } 6183 6184 if (attrs[NL80211_ATTR_FTM_RESPONDER]) { 6185 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1]; 6186 6187 err = nla_parse_nested_deprecated(tb, 6188 NL80211_FTM_RESP_ATTR_MAX, 6189 attrs[NL80211_ATTR_FTM_RESPONDER], 6190 NULL, NULL); 6191 if (err) 6192 return err; 6193 6194 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] && 6195 wiphy_ext_feature_isset(&rdev->wiphy, 6196 NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER)) 6197 bcn->ftm_responder = 1; 6198 else 6199 return -EOPNOTSUPP; 6200 6201 if (tb[NL80211_FTM_RESP_ATTR_LCI]) { 6202 bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]); 6203 bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]); 6204 } 6205 6206 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) { 6207 bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 6208 bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 6209 } 6210 } else { 6211 bcn->ftm_responder = -1; 6212 } 6213 6214 if (attrs[NL80211_ATTR_HE_BSS_COLOR]) { 6215 err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR], 6216 &bcn->he_bss_color); 6217 if (err) 6218 return err; 6219 bcn->he_bss_color_valid = true; 6220 } 6221 6222 if (attrs[NL80211_ATTR_MBSSID_ELEMS]) { 6223 struct cfg80211_mbssid_elems *mbssid = 6224 nl80211_parse_mbssid_elems(&rdev->wiphy, 6225 attrs[NL80211_ATTR_MBSSID_ELEMS]); 6226 6227 if (IS_ERR(mbssid)) 6228 return PTR_ERR(mbssid); 6229 6230 bcn->mbssid_ies = mbssid; 6231 6232 if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) { 6233 struct cfg80211_rnr_elems *rnr = 6234 nl80211_parse_rnr_elems(&rdev->wiphy, 6235 attrs[NL80211_ATTR_EMA_RNR_ELEMS], 6236 extack); 6237 6238 if (IS_ERR(rnr)) 6239 return PTR_ERR(rnr); 6240 6241 if (rnr && rnr->cnt < bcn->mbssid_ies->cnt) 6242 return -EINVAL; 6243 6244 bcn->rnr_ies = rnr; 6245 } 6246 } 6247 6248 return 0; 6249 } 6250 6251 static int nl80211_parse_he_obss_pd(struct nlattr *attrs, 6252 struct ieee80211_he_obss_pd *he_obss_pd) 6253 { 6254 struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1]; 6255 int err; 6256 6257 err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs, 6258 he_obss_pd_policy, NULL); 6259 if (err) 6260 return err; 6261 6262 if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]) 6263 return -EINVAL; 6264 6265 he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]); 6266 6267 if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]) 6268 he_obss_pd->min_offset = 6269 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]); 6270 if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]) 6271 he_obss_pd->max_offset = 6272 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]); 6273 if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]) 6274 he_obss_pd->non_srg_max_offset = 6275 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]); 6276 6277 if (he_obss_pd->min_offset > he_obss_pd->max_offset) 6278 return -EINVAL; 6279 6280 if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]) 6281 memcpy(he_obss_pd->bss_color_bitmap, 6282 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]), 6283 sizeof(he_obss_pd->bss_color_bitmap)); 6284 6285 if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]) 6286 memcpy(he_obss_pd->partial_bssid_bitmap, 6287 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]), 6288 sizeof(he_obss_pd->partial_bssid_bitmap)); 6289 6290 he_obss_pd->enable = true; 6291 6292 return 0; 6293 } 6294 6295 static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev, 6296 struct nlattr *attrs, 6297 struct cfg80211_fils_discovery *fd) 6298 { 6299 struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1]; 6300 int ret; 6301 6302 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6303 NL80211_EXT_FEATURE_FILS_DISCOVERY)) 6304 return -EINVAL; 6305 6306 ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs, 6307 NULL, NULL); 6308 if (ret) 6309 return ret; 6310 6311 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] && 6312 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] && 6313 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) { 6314 fd->update = true; 6315 return 0; 6316 } 6317 6318 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] || 6319 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] || 6320 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) 6321 return -EINVAL; 6322 6323 fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 6324 fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 6325 fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]); 6326 fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]); 6327 fd->update = true; 6328 return 0; 6329 } 6330 6331 static int 6332 nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev, 6333 struct nlattr *attrs, 6334 struct cfg80211_unsol_bcast_probe_resp *presp) 6335 { 6336 struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1]; 6337 int ret; 6338 6339 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6340 NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP)) 6341 return -EINVAL; 6342 6343 ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX, 6344 attrs, NULL, NULL); 6345 if (ret) 6346 return ret; 6347 6348 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] && 6349 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) { 6350 presp->update = true; 6351 return 0; 6352 } 6353 6354 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] || 6355 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) 6356 return -EINVAL; 6357 6358 presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 6359 presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 6360 presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]); 6361 presp->update = true; 6362 return 0; 6363 } 6364 6365 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params, 6366 const struct element *rates) 6367 { 6368 int i; 6369 6370 if (!rates) 6371 return; 6372 6373 for (i = 0; i < rates->datalen; i++) { 6374 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY) 6375 params->ht_required = true; 6376 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY) 6377 params->vht_required = true; 6378 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY) 6379 params->he_required = true; 6380 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E) 6381 params->sae_h2e_required = true; 6382 } 6383 } 6384 6385 /* 6386 * Since the nl80211 API didn't include, from the beginning, attributes about 6387 * HT/VHT requirements/capabilities, we parse them out of the IEs for the 6388 * benefit of drivers that rebuild IEs in the firmware. 6389 */ 6390 static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params) 6391 { 6392 const struct cfg80211_beacon_data *bcn = ¶ms->beacon; 6393 size_t ies_len = bcn->tail_len; 6394 const u8 *ies = bcn->tail; 6395 const struct element *rates; 6396 const struct element *cap; 6397 6398 rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len); 6399 nl80211_check_ap_rate_selectors(params, rates); 6400 6401 rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len); 6402 nl80211_check_ap_rate_selectors(params, rates); 6403 6404 cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len); 6405 if (cap && cap->datalen >= sizeof(*params->ht_cap)) 6406 params->ht_cap = (void *)cap->data; 6407 cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len); 6408 if (cap && cap->datalen >= sizeof(*params->vht_cap)) 6409 params->vht_cap = (void *)cap->data; 6410 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len); 6411 if (cap && cap->datalen >= sizeof(*params->he_cap) + 1) 6412 params->he_cap = (void *)(cap->data + 1); 6413 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len); 6414 if (cap && cap->datalen >= sizeof(*params->he_oper) + 1) 6415 params->he_oper = (void *)(cap->data + 1); 6416 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len); 6417 if (cap) { 6418 if (!cap->datalen) 6419 return -EINVAL; 6420 params->eht_cap = (void *)(cap->data + 1); 6421 if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap, 6422 (const u8 *)params->eht_cap, 6423 cap->datalen - 1, true)) 6424 return -EINVAL; 6425 } 6426 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len); 6427 if (cap) { 6428 if (!cap->datalen) 6429 return -EINVAL; 6430 params->eht_oper = (void *)(cap->data + 1); 6431 if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper, 6432 cap->datalen - 1)) 6433 return -EINVAL; 6434 } 6435 return 0; 6436 } 6437 6438 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev, 6439 struct cfg80211_ap_settings *params) 6440 { 6441 struct wireless_dev *wdev; 6442 6443 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 6444 if (wdev->iftype != NL80211_IFTYPE_AP && 6445 wdev->iftype != NL80211_IFTYPE_P2P_GO) 6446 continue; 6447 6448 if (!wdev->u.ap.preset_chandef.chan) 6449 continue; 6450 6451 params->chandef = wdev->u.ap.preset_chandef; 6452 return true; 6453 } 6454 6455 return false; 6456 } 6457 6458 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev, 6459 enum nl80211_auth_type auth_type, 6460 enum nl80211_commands cmd) 6461 { 6462 if (auth_type > NL80211_AUTHTYPE_MAX) 6463 return false; 6464 6465 switch (cmd) { 6466 case NL80211_CMD_AUTHENTICATE: 6467 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 6468 auth_type == NL80211_AUTHTYPE_SAE) 6469 return false; 6470 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6471 NL80211_EXT_FEATURE_FILS_STA) && 6472 (auth_type == NL80211_AUTHTYPE_FILS_SK || 6473 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6474 auth_type == NL80211_AUTHTYPE_FILS_PK)) 6475 return false; 6476 return true; 6477 case NL80211_CMD_CONNECT: 6478 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 6479 !wiphy_ext_feature_isset(&rdev->wiphy, 6480 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 6481 auth_type == NL80211_AUTHTYPE_SAE) 6482 return false; 6483 6484 /* FILS with SK PFS or PK not supported yet */ 6485 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6486 auth_type == NL80211_AUTHTYPE_FILS_PK) 6487 return false; 6488 if (!wiphy_ext_feature_isset( 6489 &rdev->wiphy, 6490 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 6491 auth_type == NL80211_AUTHTYPE_FILS_SK) 6492 return false; 6493 return true; 6494 case NL80211_CMD_START_AP: 6495 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6496 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) && 6497 auth_type == NL80211_AUTHTYPE_SAE) 6498 return false; 6499 /* FILS not supported yet */ 6500 if (auth_type == NL80211_AUTHTYPE_FILS_SK || 6501 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6502 auth_type == NL80211_AUTHTYPE_FILS_PK) 6503 return false; 6504 return true; 6505 default: 6506 return false; 6507 } 6508 } 6509 6510 static void nl80211_send_ap_started(struct wireless_dev *wdev, 6511 unsigned int link_id) 6512 { 6513 struct wiphy *wiphy = wdev->wiphy; 6514 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 6515 struct sk_buff *msg; 6516 void *hdr; 6517 6518 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6519 if (!msg) 6520 return; 6521 6522 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP); 6523 if (!hdr) 6524 goto out; 6525 6526 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 6527 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 6528 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 6529 NL80211_ATTR_PAD) || 6530 (wdev->u.ap.ssid_len && 6531 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 6532 wdev->u.ap.ssid)) || 6533 (wdev->valid_links && 6534 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 6535 goto out; 6536 6537 genlmsg_end(msg, hdr); 6538 6539 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 6540 NL80211_MCGRP_MLME, GFP_KERNEL); 6541 return; 6542 out: 6543 nlmsg_free(msg); 6544 } 6545 6546 static int nl80211_validate_ap_phy_operation(struct cfg80211_ap_settings *params) 6547 { 6548 struct ieee80211_channel *channel = params->chandef.chan; 6549 6550 if ((params->he_cap || params->he_oper) && 6551 (channel->flags & IEEE80211_CHAN_NO_HE)) 6552 return -EOPNOTSUPP; 6553 6554 if ((params->eht_cap || params->eht_oper) && 6555 (channel->flags & IEEE80211_CHAN_NO_EHT)) 6556 return -EOPNOTSUPP; 6557 6558 return 0; 6559 } 6560 6561 static int 6562 nl80211_parse_s1g_short_beacon(struct cfg80211_registered_device *rdev, 6563 struct nlattr *attrs, 6564 struct cfg80211_s1g_short_beacon *sb) 6565 { 6566 struct nlattr *tb[NL80211_S1G_SHORT_BEACON_ATTR_MAX + 1]; 6567 int ret; 6568 6569 if (!rdev->wiphy.bands[NL80211_BAND_S1GHZ]) 6570 return -EINVAL; 6571 6572 ret = nla_parse_nested(tb, NL80211_S1G_SHORT_BEACON_ATTR_MAX, attrs, 6573 NULL, NULL); 6574 if (ret) 6575 return ret; 6576 6577 /* Short beacon tail is optional (i.e might only include the TIM) */ 6578 if (!tb[NL80211_S1G_SHORT_BEACON_ATTR_HEAD]) 6579 return -EINVAL; 6580 6581 sb->short_head = nla_data(tb[NL80211_S1G_SHORT_BEACON_ATTR_HEAD]); 6582 sb->short_head_len = nla_len(tb[NL80211_S1G_SHORT_BEACON_ATTR_HEAD]); 6583 sb->short_tail_len = 0; 6584 6585 if (tb[NL80211_S1G_SHORT_BEACON_ATTR_TAIL]) { 6586 sb->short_tail = 6587 nla_data(tb[NL80211_S1G_SHORT_BEACON_ATTR_TAIL]); 6588 sb->short_tail_len = 6589 nla_len(tb[NL80211_S1G_SHORT_BEACON_ATTR_TAIL]); 6590 } 6591 6592 sb->update = true; 6593 return 0; 6594 } 6595 6596 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info) 6597 { 6598 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6599 struct cfg80211_beaconing_check_config beacon_check = {}; 6600 unsigned int link_id = nl80211_link_id(info->attrs); 6601 struct net_device *dev = info->user_ptr[1]; 6602 struct wireless_dev *wdev = dev->ieee80211_ptr; 6603 struct cfg80211_ap_settings *params; 6604 int err; 6605 6606 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6607 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6608 return -EOPNOTSUPP; 6609 6610 if (!rdev->ops->start_ap) 6611 return -EOPNOTSUPP; 6612 6613 if (wdev->links[link_id].cac_started) 6614 return -EBUSY; 6615 6616 if (wdev->links[link_id].ap.beacon_interval) 6617 return -EALREADY; 6618 6619 /* these are required for START_AP */ 6620 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] || 6621 !info->attrs[NL80211_ATTR_DTIM_PERIOD] || 6622 !info->attrs[NL80211_ATTR_BEACON_HEAD]) 6623 return -EINVAL; 6624 6625 if (info->attrs[NL80211_ATTR_SMPS_MODE] && 6626 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]) != NL80211_SMPS_OFF) 6627 return -EOPNOTSUPP; 6628 6629 params = kzalloc(sizeof(*params), GFP_KERNEL); 6630 if (!params) 6631 return -ENOMEM; 6632 6633 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6634 info->extack); 6635 if (err) 6636 goto out; 6637 6638 params->beacon_interval = 6639 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 6640 params->dtim_period = 6641 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 6642 6643 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype, 6644 params->beacon_interval); 6645 if (err) 6646 goto out; 6647 6648 /* 6649 * In theory, some of these attributes should be required here 6650 * but since they were not used when the command was originally 6651 * added, keep them optional for old user space programs to let 6652 * them continue to work with drivers that do not need the 6653 * additional information -- drivers must check! 6654 */ 6655 if (info->attrs[NL80211_ATTR_SSID]) { 6656 params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 6657 params->ssid_len = 6658 nla_len(info->attrs[NL80211_ATTR_SSID]); 6659 if (params->ssid_len == 0) { 6660 err = -EINVAL; 6661 goto out; 6662 } 6663 6664 if (wdev->u.ap.ssid_len && 6665 (wdev->u.ap.ssid_len != params->ssid_len || 6666 memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) { 6667 /* require identical SSID for MLO */ 6668 err = -EINVAL; 6669 goto out; 6670 } 6671 } else if (wdev->valid_links) { 6672 /* require SSID for MLO */ 6673 err = -EINVAL; 6674 goto out; 6675 } 6676 6677 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) 6678 params->hidden_ssid = nla_get_u32( 6679 info->attrs[NL80211_ATTR_HIDDEN_SSID]); 6680 6681 params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 6682 6683 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 6684 params->auth_type = nla_get_u32( 6685 info->attrs[NL80211_ATTR_AUTH_TYPE]); 6686 if (!nl80211_valid_auth_type(rdev, params->auth_type, 6687 NL80211_CMD_START_AP)) { 6688 err = -EINVAL; 6689 goto out; 6690 } 6691 } else 6692 params->auth_type = NL80211_AUTHTYPE_AUTOMATIC; 6693 6694 err = nl80211_crypto_settings(rdev, info, ¶ms->crypto, 6695 NL80211_MAX_NR_CIPHER_SUITES); 6696 if (err) 6697 goto out; 6698 6699 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) { 6700 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) { 6701 err = -EOPNOTSUPP; 6702 goto out; 6703 } 6704 params->inactivity_timeout = nla_get_u16( 6705 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]); 6706 } 6707 6708 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 6709 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6710 err = -EINVAL; 6711 goto out; 6712 } 6713 params->p2p_ctwindow = 6714 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 6715 if (params->p2p_ctwindow != 0 && 6716 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) { 6717 err = -EINVAL; 6718 goto out; 6719 } 6720 } 6721 6722 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 6723 u8 tmp; 6724 6725 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6726 err = -EINVAL; 6727 goto out; 6728 } 6729 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 6730 params->p2p_opp_ps = tmp; 6731 if (params->p2p_opp_ps != 0 && 6732 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) { 6733 err = -EINVAL; 6734 goto out; 6735 } 6736 } 6737 6738 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 6739 err = nl80211_parse_chandef(rdev, info, ¶ms->chandef); 6740 if (err) 6741 goto out; 6742 } else if (wdev->valid_links) { 6743 /* with MLD need to specify the channel configuration */ 6744 err = -EINVAL; 6745 goto out; 6746 } else if (wdev->u.ap.preset_chandef.chan) { 6747 params->chandef = wdev->u.ap.preset_chandef; 6748 } else if (!nl80211_get_ap_channel(rdev, params)) { 6749 err = -EINVAL; 6750 goto out; 6751 } 6752 6753 beacon_check.iftype = wdev->iftype; 6754 beacon_check.relax = true; 6755 beacon_check.reg_power = 6756 cfg80211_get_6ghz_power_type(params->beacon.tail, 6757 params->beacon.tail_len, 0); 6758 if (!cfg80211_reg_check_beaconing(&rdev->wiphy, ¶ms->chandef, 6759 &beacon_check)) { 6760 err = -EINVAL; 6761 goto out; 6762 } 6763 6764 if (info->attrs[NL80211_ATTR_TX_RATES]) { 6765 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 6766 NL80211_ATTR_TX_RATES, 6767 ¶ms->beacon_rate, 6768 dev, false, link_id); 6769 if (err) 6770 goto out; 6771 6772 err = validate_beacon_tx_rate(rdev, params->chandef.chan->band, 6773 ¶ms->beacon_rate); 6774 if (err) 6775 goto out; 6776 } 6777 6778 params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 6779 if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 6780 err = -EOPNOTSUPP; 6781 goto out; 6782 } 6783 6784 if (info->attrs[NL80211_ATTR_ACL_POLICY]) { 6785 params->acl = parse_acl_data(&rdev->wiphy, info); 6786 if (IS_ERR(params->acl)) { 6787 err = PTR_ERR(params->acl); 6788 params->acl = NULL; 6789 goto out; 6790 } 6791 } 6792 6793 params->twt_responder = 6794 nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]); 6795 6796 if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) { 6797 err = nl80211_parse_he_obss_pd( 6798 info->attrs[NL80211_ATTR_HE_OBSS_PD], 6799 ¶ms->he_obss_pd); 6800 if (err) 6801 goto out; 6802 } 6803 6804 if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) { 6805 err = nl80211_parse_fils_discovery(rdev, 6806 info->attrs[NL80211_ATTR_FILS_DISCOVERY], 6807 ¶ms->fils_discovery); 6808 if (err) 6809 goto out; 6810 } 6811 6812 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 6813 err = nl80211_parse_unsol_bcast_probe_resp( 6814 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 6815 ¶ms->unsol_bcast_probe_resp); 6816 if (err) 6817 goto out; 6818 } 6819 6820 if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) { 6821 err = nl80211_parse_mbssid_config(&rdev->wiphy, dev, link_id, 6822 info->attrs[NL80211_ATTR_MBSSID_CONFIG], 6823 ¶ms->mbssid_config, 6824 params->beacon.mbssid_ies ? 6825 params->beacon.mbssid_ies->cnt : 6826 0); 6827 if (err) 6828 goto out; 6829 } 6830 6831 if (!params->mbssid_config.ema && params->beacon.rnr_ies) { 6832 err = -EINVAL; 6833 goto out; 6834 } 6835 6836 if (info->attrs[NL80211_ATTR_S1G_SHORT_BEACON]) { 6837 if (!info->attrs[NL80211_ATTR_S1G_LONG_BEACON_PERIOD]) { 6838 err = -EINVAL; 6839 goto out; 6840 } 6841 6842 params->s1g_long_beacon_period = nla_get_u8( 6843 info->attrs[NL80211_ATTR_S1G_LONG_BEACON_PERIOD]); 6844 6845 err = nl80211_parse_s1g_short_beacon( 6846 rdev, info->attrs[NL80211_ATTR_S1G_SHORT_BEACON], 6847 ¶ms->s1g_short_beacon); 6848 if (err) 6849 goto out; 6850 } 6851 6852 err = nl80211_calculate_ap_params(params); 6853 if (err) 6854 goto out; 6855 6856 err = nl80211_validate_ap_phy_operation(params); 6857 if (err) 6858 goto out; 6859 6860 if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]) 6861 params->flags = nla_get_u32( 6862 info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]); 6863 else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT]) 6864 params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT; 6865 6866 if (wdev->conn_owner_nlportid && 6867 info->attrs[NL80211_ATTR_SOCKET_OWNER] && 6868 wdev->conn_owner_nlportid != info->snd_portid) { 6869 err = -EINVAL; 6870 goto out; 6871 } 6872 6873 /* FIXME: validate MLO/link-id against driver capabilities */ 6874 6875 err = rdev_start_ap(rdev, dev, params); 6876 if (!err) { 6877 wdev->links[link_id].ap.beacon_interval = params->beacon_interval; 6878 wdev->links[link_id].ap.chandef = params->chandef; 6879 wdev->u.ap.ssid_len = params->ssid_len; 6880 memcpy(wdev->u.ap.ssid, params->ssid, 6881 params->ssid_len); 6882 6883 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 6884 wdev->conn_owner_nlportid = info->snd_portid; 6885 6886 nl80211_send_ap_started(wdev, link_id); 6887 } 6888 out: 6889 kfree(params->acl); 6890 kfree(params->beacon.mbssid_ies); 6891 if (params->mbssid_config.tx_wdev && 6892 params->mbssid_config.tx_wdev->netdev && 6893 params->mbssid_config.tx_wdev->netdev != dev) 6894 dev_put(params->mbssid_config.tx_wdev->netdev); 6895 kfree(params->beacon.rnr_ies); 6896 kfree(params); 6897 6898 return err; 6899 } 6900 6901 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info) 6902 { 6903 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6904 struct cfg80211_beaconing_check_config beacon_check = {}; 6905 unsigned int link_id = nl80211_link_id(info->attrs); 6906 struct net_device *dev = info->user_ptr[1]; 6907 struct wireless_dev *wdev = dev->ieee80211_ptr; 6908 struct cfg80211_ap_update *params; 6909 struct nlattr *attr; 6910 int err; 6911 6912 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6913 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6914 return -EOPNOTSUPP; 6915 6916 if (!rdev->ops->change_beacon) 6917 return -EOPNOTSUPP; 6918 6919 if (!wdev->links[link_id].ap.beacon_interval) 6920 return -EINVAL; 6921 6922 params = kzalloc(sizeof(*params), GFP_KERNEL); 6923 if (!params) 6924 return -ENOMEM; 6925 6926 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6927 info->extack); 6928 if (err) 6929 goto out; 6930 6931 /* recheck beaconing is permitted with possibly changed power type */ 6932 beacon_check.iftype = wdev->iftype; 6933 beacon_check.relax = true; 6934 beacon_check.reg_power = 6935 cfg80211_get_6ghz_power_type(params->beacon.tail, 6936 params->beacon.tail_len, 0); 6937 if (!cfg80211_reg_check_beaconing(&rdev->wiphy, 6938 &wdev->links[link_id].ap.chandef, 6939 &beacon_check)) { 6940 err = -EINVAL; 6941 goto out; 6942 } 6943 6944 attr = info->attrs[NL80211_ATTR_FILS_DISCOVERY]; 6945 if (attr) { 6946 err = nl80211_parse_fils_discovery(rdev, attr, 6947 ¶ms->fils_discovery); 6948 if (err) 6949 goto out; 6950 } 6951 6952 attr = info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]; 6953 if (attr) { 6954 err = nl80211_parse_unsol_bcast_probe_resp(rdev, attr, 6955 ¶ms->unsol_bcast_probe_resp); 6956 if (err) 6957 goto out; 6958 } 6959 6960 attr = info->attrs[NL80211_ATTR_S1G_SHORT_BEACON]; 6961 if (attr) { 6962 err = nl80211_parse_s1g_short_beacon(rdev, attr, 6963 ¶ms->s1g_short_beacon); 6964 if (err) 6965 goto out; 6966 } 6967 6968 err = rdev_change_beacon(rdev, dev, params); 6969 6970 out: 6971 kfree(params->beacon.mbssid_ies); 6972 kfree(params->beacon.rnr_ies); 6973 kfree(params); 6974 return err; 6975 } 6976 6977 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info) 6978 { 6979 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6980 unsigned int link_id = nl80211_link_id(info->attrs); 6981 struct net_device *dev = info->user_ptr[1]; 6982 6983 return cfg80211_stop_ap(rdev, dev, link_id, false); 6984 } 6985 6986 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = { 6987 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG }, 6988 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG }, 6989 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG }, 6990 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG }, 6991 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG }, 6992 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG }, 6993 }; 6994 6995 static int parse_station_flags(struct genl_info *info, 6996 enum nl80211_iftype iftype, 6997 struct station_parameters *params) 6998 { 6999 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1]; 7000 struct nlattr *nla; 7001 int flag; 7002 7003 /* 7004 * Try parsing the new attribute first so userspace 7005 * can specify both for older kernels. 7006 */ 7007 nla = info->attrs[NL80211_ATTR_STA_FLAGS2]; 7008 if (nla) { 7009 struct nl80211_sta_flag_update *sta_flags; 7010 7011 sta_flags = nla_data(nla); 7012 params->sta_flags_mask = sta_flags->mask; 7013 params->sta_flags_set = sta_flags->set; 7014 params->sta_flags_set &= params->sta_flags_mask; 7015 if ((params->sta_flags_mask | 7016 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID)) 7017 return -EINVAL; 7018 return 0; 7019 } 7020 7021 /* if present, parse the old attribute */ 7022 7023 nla = info->attrs[NL80211_ATTR_STA_FLAGS]; 7024 if (!nla) 7025 return 0; 7026 7027 if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack)) 7028 return -EINVAL; 7029 7030 /* 7031 * Only allow certain flags for interface types so that 7032 * other attributes are silently ignored. Remember that 7033 * this is backward compatibility code with old userspace 7034 * and shouldn't be hit in other cases anyway. 7035 */ 7036 switch (iftype) { 7037 case NL80211_IFTYPE_AP: 7038 case NL80211_IFTYPE_AP_VLAN: 7039 case NL80211_IFTYPE_P2P_GO: 7040 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 7041 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 7042 BIT(NL80211_STA_FLAG_WME) | 7043 BIT(NL80211_STA_FLAG_MFP); 7044 break; 7045 case NL80211_IFTYPE_P2P_CLIENT: 7046 case NL80211_IFTYPE_STATION: 7047 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 7048 BIT(NL80211_STA_FLAG_TDLS_PEER); 7049 break; 7050 case NL80211_IFTYPE_MESH_POINT: 7051 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7052 BIT(NL80211_STA_FLAG_MFP) | 7053 BIT(NL80211_STA_FLAG_AUTHORIZED); 7054 break; 7055 default: 7056 return -EINVAL; 7057 } 7058 7059 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) { 7060 if (flags[flag]) { 7061 params->sta_flags_set |= (1<<flag); 7062 7063 /* no longer support new API additions in old API */ 7064 if (flag > NL80211_STA_FLAG_MAX_OLD_API) 7065 return -EINVAL; 7066 } 7067 } 7068 7069 return 0; 7070 } 7071 7072 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr) 7073 { 7074 struct nlattr *rate; 7075 u32 bitrate; 7076 u16 bitrate_compat; 7077 enum nl80211_rate_info rate_flg; 7078 7079 rate = nla_nest_start_noflag(msg, attr); 7080 if (!rate) 7081 return false; 7082 7083 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */ 7084 bitrate = cfg80211_calculate_bitrate(info); 7085 /* report 16-bit bitrate only if we can */ 7086 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0; 7087 if (bitrate > 0 && 7088 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate)) 7089 return false; 7090 if (bitrate_compat > 0 && 7091 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat)) 7092 return false; 7093 7094 switch (info->bw) { 7095 case RATE_INFO_BW_1: 7096 rate_flg = NL80211_RATE_INFO_1_MHZ_WIDTH; 7097 break; 7098 case RATE_INFO_BW_2: 7099 rate_flg = NL80211_RATE_INFO_2_MHZ_WIDTH; 7100 break; 7101 case RATE_INFO_BW_4: 7102 rate_flg = NL80211_RATE_INFO_4_MHZ_WIDTH; 7103 break; 7104 case RATE_INFO_BW_5: 7105 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH; 7106 break; 7107 case RATE_INFO_BW_8: 7108 rate_flg = NL80211_RATE_INFO_8_MHZ_WIDTH; 7109 break; 7110 case RATE_INFO_BW_10: 7111 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH; 7112 break; 7113 case RATE_INFO_BW_16: 7114 rate_flg = NL80211_RATE_INFO_16_MHZ_WIDTH; 7115 break; 7116 default: 7117 WARN_ON(1); 7118 fallthrough; 7119 case RATE_INFO_BW_20: 7120 rate_flg = 0; 7121 break; 7122 case RATE_INFO_BW_40: 7123 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH; 7124 break; 7125 case RATE_INFO_BW_80: 7126 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH; 7127 break; 7128 case RATE_INFO_BW_160: 7129 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH; 7130 break; 7131 case RATE_INFO_BW_HE_RU: 7132 rate_flg = 0; 7133 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS)); 7134 break; 7135 case RATE_INFO_BW_320: 7136 rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH; 7137 break; 7138 case RATE_INFO_BW_EHT_RU: 7139 rate_flg = 0; 7140 WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS)); 7141 break; 7142 } 7143 7144 if (rate_flg && nla_put_flag(msg, rate_flg)) 7145 return false; 7146 7147 if (info->flags & RATE_INFO_FLAGS_MCS) { 7148 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs)) 7149 return false; 7150 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 7151 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 7152 return false; 7153 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) { 7154 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs)) 7155 return false; 7156 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss)) 7157 return false; 7158 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 7159 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 7160 return false; 7161 } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) { 7162 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs)) 7163 return false; 7164 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss)) 7165 return false; 7166 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi)) 7167 return false; 7168 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm)) 7169 return false; 7170 if (info->bw == RATE_INFO_BW_HE_RU && 7171 nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC, 7172 info->he_ru_alloc)) 7173 return false; 7174 } else if (info->flags & RATE_INFO_FLAGS_S1G_MCS) { 7175 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_MCS, info->mcs)) 7176 return false; 7177 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_NSS, info->nss)) 7178 return false; 7179 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 7180 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 7181 return false; 7182 } else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) { 7183 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs)) 7184 return false; 7185 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss)) 7186 return false; 7187 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi)) 7188 return false; 7189 if (info->bw == RATE_INFO_BW_EHT_RU && 7190 nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC, 7191 info->eht_ru_alloc)) 7192 return false; 7193 } 7194 7195 nla_nest_end(msg, rate); 7196 return true; 7197 } 7198 7199 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal, 7200 int id) 7201 { 7202 void *attr; 7203 int i = 0; 7204 7205 if (!mask) 7206 return true; 7207 7208 attr = nla_nest_start_noflag(msg, id); 7209 if (!attr) 7210 return false; 7211 7212 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { 7213 if (!(mask & BIT(i))) 7214 continue; 7215 7216 if (nla_put_u8(msg, i, signal[i])) 7217 return false; 7218 } 7219 7220 nla_nest_end(msg, attr); 7221 7222 return true; 7223 } 7224 7225 static int nl80211_fill_link_station(struct sk_buff *msg, 7226 struct cfg80211_registered_device *rdev, 7227 struct link_station_info *link_sinfo) 7228 { 7229 struct nlattr *bss_param, *link_sinfoattr; 7230 7231 #define PUT_LINK_SINFO(attr, memb, type) do { \ 7232 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 7233 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7234 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 7235 link_sinfo->memb)) \ 7236 goto nla_put_failure; \ 7237 } while (0) 7238 #define PUT_LINK_SINFO_U64(attr, memb) do { \ 7239 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7240 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 7241 link_sinfo->memb, NL80211_STA_INFO_PAD)) \ 7242 goto nla_put_failure; \ 7243 } while (0) 7244 7245 link_sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 7246 if (!link_sinfoattr) 7247 goto nla_put_failure; 7248 7249 PUT_LINK_SINFO(INACTIVE_TIME, inactive_time, u32); 7250 7251 if (link_sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 7252 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 7253 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 7254 (u32)link_sinfo->rx_bytes)) 7255 goto nla_put_failure; 7256 7257 if (link_sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 7258 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 7259 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 7260 (u32)link_sinfo->tx_bytes)) 7261 goto nla_put_failure; 7262 7263 PUT_LINK_SINFO_U64(RX_BYTES64, rx_bytes); 7264 PUT_LINK_SINFO_U64(TX_BYTES64, tx_bytes); 7265 PUT_LINK_SINFO_U64(RX_DURATION, rx_duration); 7266 PUT_LINK_SINFO_U64(TX_DURATION, tx_duration); 7267 7268 if (wiphy_ext_feature_isset(&rdev->wiphy, 7269 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7270 PUT_LINK_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 7271 7272 switch (rdev->wiphy.signal_type) { 7273 case CFG80211_SIGNAL_TYPE_MBM: 7274 PUT_LINK_SINFO(SIGNAL, signal, u8); 7275 PUT_LINK_SINFO(SIGNAL_AVG, signal_avg, u8); 7276 break; 7277 default: 7278 break; 7279 } 7280 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 7281 if (!nl80211_put_signal(msg, link_sinfo->chains, 7282 link_sinfo->chain_signal, 7283 NL80211_STA_INFO_CHAIN_SIGNAL)) 7284 goto nla_put_failure; 7285 } 7286 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 7287 if (!nl80211_put_signal(msg, link_sinfo->chains, 7288 link_sinfo->chain_signal_avg, 7289 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 7290 goto nla_put_failure; 7291 } 7292 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 7293 if (!nl80211_put_sta_rate(msg, &link_sinfo->txrate, 7294 NL80211_STA_INFO_TX_BITRATE)) 7295 goto nla_put_failure; 7296 } 7297 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 7298 if (!nl80211_put_sta_rate(msg, &link_sinfo->rxrate, 7299 NL80211_STA_INFO_RX_BITRATE)) 7300 goto nla_put_failure; 7301 } 7302 7303 PUT_LINK_SINFO(RX_PACKETS, rx_packets, u32); 7304 PUT_LINK_SINFO(TX_PACKETS, tx_packets, u32); 7305 PUT_LINK_SINFO(TX_RETRIES, tx_retries, u32); 7306 PUT_LINK_SINFO(TX_FAILED, tx_failed, u32); 7307 PUT_LINK_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 7308 PUT_LINK_SINFO(BEACON_LOSS, beacon_loss_count, u32); 7309 7310 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 7311 bss_param = nla_nest_start_noflag(msg, 7312 NL80211_STA_INFO_BSS_PARAM); 7313 if (!bss_param) 7314 goto nla_put_failure; 7315 7316 if (((link_sinfo->bss_param.flags & 7317 BSS_PARAM_FLAGS_CTS_PROT) && 7318 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 7319 ((link_sinfo->bss_param.flags & 7320 BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 7321 nla_put_flag(msg, 7322 NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 7323 ((link_sinfo->bss_param.flags & 7324 BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 7325 nla_put_flag(msg, 7326 NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 7327 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 7328 link_sinfo->bss_param.dtim_period) || 7329 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 7330 link_sinfo->bss_param.beacon_interval)) 7331 goto nla_put_failure; 7332 7333 nla_nest_end(msg, bss_param); 7334 } 7335 7336 PUT_LINK_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 7337 PUT_LINK_SINFO_U64(BEACON_RX, rx_beacon); 7338 PUT_LINK_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 7339 PUT_LINK_SINFO(RX_MPDUS, rx_mpdu_count, u32); 7340 PUT_LINK_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 7341 if (wiphy_ext_feature_isset(&rdev->wiphy, 7342 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 7343 PUT_LINK_SINFO(ACK_SIGNAL, ack_signal, u8); 7344 PUT_LINK_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 7345 } 7346 7347 #undef PUT_LINK_SINFO 7348 #undef PUT_LINK_SINFO_U64 7349 7350 if (link_sinfo->pertid) { 7351 struct nlattr *tidsattr; 7352 int tid; 7353 7354 tidsattr = nla_nest_start_noflag(msg, 7355 NL80211_STA_INFO_TID_STATS); 7356 if (!tidsattr) 7357 goto nla_put_failure; 7358 7359 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 7360 struct cfg80211_tid_stats *tidstats; 7361 struct nlattr *tidattr; 7362 7363 tidstats = &link_sinfo->pertid[tid]; 7364 7365 if (!tidstats->filled) 7366 continue; 7367 7368 tidattr = nla_nest_start_noflag(msg, tid + 1); 7369 if (!tidattr) 7370 goto nla_put_failure; 7371 7372 #define PUT_TIDVAL_U64(attr, memb) do { \ 7373 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 7374 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 7375 tidstats->memb, NL80211_TID_STATS_PAD)) \ 7376 goto nla_put_failure; \ 7377 } while (0) 7378 7379 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 7380 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 7381 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 7382 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 7383 7384 #undef PUT_TIDVAL_U64 7385 if ((tidstats->filled & 7386 BIT(NL80211_TID_STATS_TXQ_STATS)) && 7387 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 7388 NL80211_TID_STATS_TXQ_STATS)) 7389 goto nla_put_failure; 7390 7391 nla_nest_end(msg, tidattr); 7392 } 7393 7394 nla_nest_end(msg, tidsattr); 7395 } 7396 7397 nla_nest_end(msg, link_sinfoattr); 7398 return 0; 7399 7400 nla_put_failure: 7401 return -EMSGSIZE; 7402 } 7403 7404 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid, 7405 u32 seq, int flags, 7406 struct cfg80211_registered_device *rdev, 7407 struct net_device *dev, 7408 const u8 *mac_addr, struct station_info *sinfo, 7409 bool link_stats) 7410 { 7411 void *hdr; 7412 struct nlattr *sinfoattr, *bss_param; 7413 struct link_station_info *link_sinfo; 7414 struct nlattr *links, *link; 7415 int link_id; 7416 7417 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 7418 if (!hdr) { 7419 cfg80211_sinfo_release_content(sinfo); 7420 return -1; 7421 } 7422 7423 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 7424 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 7425 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation)) 7426 goto nla_put_failure; 7427 7428 sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 7429 if (!sinfoattr) 7430 goto nla_put_failure; 7431 7432 #define PUT_SINFO(attr, memb, type) do { \ 7433 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 7434 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7435 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 7436 sinfo->memb)) \ 7437 goto nla_put_failure; \ 7438 } while (0) 7439 #define PUT_SINFO_U64(attr, memb) do { \ 7440 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7441 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 7442 sinfo->memb, NL80211_STA_INFO_PAD)) \ 7443 goto nla_put_failure; \ 7444 } while (0) 7445 7446 PUT_SINFO(CONNECTED_TIME, connected_time, u32); 7447 PUT_SINFO(INACTIVE_TIME, inactive_time, u32); 7448 PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at); 7449 7450 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 7451 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 7452 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 7453 (u32)sinfo->rx_bytes)) 7454 goto nla_put_failure; 7455 7456 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 7457 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 7458 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 7459 (u32)sinfo->tx_bytes)) 7460 goto nla_put_failure; 7461 7462 PUT_SINFO_U64(RX_BYTES64, rx_bytes); 7463 PUT_SINFO_U64(TX_BYTES64, tx_bytes); 7464 PUT_SINFO_U64(RX_DURATION, rx_duration); 7465 PUT_SINFO_U64(TX_DURATION, tx_duration); 7466 7467 if (wiphy_ext_feature_isset(&rdev->wiphy, 7468 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7469 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 7470 7471 switch (rdev->wiphy.signal_type) { 7472 case CFG80211_SIGNAL_TYPE_MBM: 7473 PUT_SINFO(SIGNAL, signal, u8); 7474 PUT_SINFO(SIGNAL_AVG, signal_avg, u8); 7475 break; 7476 default: 7477 break; 7478 } 7479 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 7480 if (!nl80211_put_signal(msg, sinfo->chains, 7481 sinfo->chain_signal, 7482 NL80211_STA_INFO_CHAIN_SIGNAL)) 7483 goto nla_put_failure; 7484 } 7485 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 7486 if (!nl80211_put_signal(msg, sinfo->chains, 7487 sinfo->chain_signal_avg, 7488 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 7489 goto nla_put_failure; 7490 } 7491 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 7492 if (!nl80211_put_sta_rate(msg, &sinfo->txrate, 7493 NL80211_STA_INFO_TX_BITRATE)) 7494 goto nla_put_failure; 7495 } 7496 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 7497 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate, 7498 NL80211_STA_INFO_RX_BITRATE)) 7499 goto nla_put_failure; 7500 } 7501 7502 PUT_SINFO(RX_PACKETS, rx_packets, u32); 7503 PUT_SINFO(TX_PACKETS, tx_packets, u32); 7504 PUT_SINFO(TX_RETRIES, tx_retries, u32); 7505 PUT_SINFO(TX_FAILED, tx_failed, u32); 7506 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 7507 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32); 7508 7509 PUT_SINFO(LLID, llid, u16); 7510 PUT_SINFO(PLID, plid, u16); 7511 PUT_SINFO(PLINK_STATE, plink_state, u8); 7512 PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32); 7513 PUT_SINFO(LOCAL_PM, local_pm, u32); 7514 PUT_SINFO(PEER_PM, peer_pm, u32); 7515 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32); 7516 PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8); 7517 PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8); 7518 PUT_SINFO_U64(T_OFFSET, t_offset); 7519 7520 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 7521 bss_param = nla_nest_start_noflag(msg, 7522 NL80211_STA_INFO_BSS_PARAM); 7523 if (!bss_param) 7524 goto nla_put_failure; 7525 7526 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) && 7527 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 7528 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 7529 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 7530 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 7531 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 7532 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 7533 sinfo->bss_param.dtim_period) || 7534 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 7535 sinfo->bss_param.beacon_interval)) 7536 goto nla_put_failure; 7537 7538 nla_nest_end(msg, bss_param); 7539 } 7540 if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) && 7541 nla_put(msg, NL80211_STA_INFO_STA_FLAGS, 7542 sizeof(struct nl80211_sta_flag_update), 7543 &sinfo->sta_flags)) 7544 goto nla_put_failure; 7545 7546 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 7547 PUT_SINFO_U64(BEACON_RX, rx_beacon); 7548 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 7549 PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32); 7550 PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 7551 if (wiphy_ext_feature_isset(&rdev->wiphy, 7552 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 7553 PUT_SINFO(ACK_SIGNAL, ack_signal, u8); 7554 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 7555 } 7556 7557 #undef PUT_SINFO 7558 #undef PUT_SINFO_U64 7559 7560 if (sinfo->pertid) { 7561 struct nlattr *tidsattr; 7562 int tid; 7563 7564 tidsattr = nla_nest_start_noflag(msg, 7565 NL80211_STA_INFO_TID_STATS); 7566 if (!tidsattr) 7567 goto nla_put_failure; 7568 7569 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 7570 struct cfg80211_tid_stats *tidstats; 7571 struct nlattr *tidattr; 7572 7573 tidstats = &sinfo->pertid[tid]; 7574 7575 if (!tidstats->filled) 7576 continue; 7577 7578 tidattr = nla_nest_start_noflag(msg, tid + 1); 7579 if (!tidattr) 7580 goto nla_put_failure; 7581 7582 #define PUT_TIDVAL_U64(attr, memb) do { \ 7583 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 7584 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 7585 tidstats->memb, NL80211_TID_STATS_PAD)) \ 7586 goto nla_put_failure; \ 7587 } while (0) 7588 7589 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 7590 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 7591 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 7592 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 7593 7594 #undef PUT_TIDVAL_U64 7595 if ((tidstats->filled & 7596 BIT(NL80211_TID_STATS_TXQ_STATS)) && 7597 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 7598 NL80211_TID_STATS_TXQ_STATS)) 7599 goto nla_put_failure; 7600 7601 nla_nest_end(msg, tidattr); 7602 } 7603 7604 nla_nest_end(msg, tidsattr); 7605 } 7606 7607 nla_nest_end(msg, sinfoattr); 7608 7609 if (sinfo->assoc_req_ies_len && 7610 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len, 7611 sinfo->assoc_req_ies)) 7612 goto nla_put_failure; 7613 7614 if (sinfo->assoc_resp_ies_len && 7615 nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len, 7616 sinfo->assoc_resp_ies)) 7617 goto nla_put_failure; 7618 7619 if (sinfo->mlo_params_valid) { 7620 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 7621 sinfo->assoc_link_id)) 7622 goto nla_put_failure; 7623 7624 if (!is_zero_ether_addr(sinfo->mld_addr) && 7625 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 7626 sinfo->mld_addr)) 7627 goto nla_put_failure; 7628 } 7629 7630 if (link_stats && sinfo->valid_links) { 7631 links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 7632 if (!links) 7633 goto nla_put_failure; 7634 7635 for_each_valid_link(sinfo, link_id) { 7636 link_sinfo = sinfo->links[link_id]; 7637 7638 if (WARN_ON_ONCE(!link_sinfo)) 7639 continue; 7640 7641 if (!is_valid_ether_addr(link_sinfo->addr)) 7642 continue; 7643 7644 link = nla_nest_start(msg, link_id + 1); 7645 if (!link) 7646 goto nla_put_failure; 7647 7648 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 7649 link_id)) 7650 goto nla_put_failure; 7651 7652 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 7653 link_sinfo->addr)) 7654 goto nla_put_failure; 7655 7656 if (nl80211_fill_link_station(msg, rdev, link_sinfo)) 7657 goto nla_put_failure; 7658 7659 nla_nest_end(msg, link); 7660 } 7661 nla_nest_end(msg, links); 7662 } 7663 7664 cfg80211_sinfo_release_content(sinfo); 7665 genlmsg_end(msg, hdr); 7666 return 0; 7667 7668 nla_put_failure: 7669 cfg80211_sinfo_release_content(sinfo); 7670 genlmsg_cancel(msg, hdr); 7671 return -EMSGSIZE; 7672 } 7673 7674 static void cfg80211_sta_set_mld_sinfo(struct station_info *sinfo) 7675 { 7676 struct link_station_info *link_sinfo; 7677 int link_id, init = 0; 7678 u32 link_inactive_time; 7679 7680 sinfo->signal = -99; 7681 7682 for_each_valid_link(sinfo, link_id) { 7683 link_sinfo = sinfo->links[link_id]; 7684 if (!link_sinfo) 7685 continue; 7686 7687 if ((link_sinfo->filled & 7688 BIT_ULL(NL80211_STA_INFO_TX_PACKETS))) { 7689 sinfo->tx_packets += link_sinfo->tx_packets; 7690 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_PACKETS); 7691 } 7692 7693 if ((link_sinfo->filled & 7694 BIT_ULL(NL80211_STA_INFO_RX_PACKETS))) { 7695 sinfo->rx_packets += link_sinfo->rx_packets; 7696 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_PACKETS); 7697 } 7698 7699 if (link_sinfo->filled & 7700 (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 7701 BIT_ULL(NL80211_STA_INFO_TX_BYTES64))) { 7702 sinfo->tx_bytes += link_sinfo->tx_bytes; 7703 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BYTES); 7704 } 7705 7706 if (link_sinfo->filled & 7707 (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 7708 BIT_ULL(NL80211_STA_INFO_TX_BYTES64))) { 7709 sinfo->rx_bytes += link_sinfo->rx_bytes; 7710 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_BYTES); 7711 } 7712 7713 if (link_sinfo->filled & 7714 BIT_ULL(NL80211_STA_INFO_TX_RETRIES)) { 7715 sinfo->tx_retries += link_sinfo->tx_retries; 7716 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_RETRIES); 7717 } 7718 7719 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_FAILED)) { 7720 sinfo->tx_failed += link_sinfo->tx_failed; 7721 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_FAILED); 7722 } 7723 7724 if (link_sinfo->filled & 7725 BIT_ULL(NL80211_STA_INFO_RX_DROP_MISC)) { 7726 sinfo->rx_dropped_misc += link_sinfo->rx_dropped_misc; 7727 sinfo->filled |= 7728 BIT_ULL(NL80211_STA_INFO_RX_DROP_MISC); 7729 } 7730 7731 if (link_sinfo->filled & 7732 BIT_ULL(NL80211_STA_INFO_BEACON_LOSS)) { 7733 sinfo->beacon_loss_count += 7734 link_sinfo->beacon_loss_count; 7735 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_BEACON_LOSS); 7736 } 7737 7738 if (link_sinfo->filled & 7739 BIT_ULL(NL80211_STA_INFO_EXPECTED_THROUGHPUT)) { 7740 sinfo->expected_throughput += 7741 link_sinfo->expected_throughput; 7742 sinfo->filled |= 7743 BIT_ULL(NL80211_STA_INFO_EXPECTED_THROUGHPUT); 7744 } 7745 7746 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_MPDUS)) { 7747 sinfo->rx_mpdu_count += link_sinfo->rx_mpdu_count; 7748 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_MPDUS); 7749 } 7750 7751 if (link_sinfo->filled & 7752 BIT_ULL(NL80211_STA_INFO_FCS_ERROR_COUNT)) { 7753 sinfo->fcs_err_count += link_sinfo->fcs_err_count; 7754 sinfo->filled |= 7755 BIT_ULL(NL80211_STA_INFO_FCS_ERROR_COUNT); 7756 } 7757 7758 if (link_sinfo->filled & 7759 BIT_ULL(NL80211_STA_INFO_BEACON_RX)) { 7760 sinfo->rx_beacon += link_sinfo->rx_beacon; 7761 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_BEACON_RX); 7762 } 7763 7764 /* Update MLO signal, signal_avg as best among links */ 7765 if ((link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_SIGNAL)) && 7766 link_sinfo->signal > sinfo->signal) { 7767 sinfo->signal = link_sinfo->signal; 7768 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL); 7769 } 7770 7771 if ((link_sinfo->filled & 7772 BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG)) && 7773 link_sinfo->signal_avg > sinfo->signal_avg) { 7774 sinfo->signal_avg = link_sinfo->signal_avg; 7775 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG); 7776 } 7777 7778 /* Update MLO inactive_time, bss_param based on least 7779 * value for corresponding field of link. 7780 */ 7781 if ((link_sinfo->filled & 7782 BIT_ULL(NL80211_STA_INFO_INACTIVE_TIME)) && 7783 (!init || 7784 link_inactive_time > link_sinfo->inactive_time)) { 7785 link_inactive_time = link_sinfo->inactive_time; 7786 sinfo->inactive_time = link_sinfo->inactive_time; 7787 sinfo->filled |= NL80211_STA_INFO_INACTIVE_TIME; 7788 } 7789 7790 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM) && 7791 (!init || 7792 sinfo->bss_param.dtim_period > 7793 link_sinfo->bss_param.dtim_period)) { 7794 sinfo->bss_param.dtim_period = 7795 link_sinfo->bss_param.dtim_period; 7796 sinfo->filled |= NL80211_STA_BSS_PARAM_DTIM_PERIOD; 7797 sinfo->bss_param.beacon_interval = 7798 link_sinfo->bss_param.beacon_interval; 7799 sinfo->filled |= NL80211_STA_BSS_PARAM_BEACON_INTERVAL; 7800 } 7801 7802 /* Update MLO rates as per last updated link rate */ 7803 if ((link_sinfo->filled & 7804 BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) && 7805 (!init || 7806 link_inactive_time > link_sinfo->inactive_time)) { 7807 sinfo->txrate = link_sinfo->txrate; 7808 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE); 7809 } 7810 if ((link_sinfo->filled & 7811 BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) && 7812 (!init || 7813 link_inactive_time > link_sinfo->inactive_time)) { 7814 sinfo->rxrate = link_sinfo->rxrate; 7815 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_BITRATE); 7816 } 7817 7818 if (link_sinfo->filled & 7819 BIT_ULL(NL80211_STA_INFO_TX_DURATION) && 7820 (!init || 7821 link_inactive_time > link_sinfo->inactive_time)) { 7822 sinfo->tx_duration += link_sinfo->tx_duration; 7823 sinfo->filled |= 7824 BIT_ULL(NL80211_STA_INFO_TX_DURATION); 7825 } 7826 if (link_sinfo->filled & 7827 BIT_ULL(NL80211_STA_INFO_RX_DURATION) && 7828 (!init || 7829 link_inactive_time > link_sinfo->inactive_time)) { 7830 sinfo->rx_duration += link_sinfo->rx_duration; 7831 sinfo->filled |= 7832 BIT_ULL(NL80211_STA_INFO_RX_DURATION); 7833 } 7834 init++; 7835 7836 /* pertid stats accumulate for rx/tx fields */ 7837 if (sinfo->pertid) { 7838 sinfo->pertid->rx_msdu += 7839 link_sinfo->pertid->rx_msdu; 7840 sinfo->pertid->tx_msdu += 7841 link_sinfo->pertid->tx_msdu; 7842 sinfo->pertid->tx_msdu_retries += 7843 link_sinfo->pertid->tx_msdu_retries; 7844 sinfo->pertid->tx_msdu_failed += 7845 link_sinfo->pertid->tx_msdu_failed; 7846 7847 sinfo->pertid->filled |= 7848 BIT(NL80211_TID_STATS_RX_MSDU) | 7849 BIT(NL80211_TID_STATS_TX_MSDU) | 7850 BIT(NL80211_TID_STATS_TX_MSDU_RETRIES) | 7851 BIT(NL80211_TID_STATS_TX_MSDU_FAILED); 7852 } 7853 } 7854 7855 /* Reset sinfo->filled bits to exclude fields which don't make 7856 * much sense at the MLO level. 7857 */ 7858 sinfo->filled &= ~BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL); 7859 sinfo->filled &= ~BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG); 7860 } 7861 7862 static int nl80211_dump_station(struct sk_buff *skb, 7863 struct netlink_callback *cb) 7864 { 7865 struct station_info sinfo; 7866 struct cfg80211_registered_device *rdev; 7867 struct wireless_dev *wdev; 7868 u8 mac_addr[ETH_ALEN]; 7869 int sta_idx = cb->args[2]; 7870 bool sinfo_alloc = false; 7871 int err, i; 7872 7873 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7874 if (err) 7875 return err; 7876 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7877 __acquire(&rdev->wiphy.mtx); 7878 7879 if (!wdev->netdev) { 7880 err = -EINVAL; 7881 goto out_err; 7882 } 7883 7884 if (!rdev->ops->dump_station) { 7885 err = -EOPNOTSUPP; 7886 goto out_err; 7887 } 7888 7889 while (1) { 7890 memset(&sinfo, 0, sizeof(sinfo)); 7891 7892 for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) { 7893 sinfo.links[i] = 7894 kzalloc(sizeof(*sinfo.links[0]), GFP_KERNEL); 7895 if (!sinfo.links[i]) { 7896 err = -ENOMEM; 7897 goto out_err; 7898 } 7899 sinfo_alloc = true; 7900 } 7901 7902 err = rdev_dump_station(rdev, wdev->netdev, sta_idx, 7903 mac_addr, &sinfo); 7904 if (err == -ENOENT) 7905 break; 7906 if (err) 7907 goto out_err; 7908 7909 if (sinfo.valid_links) 7910 cfg80211_sta_set_mld_sinfo(&sinfo); 7911 7912 /* reset the sinfo_alloc flag as nl80211_send_station() 7913 * always releases sinfo 7914 */ 7915 sinfo_alloc = false; 7916 7917 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION, 7918 NETLINK_CB(cb->skb).portid, 7919 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7920 rdev, wdev->netdev, mac_addr, 7921 &sinfo, false) < 0) 7922 goto out; 7923 7924 sta_idx++; 7925 } 7926 7927 out: 7928 cb->args[2] = sta_idx; 7929 err = skb->len; 7930 out_err: 7931 if (sinfo_alloc) 7932 cfg80211_sinfo_release_content(&sinfo); 7933 wiphy_unlock(&rdev->wiphy); 7934 7935 return err; 7936 } 7937 7938 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info) 7939 { 7940 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7941 struct net_device *dev = info->user_ptr[1]; 7942 struct station_info sinfo; 7943 struct sk_buff *msg; 7944 u8 *mac_addr = NULL; 7945 int err, i; 7946 7947 memset(&sinfo, 0, sizeof(sinfo)); 7948 7949 if (!info->attrs[NL80211_ATTR_MAC]) 7950 return -EINVAL; 7951 7952 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7953 7954 if (!rdev->ops->get_station) 7955 return -EOPNOTSUPP; 7956 7957 for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) { 7958 sinfo.links[i] = kzalloc(sizeof(*sinfo.links[0]), GFP_KERNEL); 7959 if (!sinfo.links[i]) { 7960 cfg80211_sinfo_release_content(&sinfo); 7961 return -ENOMEM; 7962 } 7963 } 7964 7965 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 7966 if (err) { 7967 cfg80211_sinfo_release_content(&sinfo); 7968 return err; 7969 } 7970 7971 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7972 if (!msg) { 7973 cfg80211_sinfo_release_content(&sinfo); 7974 return -ENOMEM; 7975 } 7976 7977 if (sinfo.valid_links) 7978 cfg80211_sta_set_mld_sinfo(&sinfo); 7979 7980 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 7981 info->snd_portid, info->snd_seq, 0, 7982 rdev, dev, mac_addr, &sinfo, false) < 0) { 7983 nlmsg_free(msg); 7984 return -ENOBUFS; 7985 } 7986 7987 return genlmsg_reply(msg, info); 7988 } 7989 7990 int cfg80211_check_station_change(struct wiphy *wiphy, 7991 struct station_parameters *params, 7992 enum cfg80211_station_type statype) 7993 { 7994 if (params->listen_interval != -1 && 7995 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 7996 return -EINVAL; 7997 7998 if (params->support_p2p_ps != -1 && 7999 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 8000 return -EINVAL; 8001 8002 if (params->aid && 8003 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && 8004 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 8005 return -EINVAL; 8006 8007 /* When you run into this, adjust the code below for the new flag */ 8008 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 8009 8010 switch (statype) { 8011 case CFG80211_STA_MESH_PEER_KERNEL: 8012 case CFG80211_STA_MESH_PEER_USER: 8013 /* 8014 * No ignoring the TDLS flag here -- the userspace mesh 8015 * code doesn't have the bug of including TDLS in the 8016 * mask everywhere. 8017 */ 8018 if (params->sta_flags_mask & 8019 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) | 8020 BIT(NL80211_STA_FLAG_MFP) | 8021 BIT(NL80211_STA_FLAG_AUTHORIZED))) 8022 return -EINVAL; 8023 break; 8024 case CFG80211_STA_TDLS_PEER_SETUP: 8025 case CFG80211_STA_TDLS_PEER_ACTIVE: 8026 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 8027 return -EINVAL; 8028 /* ignore since it can't change */ 8029 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 8030 break; 8031 default: 8032 /* disallow mesh-specific things */ 8033 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) 8034 return -EINVAL; 8035 if (params->local_pm) 8036 return -EINVAL; 8037 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 8038 return -EINVAL; 8039 } 8040 8041 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 8042 statype != CFG80211_STA_TDLS_PEER_ACTIVE) { 8043 /* TDLS can't be set, ... */ 8044 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) 8045 return -EINVAL; 8046 /* 8047 * ... but don't bother the driver with it. This works around 8048 * a hostapd/wpa_supplicant issue -- it always includes the 8049 * TLDS_PEER flag in the mask even for AP mode. 8050 */ 8051 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 8052 } 8053 8054 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 8055 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 8056 /* reject other things that can't change */ 8057 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) 8058 return -EINVAL; 8059 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) 8060 return -EINVAL; 8061 if (params->link_sta_params.supported_rates) 8062 return -EINVAL; 8063 if (params->ext_capab || params->link_sta_params.ht_capa || 8064 params->link_sta_params.vht_capa || 8065 params->link_sta_params.he_capa || 8066 params->link_sta_params.eht_capa) 8067 return -EINVAL; 8068 if (params->sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 8069 return -EINVAL; 8070 } 8071 8072 if (statype != CFG80211_STA_AP_CLIENT && 8073 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 8074 if (params->vlan) 8075 return -EINVAL; 8076 } 8077 8078 /* Accept EMLSR capabilities only for AP client before association */ 8079 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 8080 params->eml_cap_present) 8081 return -EINVAL; 8082 8083 switch (statype) { 8084 case CFG80211_STA_AP_MLME_CLIENT: 8085 /* Use this only for authorizing/unauthorizing a station */ 8086 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 8087 return -EOPNOTSUPP; 8088 break; 8089 case CFG80211_STA_AP_CLIENT: 8090 case CFG80211_STA_AP_CLIENT_UNASSOC: 8091 /* accept only the listed bits */ 8092 if (params->sta_flags_mask & 8093 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 8094 BIT(NL80211_STA_FLAG_AUTHENTICATED) | 8095 BIT(NL80211_STA_FLAG_ASSOCIATED) | 8096 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 8097 BIT(NL80211_STA_FLAG_WME) | 8098 BIT(NL80211_STA_FLAG_MFP) | 8099 BIT(NL80211_STA_FLAG_SPP_AMSDU))) 8100 return -EINVAL; 8101 8102 /* but authenticated/associated only if driver handles it */ 8103 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 8104 params->sta_flags_mask & 8105 (BIT(NL80211_STA_FLAG_AUTHENTICATED) | 8106 BIT(NL80211_STA_FLAG_ASSOCIATED))) 8107 return -EINVAL; 8108 break; 8109 case CFG80211_STA_IBSS: 8110 case CFG80211_STA_AP_STA: 8111 /* reject any changes other than AUTHORIZED */ 8112 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED)) 8113 return -EINVAL; 8114 break; 8115 case CFG80211_STA_TDLS_PEER_SETUP: 8116 /* reject any changes other than AUTHORIZED or WME */ 8117 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 8118 BIT(NL80211_STA_FLAG_WME))) 8119 return -EINVAL; 8120 /* force (at least) rates when authorizing */ 8121 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) && 8122 !params->link_sta_params.supported_rates) 8123 return -EINVAL; 8124 break; 8125 case CFG80211_STA_TDLS_PEER_ACTIVE: 8126 /* reject any changes */ 8127 return -EINVAL; 8128 case CFG80211_STA_MESH_PEER_KERNEL: 8129 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 8130 return -EINVAL; 8131 break; 8132 case CFG80211_STA_MESH_PEER_USER: 8133 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION && 8134 params->plink_action != NL80211_PLINK_ACTION_BLOCK) 8135 return -EINVAL; 8136 break; 8137 } 8138 8139 /* 8140 * Older kernel versions ignored this attribute entirely, so don't 8141 * reject attempts to update it but mark it as unused instead so the 8142 * driver won't look at the data. 8143 */ 8144 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 8145 statype != CFG80211_STA_TDLS_PEER_SETUP) 8146 params->link_sta_params.opmode_notif_used = false; 8147 8148 return 0; 8149 } 8150 EXPORT_SYMBOL(cfg80211_check_station_change); 8151 8152 /* 8153 * Get vlan interface making sure it is running and on the right wiphy. 8154 */ 8155 static struct net_device *get_vlan(struct genl_info *info, 8156 struct cfg80211_registered_device *rdev) 8157 { 8158 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN]; 8159 struct net_device *v; 8160 int ret; 8161 8162 if (!vlanattr) 8163 return NULL; 8164 8165 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr)); 8166 if (!v) 8167 return ERR_PTR(-ENODEV); 8168 8169 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) { 8170 ret = -EINVAL; 8171 goto error; 8172 } 8173 8174 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 8175 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 8176 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 8177 ret = -EINVAL; 8178 goto error; 8179 } 8180 8181 if (!netif_running(v)) { 8182 ret = -ENETDOWN; 8183 goto error; 8184 } 8185 8186 return v; 8187 error: 8188 dev_put(v); 8189 return ERR_PTR(ret); 8190 } 8191 8192 static int nl80211_parse_sta_wme(struct genl_info *info, 8193 struct station_parameters *params) 8194 { 8195 struct nlattr *tb[NL80211_STA_WME_MAX + 1]; 8196 struct nlattr *nla; 8197 int err; 8198 8199 /* parse WME attributes if present */ 8200 if (!info->attrs[NL80211_ATTR_STA_WME]) 8201 return 0; 8202 8203 nla = info->attrs[NL80211_ATTR_STA_WME]; 8204 err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla, 8205 nl80211_sta_wme_policy, 8206 info->extack); 8207 if (err) 8208 return err; 8209 8210 if (tb[NL80211_STA_WME_UAPSD_QUEUES]) 8211 params->uapsd_queues = nla_get_u8( 8212 tb[NL80211_STA_WME_UAPSD_QUEUES]); 8213 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) 8214 return -EINVAL; 8215 8216 if (tb[NL80211_STA_WME_MAX_SP]) 8217 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]); 8218 8219 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) 8220 return -EINVAL; 8221 8222 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD; 8223 8224 return 0; 8225 } 8226 8227 static int nl80211_parse_sta_channel_info(struct genl_info *info, 8228 struct station_parameters *params) 8229 { 8230 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) { 8231 params->supported_channels = 8232 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 8233 params->supported_channels_len = 8234 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 8235 /* 8236 * Need to include at least one (first channel, number of 8237 * channels) tuple for each subband (checked in policy), 8238 * and must have proper tuples for the rest of the data as well. 8239 */ 8240 if (params->supported_channels_len % 2) 8241 return -EINVAL; 8242 } 8243 8244 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) { 8245 params->supported_oper_classes = 8246 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 8247 params->supported_oper_classes_len = 8248 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 8249 } 8250 return 0; 8251 } 8252 8253 static int nl80211_set_station_tdls(struct genl_info *info, 8254 struct station_parameters *params) 8255 { 8256 int err; 8257 /* Dummy STA entry gets updated once the peer capabilities are known */ 8258 if (info->attrs[NL80211_ATTR_PEER_AID]) 8259 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 8260 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 8261 params->link_sta_params.ht_capa = 8262 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 8263 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 8264 params->link_sta_params.vht_capa = 8265 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 8266 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 8267 params->link_sta_params.he_capa = 8268 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8269 params->link_sta_params.he_capa_len = 8270 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8271 8272 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 8273 params->link_sta_params.eht_capa = 8274 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8275 params->link_sta_params.eht_capa_len = 8276 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8277 8278 if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa, 8279 (const u8 *)params->link_sta_params.eht_capa, 8280 params->link_sta_params.eht_capa_len, 8281 false)) 8282 return -EINVAL; 8283 } 8284 } 8285 8286 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 8287 params->link_sta_params.s1g_capa = 8288 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]); 8289 8290 err = nl80211_parse_sta_channel_info(info, params); 8291 if (err) 8292 return err; 8293 8294 return nl80211_parse_sta_wme(info, params); 8295 } 8296 8297 static int nl80211_parse_sta_txpower_setting(struct genl_info *info, 8298 struct sta_txpwr *txpwr, 8299 bool *txpwr_set) 8300 { 8301 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8302 int idx; 8303 8304 if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) { 8305 if (!rdev->ops->set_tx_power || 8306 !wiphy_ext_feature_isset(&rdev->wiphy, 8307 NL80211_EXT_FEATURE_STA_TX_PWR)) 8308 return -EOPNOTSUPP; 8309 8310 idx = NL80211_ATTR_STA_TX_POWER_SETTING; 8311 txpwr->type = nla_get_u8(info->attrs[idx]); 8312 8313 if (txpwr->type == NL80211_TX_POWER_LIMITED) { 8314 idx = NL80211_ATTR_STA_TX_POWER; 8315 8316 if (info->attrs[idx]) 8317 txpwr->power = nla_get_s16(info->attrs[idx]); 8318 else 8319 return -EINVAL; 8320 } 8321 8322 *txpwr_set = true; 8323 } else { 8324 *txpwr_set = false; 8325 } 8326 8327 return 0; 8328 } 8329 8330 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info) 8331 { 8332 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8333 struct net_device *dev = info->user_ptr[1]; 8334 struct station_parameters params; 8335 u8 *mac_addr; 8336 int err; 8337 8338 memset(¶ms, 0, sizeof(params)); 8339 8340 if (!rdev->ops->change_station) 8341 return -EOPNOTSUPP; 8342 8343 /* 8344 * AID and listen_interval properties can be set only for unassociated 8345 * station. Include these parameters here and will check them in 8346 * cfg80211_check_station_change(). 8347 */ 8348 if (info->attrs[NL80211_ATTR_STA_AID]) 8349 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 8350 8351 if (info->attrs[NL80211_ATTR_VLAN_ID]) 8352 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 8353 8354 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 8355 params.listen_interval = 8356 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 8357 else 8358 params.listen_interval = -1; 8359 8360 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) 8361 params.support_p2p_ps = 8362 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 8363 else 8364 params.support_p2p_ps = -1; 8365 8366 if (!info->attrs[NL80211_ATTR_MAC]) 8367 return -EINVAL; 8368 8369 params.link_sta_params.link_id = 8370 nl80211_link_id_or_invalid(info->attrs); 8371 8372 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 8373 /* If MLD_ADDR attribute is set then this is an MLD station 8374 * and the MLD_ADDR attribute holds the MLD address and the 8375 * MAC attribute holds for the LINK address. 8376 * In that case, the link_id is also expected to be valid. 8377 */ 8378 if (params.link_sta_params.link_id < 0) 8379 return -EINVAL; 8380 8381 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 8382 params.link_sta_params.mld_mac = mac_addr; 8383 params.link_sta_params.link_mac = 8384 nla_data(info->attrs[NL80211_ATTR_MAC]); 8385 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 8386 return -EINVAL; 8387 } else { 8388 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 8389 } 8390 8391 8392 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 8393 params.link_sta_params.supported_rates = 8394 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8395 params.link_sta_params.supported_rates_len = 8396 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8397 } 8398 8399 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 8400 params.capability = 8401 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 8402 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 8403 } 8404 8405 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 8406 params.ext_capab = 8407 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8408 params.ext_capab_len = 8409 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8410 } 8411 8412 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 8413 return -EINVAL; 8414 8415 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 8416 params.plink_action = 8417 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 8418 8419 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) { 8420 params.plink_state = 8421 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]); 8422 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) 8423 params.peer_aid = nla_get_u16( 8424 info->attrs[NL80211_ATTR_MESH_PEER_AID]); 8425 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE; 8426 } 8427 8428 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) 8429 params.local_pm = nla_get_u32( 8430 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]); 8431 8432 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 8433 params.link_sta_params.opmode_notif_used = true; 8434 params.link_sta_params.opmode_notif = 8435 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 8436 } 8437 8438 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 8439 params.link_sta_params.he_6ghz_capa = 8440 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 8441 8442 if (info->attrs[NL80211_ATTR_EML_CAPABILITY]) { 8443 params.eml_cap_present = true; 8444 params.eml_cap = 8445 nla_get_u16(info->attrs[NL80211_ATTR_EML_CAPABILITY]); 8446 } 8447 8448 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 8449 params.airtime_weight = 8450 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 8451 8452 if (params.airtime_weight && 8453 !wiphy_ext_feature_isset(&rdev->wiphy, 8454 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 8455 return -EOPNOTSUPP; 8456 8457 err = nl80211_parse_sta_txpower_setting(info, 8458 ¶ms.link_sta_params.txpwr, 8459 ¶ms.link_sta_params.txpwr_set); 8460 if (err) 8461 return err; 8462 8463 /* Include parameters for TDLS peer (will check later) */ 8464 err = nl80211_set_station_tdls(info, ¶ms); 8465 if (err) 8466 return err; 8467 8468 params.vlan = get_vlan(info, rdev); 8469 if (IS_ERR(params.vlan)) 8470 return PTR_ERR(params.vlan); 8471 8472 switch (dev->ieee80211_ptr->iftype) { 8473 case NL80211_IFTYPE_AP: 8474 case NL80211_IFTYPE_AP_VLAN: 8475 case NL80211_IFTYPE_P2P_GO: 8476 case NL80211_IFTYPE_P2P_CLIENT: 8477 case NL80211_IFTYPE_STATION: 8478 case NL80211_IFTYPE_ADHOC: 8479 case NL80211_IFTYPE_MESH_POINT: 8480 break; 8481 default: 8482 err = -EOPNOTSUPP; 8483 goto out_put_vlan; 8484 } 8485 8486 /* driver will call cfg80211_check_station_change() */ 8487 err = rdev_change_station(rdev, dev, mac_addr, ¶ms); 8488 8489 out_put_vlan: 8490 dev_put(params.vlan); 8491 8492 return err; 8493 } 8494 8495 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info) 8496 { 8497 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8498 int err; 8499 struct net_device *dev = info->user_ptr[1]; 8500 struct wireless_dev *wdev = dev->ieee80211_ptr; 8501 struct station_parameters params; 8502 u8 *mac_addr = NULL; 8503 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 8504 BIT(NL80211_STA_FLAG_ASSOCIATED); 8505 8506 memset(¶ms, 0, sizeof(params)); 8507 8508 if (!rdev->ops->add_station) 8509 return -EOPNOTSUPP; 8510 8511 if (!info->attrs[NL80211_ATTR_MAC]) 8512 return -EINVAL; 8513 8514 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 8515 return -EINVAL; 8516 8517 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 8518 return -EINVAL; 8519 8520 if (!info->attrs[NL80211_ATTR_STA_AID] && 8521 !info->attrs[NL80211_ATTR_PEER_AID]) 8522 return -EINVAL; 8523 8524 params.link_sta_params.link_id = 8525 nl80211_link_id_or_invalid(info->attrs); 8526 8527 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 8528 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 8529 params.link_sta_params.mld_mac = mac_addr; 8530 params.link_sta_params.link_mac = 8531 nla_data(info->attrs[NL80211_ATTR_MAC]); 8532 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 8533 return -EINVAL; 8534 } else { 8535 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 8536 } 8537 8538 params.link_sta_params.supported_rates = 8539 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8540 params.link_sta_params.supported_rates_len = 8541 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8542 params.listen_interval = 8543 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 8544 8545 if (info->attrs[NL80211_ATTR_VLAN_ID]) 8546 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 8547 8548 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) { 8549 params.support_p2p_ps = 8550 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 8551 } else { 8552 /* 8553 * if not specified, assume it's supported for P2P GO interface, 8554 * and is NOT supported for AP interface 8555 */ 8556 params.support_p2p_ps = 8557 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO; 8558 } 8559 8560 if (info->attrs[NL80211_ATTR_PEER_AID]) 8561 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 8562 else 8563 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 8564 8565 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 8566 params.capability = 8567 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 8568 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 8569 } 8570 8571 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 8572 params.ext_capab = 8573 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8574 params.ext_capab_len = 8575 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8576 } 8577 8578 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 8579 params.link_sta_params.ht_capa = 8580 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 8581 8582 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 8583 params.link_sta_params.vht_capa = 8584 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 8585 8586 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 8587 params.link_sta_params.he_capa = 8588 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8589 params.link_sta_params.he_capa_len = 8590 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8591 8592 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 8593 params.link_sta_params.eht_capa = 8594 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8595 params.link_sta_params.eht_capa_len = 8596 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8597 8598 if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa, 8599 (const u8 *)params.link_sta_params.eht_capa, 8600 params.link_sta_params.eht_capa_len, 8601 false)) 8602 return -EINVAL; 8603 } 8604 } 8605 8606 if (info->attrs[NL80211_ATTR_EML_CAPABILITY]) { 8607 params.eml_cap_present = true; 8608 params.eml_cap = 8609 nla_get_u16(info->attrs[NL80211_ATTR_EML_CAPABILITY]); 8610 } 8611 8612 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 8613 params.link_sta_params.he_6ghz_capa = 8614 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 8615 8616 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 8617 params.link_sta_params.s1g_capa = 8618 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]); 8619 8620 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 8621 params.link_sta_params.opmode_notif_used = true; 8622 params.link_sta_params.opmode_notif = 8623 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 8624 } 8625 8626 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 8627 params.plink_action = 8628 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 8629 8630 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 8631 params.airtime_weight = 8632 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 8633 8634 if (params.airtime_weight && 8635 !wiphy_ext_feature_isset(&rdev->wiphy, 8636 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 8637 return -EOPNOTSUPP; 8638 8639 err = nl80211_parse_sta_txpower_setting(info, 8640 ¶ms.link_sta_params.txpwr, 8641 ¶ms.link_sta_params.txpwr_set); 8642 if (err) 8643 return err; 8644 8645 err = nl80211_parse_sta_channel_info(info, ¶ms); 8646 if (err) 8647 return err; 8648 8649 err = nl80211_parse_sta_wme(info, ¶ms); 8650 if (err) 8651 return err; 8652 8653 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 8654 return -EINVAL; 8655 8656 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT 8657 * as userspace might just pass through the capabilities from the IEs 8658 * directly, rather than enforcing this restriction and returning an 8659 * error in this case. 8660 */ 8661 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) { 8662 params.link_sta_params.ht_capa = NULL; 8663 params.link_sta_params.vht_capa = NULL; 8664 8665 /* HE and EHT require WME */ 8666 if (params.link_sta_params.he_capa_len || 8667 params.link_sta_params.he_6ghz_capa || 8668 params.link_sta_params.eht_capa_len) 8669 return -EINVAL; 8670 } 8671 8672 /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */ 8673 if (params.link_sta_params.he_6ghz_capa && 8674 (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa)) 8675 return -EINVAL; 8676 8677 /* When you run into this, adjust the code below for the new flag */ 8678 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 8679 8680 switch (dev->ieee80211_ptr->iftype) { 8681 case NL80211_IFTYPE_AP: 8682 case NL80211_IFTYPE_AP_VLAN: 8683 case NL80211_IFTYPE_P2P_GO: 8684 /* ignore WME attributes if iface/sta is not capable */ 8685 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) || 8686 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) 8687 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 8688 8689 /* TDLS peers cannot be added */ 8690 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 8691 info->attrs[NL80211_ATTR_PEER_AID]) 8692 return -EINVAL; 8693 /* but don't bother the driver with it */ 8694 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 8695 8696 /* allow authenticated/associated only if driver handles it */ 8697 if (!(rdev->wiphy.features & 8698 NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 8699 params.sta_flags_mask & auth_assoc) 8700 return -EINVAL; 8701 8702 if (!wiphy_ext_feature_isset(&rdev->wiphy, 8703 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT) && 8704 params.sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 8705 return -EINVAL; 8706 8707 /* Older userspace, or userspace wanting to be compatible with 8708 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth 8709 * and assoc flags in the mask, but assumes the station will be 8710 * added as associated anyway since this was the required driver 8711 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was 8712 * introduced. 8713 * In order to not bother drivers with this quirk in the API 8714 * set the flags in both the mask and set for new stations in 8715 * this case. 8716 */ 8717 if (!(params.sta_flags_mask & auth_assoc)) { 8718 params.sta_flags_mask |= auth_assoc; 8719 params.sta_flags_set |= auth_assoc; 8720 } 8721 8722 /* must be last in here for error handling */ 8723 params.vlan = get_vlan(info, rdev); 8724 if (IS_ERR(params.vlan)) 8725 return PTR_ERR(params.vlan); 8726 break; 8727 case NL80211_IFTYPE_MESH_POINT: 8728 /* ignore uAPSD data */ 8729 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 8730 8731 /* associated is disallowed */ 8732 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) 8733 return -EINVAL; 8734 /* TDLS peers cannot be added */ 8735 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 8736 info->attrs[NL80211_ATTR_PEER_AID]) 8737 return -EINVAL; 8738 break; 8739 case NL80211_IFTYPE_STATION: 8740 case NL80211_IFTYPE_P2P_CLIENT: 8741 /* ignore uAPSD data */ 8742 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 8743 8744 /* these are disallowed */ 8745 if (params.sta_flags_mask & 8746 (BIT(NL80211_STA_FLAG_ASSOCIATED) | 8747 BIT(NL80211_STA_FLAG_AUTHENTICATED))) 8748 return -EINVAL; 8749 /* Only TDLS peers can be added */ 8750 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 8751 return -EINVAL; 8752 /* Can only add if TDLS ... */ 8753 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS)) 8754 return -EOPNOTSUPP; 8755 /* ... with external setup is supported */ 8756 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP)) 8757 return -EOPNOTSUPP; 8758 /* 8759 * Older wpa_supplicant versions always mark the TDLS peer 8760 * as authorized, but it shouldn't yet be. 8761 */ 8762 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED); 8763 break; 8764 default: 8765 return -EOPNOTSUPP; 8766 } 8767 8768 /* be aware of params.vlan when changing code here */ 8769 8770 if (wdev->valid_links) { 8771 if (params.link_sta_params.link_id < 0) { 8772 err = -EINVAL; 8773 goto out; 8774 } 8775 if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) { 8776 err = -ENOLINK; 8777 goto out; 8778 } 8779 } else { 8780 if (params.link_sta_params.link_id >= 0) { 8781 err = -EINVAL; 8782 goto out; 8783 } 8784 } 8785 err = rdev_add_station(rdev, dev, mac_addr, ¶ms); 8786 out: 8787 dev_put(params.vlan); 8788 return err; 8789 } 8790 8791 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info) 8792 { 8793 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8794 struct net_device *dev = info->user_ptr[1]; 8795 struct wireless_dev *wdev = dev->ieee80211_ptr; 8796 struct station_del_parameters params; 8797 int link_id = nl80211_link_id_or_invalid(info->attrs); 8798 8799 memset(¶ms, 0, sizeof(params)); 8800 8801 if (info->attrs[NL80211_ATTR_MAC]) 8802 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 8803 8804 switch (wdev->iftype) { 8805 case NL80211_IFTYPE_AP: 8806 case NL80211_IFTYPE_AP_VLAN: 8807 case NL80211_IFTYPE_MESH_POINT: 8808 case NL80211_IFTYPE_P2P_GO: 8809 /* always accept these */ 8810 break; 8811 case NL80211_IFTYPE_ADHOC: 8812 /* conditionally accept */ 8813 if (wiphy_ext_feature_isset(&rdev->wiphy, 8814 NL80211_EXT_FEATURE_DEL_IBSS_STA)) 8815 break; 8816 return -EINVAL; 8817 default: 8818 return -EINVAL; 8819 } 8820 8821 if (!rdev->ops->del_station) 8822 return -EOPNOTSUPP; 8823 8824 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) { 8825 params.subtype = 8826 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]); 8827 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 && 8828 params.subtype != IEEE80211_STYPE_DEAUTH >> 4) 8829 return -EINVAL; 8830 } else { 8831 /* Default to Deauthentication frame */ 8832 params.subtype = IEEE80211_STYPE_DEAUTH >> 4; 8833 } 8834 8835 if (info->attrs[NL80211_ATTR_REASON_CODE]) { 8836 params.reason_code = 8837 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 8838 if (params.reason_code == 0) 8839 return -EINVAL; /* 0 is reserved */ 8840 } else { 8841 /* Default to reason code 2 */ 8842 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID; 8843 } 8844 8845 /* Link ID not expected in case of non-ML operation */ 8846 if (!wdev->valid_links && link_id != -1) 8847 return -EINVAL; 8848 8849 /* If given, a valid link ID should be passed during MLO */ 8850 if (wdev->valid_links && link_id >= 0 && 8851 !(wdev->valid_links & BIT(link_id))) 8852 return -EINVAL; 8853 8854 params.link_id = link_id; 8855 8856 return rdev_del_station(rdev, dev, ¶ms); 8857 } 8858 8859 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq, 8860 int flags, struct net_device *dev, 8861 u8 *dst, u8 *next_hop, 8862 struct mpath_info *pinfo) 8863 { 8864 void *hdr; 8865 struct nlattr *pinfoattr; 8866 8867 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH); 8868 if (!hdr) 8869 return -1; 8870 8871 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 8872 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) || 8873 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) || 8874 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation)) 8875 goto nla_put_failure; 8876 8877 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO); 8878 if (!pinfoattr) 8879 goto nla_put_failure; 8880 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) && 8881 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN, 8882 pinfo->frame_qlen)) 8883 goto nla_put_failure; 8884 if (((pinfo->filled & MPATH_INFO_SN) && 8885 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) || 8886 ((pinfo->filled & MPATH_INFO_METRIC) && 8887 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC, 8888 pinfo->metric)) || 8889 ((pinfo->filled & MPATH_INFO_EXPTIME) && 8890 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME, 8891 pinfo->exptime)) || 8892 ((pinfo->filled & MPATH_INFO_FLAGS) && 8893 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS, 8894 pinfo->flags)) || 8895 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) && 8896 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT, 8897 pinfo->discovery_timeout)) || 8898 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) && 8899 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES, 8900 pinfo->discovery_retries)) || 8901 ((pinfo->filled & MPATH_INFO_HOP_COUNT) && 8902 nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT, 8903 pinfo->hop_count)) || 8904 ((pinfo->filled & MPATH_INFO_PATH_CHANGE) && 8905 nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE, 8906 pinfo->path_change_count))) 8907 goto nla_put_failure; 8908 8909 nla_nest_end(msg, pinfoattr); 8910 8911 genlmsg_end(msg, hdr); 8912 return 0; 8913 8914 nla_put_failure: 8915 genlmsg_cancel(msg, hdr); 8916 return -EMSGSIZE; 8917 } 8918 8919 static int nl80211_dump_mpath(struct sk_buff *skb, 8920 struct netlink_callback *cb) 8921 { 8922 struct mpath_info pinfo; 8923 struct cfg80211_registered_device *rdev; 8924 struct wireless_dev *wdev; 8925 u8 dst[ETH_ALEN]; 8926 u8 next_hop[ETH_ALEN]; 8927 int path_idx = cb->args[2]; 8928 int err; 8929 8930 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 8931 if (err) 8932 return err; 8933 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 8934 __acquire(&rdev->wiphy.mtx); 8935 8936 if (!rdev->ops->dump_mpath) { 8937 err = -EOPNOTSUPP; 8938 goto out_err; 8939 } 8940 8941 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 8942 err = -EOPNOTSUPP; 8943 goto out_err; 8944 } 8945 8946 while (1) { 8947 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst, 8948 next_hop, &pinfo); 8949 if (err == -ENOENT) 8950 break; 8951 if (err) 8952 goto out_err; 8953 8954 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 8955 cb->nlh->nlmsg_seq, NLM_F_MULTI, 8956 wdev->netdev, dst, next_hop, 8957 &pinfo) < 0) 8958 goto out; 8959 8960 path_idx++; 8961 } 8962 8963 out: 8964 cb->args[2] = path_idx; 8965 err = skb->len; 8966 out_err: 8967 wiphy_unlock(&rdev->wiphy); 8968 return err; 8969 } 8970 8971 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info) 8972 { 8973 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8974 int err; 8975 struct net_device *dev = info->user_ptr[1]; 8976 struct mpath_info pinfo; 8977 struct sk_buff *msg; 8978 u8 *dst = NULL; 8979 u8 next_hop[ETH_ALEN]; 8980 8981 memset(&pinfo, 0, sizeof(pinfo)); 8982 8983 if (!info->attrs[NL80211_ATTR_MAC]) 8984 return -EINVAL; 8985 8986 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8987 8988 if (!rdev->ops->get_mpath) 8989 return -EOPNOTSUPP; 8990 8991 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8992 return -EOPNOTSUPP; 8993 8994 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo); 8995 if (err) 8996 return err; 8997 8998 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8999 if (!msg) 9000 return -ENOMEM; 9001 9002 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 9003 dev, dst, next_hop, &pinfo) < 0) { 9004 nlmsg_free(msg); 9005 return -ENOBUFS; 9006 } 9007 9008 return genlmsg_reply(msg, info); 9009 } 9010 9011 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info) 9012 { 9013 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9014 struct net_device *dev = info->user_ptr[1]; 9015 u8 *dst = NULL; 9016 u8 *next_hop = NULL; 9017 9018 if (!info->attrs[NL80211_ATTR_MAC]) 9019 return -EINVAL; 9020 9021 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 9022 return -EINVAL; 9023 9024 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 9025 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 9026 9027 if (!rdev->ops->change_mpath) 9028 return -EOPNOTSUPP; 9029 9030 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 9031 return -EOPNOTSUPP; 9032 9033 return rdev_change_mpath(rdev, dev, dst, next_hop); 9034 } 9035 9036 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info) 9037 { 9038 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9039 struct net_device *dev = info->user_ptr[1]; 9040 u8 *dst = NULL; 9041 u8 *next_hop = NULL; 9042 9043 if (!info->attrs[NL80211_ATTR_MAC]) 9044 return -EINVAL; 9045 9046 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 9047 return -EINVAL; 9048 9049 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 9050 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 9051 9052 if (!rdev->ops->add_mpath) 9053 return -EOPNOTSUPP; 9054 9055 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 9056 return -EOPNOTSUPP; 9057 9058 return rdev_add_mpath(rdev, dev, dst, next_hop); 9059 } 9060 9061 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info) 9062 { 9063 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9064 struct net_device *dev = info->user_ptr[1]; 9065 u8 *dst = NULL; 9066 9067 if (info->attrs[NL80211_ATTR_MAC]) 9068 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 9069 9070 if (!rdev->ops->del_mpath) 9071 return -EOPNOTSUPP; 9072 9073 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 9074 return -EOPNOTSUPP; 9075 9076 return rdev_del_mpath(rdev, dev, dst); 9077 } 9078 9079 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info) 9080 { 9081 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9082 int err; 9083 struct net_device *dev = info->user_ptr[1]; 9084 struct mpath_info pinfo; 9085 struct sk_buff *msg; 9086 u8 *dst = NULL; 9087 u8 mpp[ETH_ALEN]; 9088 9089 memset(&pinfo, 0, sizeof(pinfo)); 9090 9091 if (!info->attrs[NL80211_ATTR_MAC]) 9092 return -EINVAL; 9093 9094 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 9095 9096 if (!rdev->ops->get_mpp) 9097 return -EOPNOTSUPP; 9098 9099 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 9100 return -EOPNOTSUPP; 9101 9102 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo); 9103 if (err) 9104 return err; 9105 9106 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 9107 if (!msg) 9108 return -ENOMEM; 9109 9110 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 9111 dev, dst, mpp, &pinfo) < 0) { 9112 nlmsg_free(msg); 9113 return -ENOBUFS; 9114 } 9115 9116 return genlmsg_reply(msg, info); 9117 } 9118 9119 static int nl80211_dump_mpp(struct sk_buff *skb, 9120 struct netlink_callback *cb) 9121 { 9122 struct mpath_info pinfo; 9123 struct cfg80211_registered_device *rdev; 9124 struct wireless_dev *wdev; 9125 u8 dst[ETH_ALEN]; 9126 u8 mpp[ETH_ALEN]; 9127 int path_idx = cb->args[2]; 9128 int err; 9129 9130 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 9131 if (err) 9132 return err; 9133 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 9134 __acquire(&rdev->wiphy.mtx); 9135 9136 if (!rdev->ops->dump_mpp) { 9137 err = -EOPNOTSUPP; 9138 goto out_err; 9139 } 9140 9141 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 9142 err = -EOPNOTSUPP; 9143 goto out_err; 9144 } 9145 9146 while (1) { 9147 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst, 9148 mpp, &pinfo); 9149 if (err == -ENOENT) 9150 break; 9151 if (err) 9152 goto out_err; 9153 9154 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 9155 cb->nlh->nlmsg_seq, NLM_F_MULTI, 9156 wdev->netdev, dst, mpp, 9157 &pinfo) < 0) 9158 goto out; 9159 9160 path_idx++; 9161 } 9162 9163 out: 9164 cb->args[2] = path_idx; 9165 err = skb->len; 9166 out_err: 9167 wiphy_unlock(&rdev->wiphy); 9168 return err; 9169 } 9170 9171 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info) 9172 { 9173 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9174 struct net_device *dev = info->user_ptr[1]; 9175 struct bss_parameters params; 9176 u32 bss_param_support = rdev->wiphy.bss_param_support; 9177 u32 changed = 0; 9178 bool strict; 9179 9180 memset(¶ms, 0, sizeof(params)); 9181 params.link_id = nl80211_link_id_or_invalid(info->attrs); 9182 /* default to not changing parameters */ 9183 params.use_cts_prot = -1; 9184 params.use_short_preamble = -1; 9185 params.use_short_slot_time = -1; 9186 params.ap_isolate = -1; 9187 params.ht_opmode = -1; 9188 params.p2p_ctwindow = -1; 9189 params.p2p_opp_ps = -1; 9190 9191 strict = nla_get_flag(info->attrs[NL80211_ATTR_BSS_PARAM]); 9192 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT]) { 9193 if (strict && !(bss_param_support & WIPHY_BSS_PARAM_CTS_PROT)) 9194 return -EINVAL; 9195 params.use_cts_prot = 9196 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]); 9197 changed |= WIPHY_BSS_PARAM_CTS_PROT; 9198 } 9199 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]) { 9200 if (strict && 9201 !(bss_param_support & WIPHY_BSS_PARAM_SHORT_PREAMBLE)) 9202 return -EINVAL; 9203 params.use_short_preamble = 9204 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]); 9205 changed |= WIPHY_BSS_PARAM_SHORT_PREAMBLE; 9206 } 9207 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]) { 9208 if (strict && 9209 !(bss_param_support & WIPHY_BSS_PARAM_SHORT_SLOT_TIME)) 9210 return -EINVAL; 9211 params.use_short_slot_time = 9212 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]); 9213 changed |= WIPHY_BSS_PARAM_SHORT_SLOT_TIME; 9214 } 9215 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 9216 if (strict && 9217 !(bss_param_support & WIPHY_BSS_PARAM_BASIC_RATES)) 9218 return -EINVAL; 9219 params.basic_rates = 9220 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 9221 params.basic_rates_len = 9222 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 9223 changed |= WIPHY_BSS_PARAM_BASIC_RATES; 9224 } 9225 if (info->attrs[NL80211_ATTR_AP_ISOLATE]) { 9226 if (strict && !(bss_param_support & WIPHY_BSS_PARAM_AP_ISOLATE)) 9227 return -EINVAL; 9228 params.ap_isolate = 9229 !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]); 9230 changed |= WIPHY_BSS_PARAM_AP_ISOLATE; 9231 } 9232 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE]) { 9233 if (strict && !(bss_param_support & WIPHY_BSS_PARAM_HT_OPMODE)) 9234 return -EINVAL; 9235 params.ht_opmode = 9236 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]); 9237 changed |= WIPHY_BSS_PARAM_HT_OPMODE; 9238 } 9239 9240 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 9241 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 9242 return -EINVAL; 9243 params.p2p_ctwindow = 9244 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 9245 if (params.p2p_ctwindow != 0 && 9246 !(bss_param_support & WIPHY_BSS_PARAM_P2P_CTWINDOW)) 9247 return -EINVAL; 9248 changed |= WIPHY_BSS_PARAM_P2P_CTWINDOW; 9249 } 9250 9251 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 9252 u8 tmp; 9253 9254 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 9255 return -EINVAL; 9256 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 9257 if (tmp && !(bss_param_support & WIPHY_BSS_PARAM_P2P_OPPPS)) 9258 return -EINVAL; 9259 params.p2p_opp_ps = tmp; 9260 if (params.p2p_opp_ps && 9261 !(rdev->wiphy.bss_param_support & WIPHY_BSS_PARAM_P2P_OPPPS)) 9262 return -EINVAL; 9263 } 9264 9265 if (!rdev->ops->change_bss) 9266 return -EOPNOTSUPP; 9267 9268 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 9269 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 9270 return -EOPNOTSUPP; 9271 9272 changed &= rdev->wiphy.bss_param_support; 9273 if (!changed) 9274 return 0; 9275 9276 return rdev_change_bss(rdev, dev, ¶ms); 9277 } 9278 9279 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info) 9280 { 9281 char *data = NULL; 9282 bool is_indoor; 9283 enum nl80211_user_reg_hint_type user_reg_hint_type; 9284 u32 owner_nlportid; 9285 9286 /* 9287 * You should only get this when cfg80211 hasn't yet initialized 9288 * completely when built-in to the kernel right between the time 9289 * window between nl80211_init() and regulatory_init(), if that is 9290 * even possible. 9291 */ 9292 if (unlikely(!rcu_access_pointer(cfg80211_regdomain))) 9293 return -EINPROGRESS; 9294 9295 user_reg_hint_type = 9296 nla_get_u32_default(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE], 9297 NL80211_USER_REG_HINT_USER); 9298 9299 switch (user_reg_hint_type) { 9300 case NL80211_USER_REG_HINT_USER: 9301 case NL80211_USER_REG_HINT_CELL_BASE: 9302 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 9303 return -EINVAL; 9304 9305 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 9306 return regulatory_hint_user(data, user_reg_hint_type); 9307 case NL80211_USER_REG_HINT_INDOOR: 9308 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 9309 owner_nlportid = info->snd_portid; 9310 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR]; 9311 } else { 9312 owner_nlportid = 0; 9313 is_indoor = true; 9314 } 9315 9316 regulatory_hint_indoor(is_indoor, owner_nlportid); 9317 return 0; 9318 default: 9319 return -EINVAL; 9320 } 9321 } 9322 9323 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info) 9324 { 9325 return reg_reload_regdb(); 9326 } 9327 9328 static int nl80211_get_mesh_config(struct sk_buff *skb, 9329 struct genl_info *info) 9330 { 9331 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9332 struct net_device *dev = info->user_ptr[1]; 9333 struct wireless_dev *wdev = dev->ieee80211_ptr; 9334 struct mesh_config cur_params; 9335 int err = 0; 9336 void *hdr; 9337 struct nlattr *pinfoattr; 9338 struct sk_buff *msg; 9339 9340 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 9341 return -EOPNOTSUPP; 9342 9343 if (!rdev->ops->get_mesh_config) 9344 return -EOPNOTSUPP; 9345 9346 /* If not connected, get default parameters */ 9347 if (!wdev->u.mesh.id_len) 9348 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params)); 9349 else 9350 err = rdev_get_mesh_config(rdev, dev, &cur_params); 9351 9352 if (err) 9353 return err; 9354 9355 /* Draw up a netlink message to send back */ 9356 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 9357 if (!msg) 9358 return -ENOMEM; 9359 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 9360 NL80211_CMD_GET_MESH_CONFIG); 9361 if (!hdr) 9362 goto out; 9363 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG); 9364 if (!pinfoattr) 9365 goto nla_put_failure; 9366 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 9367 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT, 9368 cur_params.dot11MeshRetryTimeout) || 9369 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT, 9370 cur_params.dot11MeshConfirmTimeout) || 9371 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT, 9372 cur_params.dot11MeshHoldingTimeout) || 9373 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS, 9374 cur_params.dot11MeshMaxPeerLinks) || 9375 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES, 9376 cur_params.dot11MeshMaxRetries) || 9377 nla_put_u8(msg, NL80211_MESHCONF_TTL, 9378 cur_params.dot11MeshTTL) || 9379 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL, 9380 cur_params.element_ttl) || 9381 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS, 9382 cur_params.auto_open_plinks) || 9383 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 9384 cur_params.dot11MeshNbrOffsetMaxNeighbor) || 9385 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 9386 cur_params.dot11MeshHWMPmaxPREQretries) || 9387 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME, 9388 cur_params.path_refresh_time) || 9389 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 9390 cur_params.min_discovery_timeout) || 9391 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 9392 cur_params.dot11MeshHWMPactivePathTimeout) || 9393 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 9394 cur_params.dot11MeshHWMPpreqMinInterval) || 9395 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 9396 cur_params.dot11MeshHWMPperrMinInterval) || 9397 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 9398 cur_params.dot11MeshHWMPnetDiameterTraversalTime) || 9399 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE, 9400 cur_params.dot11MeshHWMPRootMode) || 9401 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL, 9402 cur_params.dot11MeshHWMPRannInterval) || 9403 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 9404 cur_params.dot11MeshGateAnnouncementProtocol) || 9405 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING, 9406 cur_params.dot11MeshForwarding) || 9407 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD, 9408 cur_params.rssi_threshold) || 9409 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE, 9410 cur_params.ht_opmode) || 9411 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 9412 cur_params.dot11MeshHWMPactivePathToRootTimeout) || 9413 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 9414 cur_params.dot11MeshHWMProotInterval) || 9415 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 9416 cur_params.dot11MeshHWMPconfirmationInterval) || 9417 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE, 9418 cur_params.power_mode) || 9419 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW, 9420 cur_params.dot11MeshAwakeWindowDuration) || 9421 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT, 9422 cur_params.plink_timeout) || 9423 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE, 9424 cur_params.dot11MeshConnectedToMeshGate) || 9425 nla_put_u8(msg, NL80211_MESHCONF_NOLEARN, 9426 cur_params.dot11MeshNolearn) || 9427 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS, 9428 cur_params.dot11MeshConnectedToAuthServer)) 9429 goto nla_put_failure; 9430 nla_nest_end(msg, pinfoattr); 9431 genlmsg_end(msg, hdr); 9432 return genlmsg_reply(msg, info); 9433 9434 nla_put_failure: 9435 out: 9436 nlmsg_free(msg); 9437 return -ENOBUFS; 9438 } 9439 9440 static const struct nla_policy 9441 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = { 9442 [NL80211_MESHCONF_RETRY_TIMEOUT] = 9443 NLA_POLICY_RANGE(NLA_U16, 1, 255), 9444 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = 9445 NLA_POLICY_RANGE(NLA_U16, 1, 255), 9446 [NL80211_MESHCONF_HOLDING_TIMEOUT] = 9447 NLA_POLICY_RANGE(NLA_U16, 1, 255), 9448 [NL80211_MESHCONF_MAX_PEER_LINKS] = 9449 NLA_POLICY_RANGE(NLA_U16, 0, 255), 9450 [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16), 9451 [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 9452 [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 9453 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1), 9454 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = 9455 NLA_POLICY_RANGE(NLA_U32, 1, 255), 9456 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 }, 9457 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 }, 9458 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1), 9459 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 }, 9460 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = 9461 NLA_POLICY_MIN(NLA_U16, 1), 9462 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = 9463 NLA_POLICY_MIN(NLA_U16, 1), 9464 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = 9465 NLA_POLICY_MIN(NLA_U16, 1), 9466 [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4), 9467 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = 9468 NLA_POLICY_MIN(NLA_U16, 1), 9469 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1), 9470 [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1), 9471 [NL80211_MESHCONF_RSSI_THRESHOLD] = 9472 NLA_POLICY_RANGE(NLA_S32, -255, 0), 9473 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 }, 9474 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 }, 9475 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = 9476 NLA_POLICY_MIN(NLA_U16, 1), 9477 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = 9478 NLA_POLICY_MIN(NLA_U16, 1), 9479 [NL80211_MESHCONF_POWER_MODE] = 9480 NLA_POLICY_RANGE(NLA_U32, 9481 NL80211_MESH_POWER_ACTIVE, 9482 NL80211_MESH_POWER_MAX), 9483 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 }, 9484 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 }, 9485 [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 9486 [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 9487 [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 9488 }; 9489 9490 static const struct nla_policy 9491 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = { 9492 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 }, 9493 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 }, 9494 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 }, 9495 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG }, 9496 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 }, 9497 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG }, 9498 [NL80211_MESH_SETUP_IE] = 9499 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 9500 IEEE80211_MAX_DATA_LEN), 9501 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG }, 9502 }; 9503 9504 static int nl80211_parse_mesh_config(struct genl_info *info, 9505 struct mesh_config *cfg, 9506 u32 *mask_out) 9507 { 9508 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1]; 9509 u32 mask = 0; 9510 u16 ht_opmode; 9511 9512 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \ 9513 do { \ 9514 if (tb[attr]) { \ 9515 cfg->param = fn(tb[attr]); \ 9516 mask |= BIT((attr) - 1); \ 9517 } \ 9518 } while (0) 9519 9520 if (!info->attrs[NL80211_ATTR_MESH_CONFIG]) 9521 return -EINVAL; 9522 if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack)) 9523 return -EINVAL; 9524 9525 /* This makes sure that there aren't more than 32 mesh config 9526 * parameters (otherwise our bitfield scheme would not work.) */ 9527 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32); 9528 9529 /* Fill in the params struct */ 9530 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask, 9531 NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16); 9532 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask, 9533 NL80211_MESHCONF_CONFIRM_TIMEOUT, 9534 nla_get_u16); 9535 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask, 9536 NL80211_MESHCONF_HOLDING_TIMEOUT, 9537 nla_get_u16); 9538 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask, 9539 NL80211_MESHCONF_MAX_PEER_LINKS, 9540 nla_get_u16); 9541 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask, 9542 NL80211_MESHCONF_MAX_RETRIES, nla_get_u8); 9543 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask, 9544 NL80211_MESHCONF_TTL, nla_get_u8); 9545 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask, 9546 NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8); 9547 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask, 9548 NL80211_MESHCONF_AUTO_OPEN_PLINKS, 9549 nla_get_u8); 9550 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, 9551 mask, 9552 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 9553 nla_get_u32); 9554 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask, 9555 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 9556 nla_get_u8); 9557 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask, 9558 NL80211_MESHCONF_PATH_REFRESH_TIME, 9559 nla_get_u32); 9560 if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) && 9561 (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535)) 9562 return -EINVAL; 9563 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask, 9564 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 9565 nla_get_u16); 9566 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, 9567 mask, 9568 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 9569 nla_get_u32); 9570 if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) && 9571 (cfg->dot11MeshHWMPactivePathTimeout < 1 || 9572 cfg->dot11MeshHWMPactivePathTimeout > 65535)) 9573 return -EINVAL; 9574 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask, 9575 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 9576 nla_get_u16); 9577 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask, 9578 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 9579 nla_get_u16); 9580 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 9581 dot11MeshHWMPnetDiameterTraversalTime, mask, 9582 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 9583 nla_get_u16); 9584 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask, 9585 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8); 9586 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask, 9587 NL80211_MESHCONF_HWMP_RANN_INTERVAL, 9588 nla_get_u16); 9589 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol, 9590 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 9591 nla_get_u8); 9592 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask, 9593 NL80211_MESHCONF_FORWARDING, nla_get_u8); 9594 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask, 9595 NL80211_MESHCONF_RSSI_THRESHOLD, 9596 nla_get_s32); 9597 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask, 9598 NL80211_MESHCONF_CONNECTED_TO_GATE, 9599 nla_get_u8); 9600 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask, 9601 NL80211_MESHCONF_CONNECTED_TO_AS, 9602 nla_get_u8); 9603 /* 9604 * Check HT operation mode based on 9605 * IEEE 802.11-2016 9.4.2.57 HT Operation element. 9606 */ 9607 if (tb[NL80211_MESHCONF_HT_OPMODE]) { 9608 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]); 9609 9610 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION | 9611 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT | 9612 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)) 9613 return -EINVAL; 9614 9615 /* NON_HT_STA bit is reserved, but some programs set it */ 9616 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT; 9617 9618 cfg->ht_opmode = ht_opmode; 9619 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1)); 9620 } 9621 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 9622 dot11MeshHWMPactivePathToRootTimeout, mask, 9623 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 9624 nla_get_u32); 9625 if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) && 9626 (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 || 9627 cfg->dot11MeshHWMPactivePathToRootTimeout > 65535)) 9628 return -EINVAL; 9629 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask, 9630 NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 9631 nla_get_u16); 9632 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval, 9633 mask, 9634 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 9635 nla_get_u16); 9636 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask, 9637 NL80211_MESHCONF_POWER_MODE, nla_get_u32); 9638 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask, 9639 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16); 9640 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask, 9641 NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32); 9642 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask, 9643 NL80211_MESHCONF_NOLEARN, nla_get_u8); 9644 if (mask_out) 9645 *mask_out = mask; 9646 9647 return 0; 9648 9649 #undef FILL_IN_MESH_PARAM_IF_SET 9650 } 9651 9652 static int nl80211_parse_mesh_setup(struct genl_info *info, 9653 struct mesh_setup *setup) 9654 { 9655 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9656 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1]; 9657 9658 if (!info->attrs[NL80211_ATTR_MESH_SETUP]) 9659 return -EINVAL; 9660 if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack)) 9661 return -EINVAL; 9662 9663 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC]) 9664 setup->sync_method = 9665 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ? 9666 IEEE80211_SYNC_METHOD_VENDOR : 9667 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET; 9668 9669 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL]) 9670 setup->path_sel_proto = 9671 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ? 9672 IEEE80211_PATH_PROTOCOL_VENDOR : 9673 IEEE80211_PATH_PROTOCOL_HWMP; 9674 9675 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC]) 9676 setup->path_metric = 9677 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ? 9678 IEEE80211_PATH_METRIC_VENDOR : 9679 IEEE80211_PATH_METRIC_AIRTIME; 9680 9681 if (tb[NL80211_MESH_SETUP_IE]) { 9682 struct nlattr *ieattr = 9683 tb[NL80211_MESH_SETUP_IE]; 9684 setup->ie = nla_data(ieattr); 9685 setup->ie_len = nla_len(ieattr); 9686 } 9687 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] && 9688 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM)) 9689 return -EINVAL; 9690 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]); 9691 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]); 9692 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]); 9693 if (setup->is_secure) 9694 setup->user_mpm = true; 9695 9696 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) { 9697 if (!setup->user_mpm) 9698 return -EINVAL; 9699 setup->auth_id = 9700 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]); 9701 } 9702 9703 return 0; 9704 } 9705 9706 static int nl80211_update_mesh_config(struct sk_buff *skb, 9707 struct genl_info *info) 9708 { 9709 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9710 struct net_device *dev = info->user_ptr[1]; 9711 struct wireless_dev *wdev = dev->ieee80211_ptr; 9712 struct mesh_config cfg = {}; 9713 u32 mask; 9714 int err; 9715 9716 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 9717 return -EOPNOTSUPP; 9718 9719 if (!rdev->ops->update_mesh_config) 9720 return -EOPNOTSUPP; 9721 9722 err = nl80211_parse_mesh_config(info, &cfg, &mask); 9723 if (err) 9724 return err; 9725 9726 if (!wdev->u.mesh.id_len) 9727 err = -ENOLINK; 9728 9729 if (!err) 9730 err = rdev_update_mesh_config(rdev, dev, mask, &cfg); 9731 9732 return err; 9733 } 9734 9735 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom, 9736 struct sk_buff *msg) 9737 { 9738 struct nlattr *nl_reg_rules; 9739 unsigned int i; 9740 9741 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) || 9742 (regdom->dfs_region && 9743 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region))) 9744 goto nla_put_failure; 9745 9746 nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES); 9747 if (!nl_reg_rules) 9748 goto nla_put_failure; 9749 9750 for (i = 0; i < regdom->n_reg_rules; i++) { 9751 struct nlattr *nl_reg_rule; 9752 const struct ieee80211_reg_rule *reg_rule; 9753 const struct ieee80211_freq_range *freq_range; 9754 const struct ieee80211_power_rule *power_rule; 9755 unsigned int max_bandwidth_khz; 9756 9757 reg_rule = ®dom->reg_rules[i]; 9758 freq_range = ®_rule->freq_range; 9759 power_rule = ®_rule->power_rule; 9760 9761 nl_reg_rule = nla_nest_start_noflag(msg, i); 9762 if (!nl_reg_rule) 9763 goto nla_put_failure; 9764 9765 max_bandwidth_khz = freq_range->max_bandwidth_khz; 9766 if (!max_bandwidth_khz) 9767 max_bandwidth_khz = reg_get_max_bandwidth(regdom, 9768 reg_rule); 9769 9770 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS, 9771 reg_rule->flags) || 9772 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START, 9773 freq_range->start_freq_khz) || 9774 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END, 9775 freq_range->end_freq_khz) || 9776 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW, 9777 max_bandwidth_khz) || 9778 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN, 9779 power_rule->max_antenna_gain) || 9780 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP, 9781 power_rule->max_eirp) || 9782 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME, 9783 reg_rule->dfs_cac_ms)) 9784 goto nla_put_failure; 9785 9786 if ((reg_rule->flags & NL80211_RRF_PSD) && 9787 nla_put_s8(msg, NL80211_ATTR_POWER_RULE_PSD, 9788 reg_rule->psd)) 9789 goto nla_put_failure; 9790 9791 nla_nest_end(msg, nl_reg_rule); 9792 } 9793 9794 nla_nest_end(msg, nl_reg_rules); 9795 return 0; 9796 9797 nla_put_failure: 9798 return -EMSGSIZE; 9799 } 9800 9801 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info) 9802 { 9803 const struct ieee80211_regdomain *regdom = NULL; 9804 struct cfg80211_registered_device *rdev; 9805 struct wiphy *wiphy = NULL; 9806 struct sk_buff *msg; 9807 int err = -EMSGSIZE; 9808 void *hdr; 9809 9810 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 9811 if (!msg) 9812 return -ENOBUFS; 9813 9814 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 9815 NL80211_CMD_GET_REG); 9816 if (!hdr) 9817 goto put_failure; 9818 9819 rtnl_lock(); 9820 9821 if (info->attrs[NL80211_ATTR_WIPHY]) { 9822 bool self_managed; 9823 9824 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 9825 if (IS_ERR(rdev)) { 9826 err = PTR_ERR(rdev); 9827 goto nla_put_failure; 9828 } 9829 9830 wiphy = &rdev->wiphy; 9831 self_managed = wiphy->regulatory_flags & 9832 REGULATORY_WIPHY_SELF_MANAGED; 9833 9834 rcu_read_lock(); 9835 9836 regdom = get_wiphy_regdom(wiphy); 9837 9838 /* a self-managed-reg device must have a private regdom */ 9839 if (WARN_ON(!regdom && self_managed)) { 9840 err = -EINVAL; 9841 goto nla_put_failure_rcu; 9842 } 9843 9844 if (regdom && 9845 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 9846 goto nla_put_failure_rcu; 9847 } else { 9848 rcu_read_lock(); 9849 } 9850 9851 if (!wiphy && reg_last_request_cell_base() && 9852 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 9853 NL80211_USER_REG_HINT_CELL_BASE)) 9854 goto nla_put_failure_rcu; 9855 9856 if (!regdom) 9857 regdom = rcu_dereference(cfg80211_regdomain); 9858 9859 if (nl80211_put_regdom(regdom, msg)) 9860 goto nla_put_failure_rcu; 9861 9862 rcu_read_unlock(); 9863 9864 genlmsg_end(msg, hdr); 9865 rtnl_unlock(); 9866 return genlmsg_reply(msg, info); 9867 9868 nla_put_failure_rcu: 9869 rcu_read_unlock(); 9870 nla_put_failure: 9871 rtnl_unlock(); 9872 put_failure: 9873 nlmsg_free(msg); 9874 return err; 9875 } 9876 9877 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb, 9878 u32 seq, int flags, struct wiphy *wiphy, 9879 const struct ieee80211_regdomain *regdom) 9880 { 9881 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 9882 NL80211_CMD_GET_REG); 9883 9884 if (!hdr) 9885 return -1; 9886 9887 genl_dump_check_consistent(cb, hdr); 9888 9889 if (nl80211_put_regdom(regdom, msg)) 9890 goto nla_put_failure; 9891 9892 if (!wiphy && reg_last_request_cell_base() && 9893 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 9894 NL80211_USER_REG_HINT_CELL_BASE)) 9895 goto nla_put_failure; 9896 9897 if (wiphy && 9898 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 9899 goto nla_put_failure; 9900 9901 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 9902 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 9903 goto nla_put_failure; 9904 9905 genlmsg_end(msg, hdr); 9906 return 0; 9907 9908 nla_put_failure: 9909 genlmsg_cancel(msg, hdr); 9910 return -EMSGSIZE; 9911 } 9912 9913 static int nl80211_get_reg_dump(struct sk_buff *skb, 9914 struct netlink_callback *cb) 9915 { 9916 const struct ieee80211_regdomain *regdom = NULL; 9917 struct cfg80211_registered_device *rdev; 9918 int err, reg_idx, start = cb->args[2]; 9919 9920 rcu_read_lock(); 9921 9922 if (cfg80211_regdomain && start == 0) { 9923 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 9924 NLM_F_MULTI, NULL, 9925 rcu_dereference(cfg80211_regdomain)); 9926 if (err < 0) 9927 goto out_err; 9928 } 9929 9930 /* the global regdom is idx 0 */ 9931 reg_idx = 1; 9932 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 9933 regdom = get_wiphy_regdom(&rdev->wiphy); 9934 if (!regdom) 9935 continue; 9936 9937 if (++reg_idx <= start) 9938 continue; 9939 9940 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 9941 NLM_F_MULTI, &rdev->wiphy, regdom); 9942 if (err < 0) { 9943 reg_idx--; 9944 break; 9945 } 9946 } 9947 9948 cb->args[2] = reg_idx; 9949 err = skb->len; 9950 out_err: 9951 rcu_read_unlock(); 9952 return err; 9953 } 9954 9955 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 9956 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = { 9957 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 }, 9958 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 }, 9959 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 }, 9960 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 }, 9961 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 }, 9962 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 }, 9963 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 }, 9964 }; 9965 9966 static int parse_reg_rule(struct nlattr *tb[], 9967 struct ieee80211_reg_rule *reg_rule) 9968 { 9969 struct ieee80211_freq_range *freq_range = ®_rule->freq_range; 9970 struct ieee80211_power_rule *power_rule = ®_rule->power_rule; 9971 9972 if (!tb[NL80211_ATTR_REG_RULE_FLAGS]) 9973 return -EINVAL; 9974 if (!tb[NL80211_ATTR_FREQ_RANGE_START]) 9975 return -EINVAL; 9976 if (!tb[NL80211_ATTR_FREQ_RANGE_END]) 9977 return -EINVAL; 9978 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]) 9979 return -EINVAL; 9980 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]) 9981 return -EINVAL; 9982 9983 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]); 9984 9985 freq_range->start_freq_khz = 9986 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]); 9987 freq_range->end_freq_khz = 9988 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]); 9989 freq_range->max_bandwidth_khz = 9990 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]); 9991 9992 power_rule->max_eirp = 9993 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]); 9994 9995 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]) 9996 power_rule->max_antenna_gain = 9997 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]); 9998 9999 if (tb[NL80211_ATTR_DFS_CAC_TIME]) 10000 reg_rule->dfs_cac_ms = 10001 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]); 10002 10003 return 0; 10004 } 10005 10006 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info) 10007 { 10008 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1]; 10009 struct nlattr *nl_reg_rule; 10010 char *alpha2; 10011 int rem_reg_rules, r; 10012 u32 num_rules = 0, rule_idx = 0; 10013 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET; 10014 struct ieee80211_regdomain *rd; 10015 10016 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 10017 return -EINVAL; 10018 10019 if (!info->attrs[NL80211_ATTR_REG_RULES]) 10020 return -EINVAL; 10021 10022 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 10023 10024 if (info->attrs[NL80211_ATTR_DFS_REGION]) 10025 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]); 10026 10027 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 10028 rem_reg_rules) { 10029 num_rules++; 10030 if (num_rules > NL80211_MAX_SUPP_REG_RULES) 10031 return -EINVAL; 10032 } 10033 10034 rtnl_lock(); 10035 if (!reg_is_valid_request(alpha2)) { 10036 r = -EINVAL; 10037 goto out; 10038 } 10039 10040 rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL); 10041 if (!rd) { 10042 r = -ENOMEM; 10043 goto out; 10044 } 10045 10046 rd->n_reg_rules = num_rules; 10047 rd->alpha2[0] = alpha2[0]; 10048 rd->alpha2[1] = alpha2[1]; 10049 10050 /* 10051 * Disable DFS master mode if the DFS region was 10052 * not supported or known on this kernel. 10053 */ 10054 if (reg_supported_dfs_region(dfs_region)) 10055 rd->dfs_region = dfs_region; 10056 10057 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 10058 rem_reg_rules) { 10059 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX, 10060 nl_reg_rule, reg_rule_policy, 10061 info->extack); 10062 if (r) 10063 goto bad_reg; 10064 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]); 10065 if (r) 10066 goto bad_reg; 10067 10068 rule_idx++; 10069 10070 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) { 10071 r = -EINVAL; 10072 goto bad_reg; 10073 } 10074 } 10075 10076 r = set_regdom(rd, REGD_SOURCE_CRDA); 10077 /* set_regdom takes ownership of rd */ 10078 rd = NULL; 10079 bad_reg: 10080 kfree(rd); 10081 out: 10082 rtnl_unlock(); 10083 return r; 10084 } 10085 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */ 10086 10087 static int validate_scan_freqs(struct nlattr *freqs) 10088 { 10089 struct nlattr *attr1, *attr2; 10090 int n_channels = 0, tmp1, tmp2; 10091 10092 nla_for_each_nested(attr1, freqs, tmp1) 10093 if (nla_len(attr1) != sizeof(u32)) 10094 return 0; 10095 10096 nla_for_each_nested(attr1, freqs, tmp1) { 10097 n_channels++; 10098 /* 10099 * Some hardware has a limited channel list for 10100 * scanning, and it is pretty much nonsensical 10101 * to scan for a channel twice, so disallow that 10102 * and don't require drivers to check that the 10103 * channel list they get isn't longer than what 10104 * they can scan, as long as they can scan all 10105 * the channels they registered at once. 10106 */ 10107 nla_for_each_nested(attr2, freqs, tmp2) 10108 if (attr1 != attr2 && 10109 nla_get_u32(attr1) == nla_get_u32(attr2)) 10110 return 0; 10111 } 10112 10113 return n_channels; 10114 } 10115 10116 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b) 10117 { 10118 return b < NUM_NL80211_BANDS && wiphy->bands[b]; 10119 } 10120 10121 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy, 10122 struct cfg80211_bss_selection *bss_select) 10123 { 10124 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1]; 10125 struct nlattr *nest; 10126 int err; 10127 bool found = false; 10128 int i; 10129 10130 /* only process one nested attribute */ 10131 nest = nla_data(nla); 10132 if (!nla_ok(nest, nla_len(nest))) 10133 return -EINVAL; 10134 10135 err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX, 10136 nest, nl80211_bss_select_policy, 10137 NULL); 10138 if (err) 10139 return err; 10140 10141 /* only one attribute may be given */ 10142 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) { 10143 if (attr[i]) { 10144 if (found) 10145 return -EINVAL; 10146 found = true; 10147 } 10148 } 10149 10150 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID; 10151 10152 if (attr[NL80211_BSS_SELECT_ATTR_RSSI]) 10153 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI; 10154 10155 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) { 10156 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF; 10157 bss_select->param.band_pref = 10158 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]); 10159 if (!is_band_valid(wiphy, bss_select->param.band_pref)) 10160 return -EINVAL; 10161 } 10162 10163 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) { 10164 struct nl80211_bss_select_rssi_adjust *adj_param; 10165 10166 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]); 10167 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST; 10168 bss_select->param.adjust.band = adj_param->band; 10169 bss_select->param.adjust.delta = adj_param->delta; 10170 if (!is_band_valid(wiphy, bss_select->param.adjust.band)) 10171 return -EINVAL; 10172 } 10173 10174 /* user-space did not provide behaviour attribute */ 10175 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID) 10176 return -EINVAL; 10177 10178 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour))) 10179 return -EINVAL; 10180 10181 return 0; 10182 } 10183 10184 int nl80211_parse_random_mac(struct nlattr **attrs, 10185 u8 *mac_addr, u8 *mac_addr_mask) 10186 { 10187 int i; 10188 10189 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) { 10190 eth_zero_addr(mac_addr); 10191 eth_zero_addr(mac_addr_mask); 10192 mac_addr[0] = 0x2; 10193 mac_addr_mask[0] = 0x3; 10194 10195 return 0; 10196 } 10197 10198 /* need both or none */ 10199 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK]) 10200 return -EINVAL; 10201 10202 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN); 10203 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN); 10204 10205 /* don't allow or configure an mcast address */ 10206 if (!is_multicast_ether_addr(mac_addr_mask) || 10207 is_multicast_ether_addr(mac_addr)) 10208 return -EINVAL; 10209 10210 /* 10211 * allow users to pass a MAC address that has bits set outside 10212 * of the mask, but don't bother drivers with having to deal 10213 * with such bits 10214 */ 10215 for (i = 0; i < ETH_ALEN; i++) 10216 mac_addr[i] &= mac_addr_mask[i]; 10217 10218 return 0; 10219 } 10220 10221 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev, 10222 struct ieee80211_channel *chan) 10223 { 10224 unsigned int link_id; 10225 bool all_ok = true; 10226 int radio_idx; 10227 10228 lockdep_assert_wiphy(wdev->wiphy); 10229 10230 if (!cfg80211_wdev_channel_allowed(wdev, chan)) 10231 return false; 10232 10233 if (!cfg80211_beaconing_iface_active(wdev)) 10234 return true; 10235 10236 radio_idx = cfg80211_get_radio_idx_by_chan(wdev->wiphy, chan); 10237 10238 /* 10239 * FIXME: check if we have a free radio/link for chan 10240 * 10241 * This, as well as the FIXME below, requires knowing the link 10242 * capabilities of the hardware. 10243 */ 10244 10245 /* we cannot leave radar channels */ 10246 for_each_valid_link(wdev, link_id) { 10247 struct cfg80211_chan_def *chandef; 10248 int link_radio_idx; 10249 10250 chandef = wdev_chandef(wdev, link_id); 10251 if (!chandef || !chandef->chan) 10252 continue; 10253 10254 if (!(chandef->chan->flags & IEEE80211_CHAN_RADAR)) 10255 continue; 10256 10257 /* 10258 * chandef->chan is a radar channel. If the radio/link onto 10259 * which this radar channel falls is the same radio/link onto 10260 * which the input 'chan' falls, off-channel operation should 10261 * not be allowed. Hence, set 'all_ok' to false. 10262 */ 10263 10264 link_radio_idx = cfg80211_get_radio_idx_by_chan(wdev->wiphy, 10265 chandef->chan); 10266 if (link_radio_idx == radio_idx) { 10267 all_ok = false; 10268 break; 10269 } 10270 } 10271 10272 if (all_ok) 10273 return true; 10274 10275 return regulatory_pre_cac_allowed(wdev->wiphy); 10276 } 10277 10278 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag, 10279 enum nl80211_ext_feature_index feat) 10280 { 10281 if (!(flags & flag)) 10282 return true; 10283 if (wiphy_ext_feature_isset(wiphy, feat)) 10284 return true; 10285 return false; 10286 } 10287 10288 static int 10289 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev, 10290 struct nlattr **attrs, u8 *mac_addr, u8 *mac_addr_mask, 10291 u32 *flags, enum nl80211_feature_flags randomness_flag) 10292 { 10293 if (!attrs[NL80211_ATTR_SCAN_FLAGS]) 10294 return 0; 10295 10296 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]); 10297 10298 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) && 10299 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) || 10300 !nl80211_check_scan_feat(wiphy, *flags, 10301 NL80211_SCAN_FLAG_LOW_SPAN, 10302 NL80211_EXT_FEATURE_LOW_SPAN_SCAN) || 10303 !nl80211_check_scan_feat(wiphy, *flags, 10304 NL80211_SCAN_FLAG_LOW_POWER, 10305 NL80211_EXT_FEATURE_LOW_POWER_SCAN) || 10306 !nl80211_check_scan_feat(wiphy, *flags, 10307 NL80211_SCAN_FLAG_HIGH_ACCURACY, 10308 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) || 10309 !nl80211_check_scan_feat(wiphy, *flags, 10310 NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME, 10311 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) || 10312 !nl80211_check_scan_feat(wiphy, *flags, 10313 NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP, 10314 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) || 10315 !nl80211_check_scan_feat(wiphy, *flags, 10316 NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION, 10317 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) || 10318 !nl80211_check_scan_feat(wiphy, *flags, 10319 NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE, 10320 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) || 10321 !nl80211_check_scan_feat(wiphy, *flags, 10322 NL80211_SCAN_FLAG_RANDOM_SN, 10323 NL80211_EXT_FEATURE_SCAN_RANDOM_SN) || 10324 !nl80211_check_scan_feat(wiphy, *flags, 10325 NL80211_SCAN_FLAG_MIN_PREQ_CONTENT, 10326 NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT)) 10327 return -EOPNOTSUPP; 10328 10329 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { 10330 int err; 10331 10332 if (!(wiphy->features & randomness_flag) || 10333 (wdev && wdev->connected)) 10334 return -EOPNOTSUPP; 10335 10336 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask); 10337 if (err) 10338 return err; 10339 } 10340 10341 return 0; 10342 } 10343 10344 static int 10345 nl80211_check_scan_flags_sched(struct wiphy *wiphy, struct wireless_dev *wdev, 10346 struct nlattr **attrs, 10347 struct cfg80211_sched_scan_request *req) 10348 { 10349 return nl80211_check_scan_flags(wiphy, wdev, attrs, 10350 req->mac_addr, req->mac_addr_mask, 10351 &req->flags, 10352 wdev ? NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR : 10353 NL80211_FEATURE_ND_RANDOM_MAC_ADDR); 10354 } 10355 10356 static int 10357 nl80211_check_scan_flags_reg(struct wiphy *wiphy, struct wireless_dev *wdev, 10358 struct nlattr **attrs, 10359 struct cfg80211_scan_request_int *req) 10360 { 10361 return nl80211_check_scan_flags(wiphy, wdev, attrs, 10362 req->req.mac_addr, 10363 req->req.mac_addr_mask, 10364 &req->req.flags, 10365 NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR); 10366 } 10367 10368 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info) 10369 { 10370 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10371 struct wireless_dev *wdev = info->user_ptr[1]; 10372 struct cfg80211_scan_request_int *request; 10373 struct nlattr *scan_freqs = NULL; 10374 bool scan_freqs_khz = false; 10375 struct nlattr *attr; 10376 struct wiphy *wiphy; 10377 int err, tmp, n_ssids = 0, n_channels, i; 10378 size_t ie_len, size; 10379 size_t ssids_offset, ie_offset; 10380 10381 wiphy = &rdev->wiphy; 10382 10383 if (wdev->iftype == NL80211_IFTYPE_NAN) 10384 return -EOPNOTSUPP; 10385 10386 if (!rdev->ops->scan) 10387 return -EOPNOTSUPP; 10388 10389 if (rdev->scan_req || rdev->scan_msg) 10390 return -EBUSY; 10391 10392 if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) { 10393 if (!wiphy_ext_feature_isset(wiphy, 10394 NL80211_EXT_FEATURE_SCAN_FREQ_KHZ)) 10395 return -EOPNOTSUPP; 10396 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]; 10397 scan_freqs_khz = true; 10398 } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) 10399 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]; 10400 10401 if (scan_freqs) { 10402 n_channels = validate_scan_freqs(scan_freqs); 10403 if (!n_channels) 10404 return -EINVAL; 10405 } else { 10406 n_channels = ieee80211_get_num_supported_channels(wiphy); 10407 } 10408 10409 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) 10410 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) 10411 n_ssids++; 10412 10413 if (n_ssids > wiphy->max_scan_ssids) 10414 return -EINVAL; 10415 10416 if (info->attrs[NL80211_ATTR_IE]) 10417 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10418 else 10419 ie_len = 0; 10420 10421 if (ie_len > wiphy->max_scan_ie_len) 10422 return -EINVAL; 10423 10424 size = struct_size(request, req.channels, n_channels); 10425 ssids_offset = size; 10426 size = size_add(size, array_size(sizeof(*request->req.ssids), n_ssids)); 10427 ie_offset = size; 10428 size = size_add(size, ie_len); 10429 request = kzalloc(size, GFP_KERNEL); 10430 if (!request) 10431 return -ENOMEM; 10432 10433 if (n_ssids) 10434 request->req.ssids = (void *)request + ssids_offset; 10435 request->req.n_ssids = n_ssids; 10436 if (ie_len) 10437 request->req.ie = (void *)request + ie_offset; 10438 10439 i = 0; 10440 if (scan_freqs) { 10441 /* user specified, bail out if channel not found */ 10442 nla_for_each_nested(attr, scan_freqs, tmp) { 10443 struct ieee80211_channel *chan; 10444 int freq = nla_get_u32(attr); 10445 10446 if (!scan_freqs_khz) 10447 freq = MHZ_TO_KHZ(freq); 10448 10449 chan = ieee80211_get_channel_khz(wiphy, freq); 10450 if (!chan) { 10451 err = -EINVAL; 10452 goto out_free; 10453 } 10454 10455 /* Ignore disabled / no primary channels */ 10456 if (chan->flags & IEEE80211_CHAN_DISABLED || 10457 chan->flags & IEEE80211_CHAN_S1G_NO_PRIMARY || 10458 !cfg80211_wdev_channel_allowed(wdev, chan)) 10459 continue; 10460 10461 request->req.channels[i] = chan; 10462 i++; 10463 } 10464 } else { 10465 enum nl80211_band band; 10466 10467 /* all channels */ 10468 for (band = 0; band < NUM_NL80211_BANDS; band++) { 10469 int j; 10470 10471 if (!wiphy->bands[band]) 10472 continue; 10473 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 10474 struct ieee80211_channel *chan; 10475 10476 chan = &wiphy->bands[band]->channels[j]; 10477 10478 if (chan->flags & IEEE80211_CHAN_DISABLED || 10479 chan->flags & 10480 IEEE80211_CHAN_S1G_NO_PRIMARY || 10481 !cfg80211_wdev_channel_allowed(wdev, chan)) 10482 continue; 10483 10484 request->req.channels[i] = chan; 10485 i++; 10486 } 10487 } 10488 } 10489 10490 if (!i) { 10491 err = -EINVAL; 10492 goto out_free; 10493 } 10494 10495 request->req.n_channels = i; 10496 10497 for (i = 0; i < request->req.n_channels; i++) { 10498 struct ieee80211_channel *chan = request->req.channels[i]; 10499 10500 /* if we can go off-channel to the target channel we're good */ 10501 if (cfg80211_off_channel_oper_allowed(wdev, chan)) 10502 continue; 10503 10504 if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) { 10505 err = -EBUSY; 10506 goto out_free; 10507 } 10508 } 10509 10510 i = 0; 10511 if (n_ssids) { 10512 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) { 10513 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 10514 err = -EINVAL; 10515 goto out_free; 10516 } 10517 request->req.ssids[i].ssid_len = nla_len(attr); 10518 memcpy(request->req.ssids[i].ssid, 10519 nla_data(attr), nla_len(attr)); 10520 i++; 10521 } 10522 } 10523 10524 if (info->attrs[NL80211_ATTR_IE]) { 10525 request->req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10526 memcpy((void *)request->req.ie, 10527 nla_data(info->attrs[NL80211_ATTR_IE]), 10528 request->req.ie_len); 10529 } 10530 10531 for (i = 0; i < NUM_NL80211_BANDS; i++) 10532 if (wiphy->bands[i]) 10533 request->req.rates[i] = 10534 (1 << wiphy->bands[i]->n_bitrates) - 1; 10535 10536 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) { 10537 nla_for_each_nested(attr, 10538 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES], 10539 tmp) { 10540 enum nl80211_band band = nla_type(attr); 10541 10542 if (band < 0 || band >= NUM_NL80211_BANDS) { 10543 err = -EINVAL; 10544 goto out_free; 10545 } 10546 10547 if (!wiphy->bands[band]) 10548 continue; 10549 10550 err = ieee80211_get_ratemask(wiphy->bands[band], 10551 nla_data(attr), 10552 nla_len(attr), 10553 &request->req.rates[band]); 10554 if (err) 10555 goto out_free; 10556 } 10557 } 10558 10559 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) { 10560 request->req.duration = 10561 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]); 10562 request->req.duration_mandatory = 10563 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]); 10564 } 10565 10566 err = nl80211_check_scan_flags_reg(wiphy, wdev, info->attrs, request); 10567 if (err) 10568 goto out_free; 10569 10570 request->req.no_cck = 10571 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 10572 10573 /* Initial implementation used NL80211_ATTR_MAC to set the specific 10574 * BSSID to scan for. This was problematic because that same attribute 10575 * was already used for another purpose (local random MAC address). The 10576 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards 10577 * compatibility with older userspace components, also use the 10578 * NL80211_ATTR_MAC value here if it can be determined to be used for 10579 * the specific BSSID use case instead of the random MAC address 10580 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use). 10581 */ 10582 if (info->attrs[NL80211_ATTR_BSSID]) 10583 memcpy(request->req.bssid, 10584 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN); 10585 else if (!(request->req.flags & NL80211_SCAN_FLAG_RANDOM_ADDR) && 10586 info->attrs[NL80211_ATTR_MAC]) 10587 memcpy(request->req.bssid, 10588 nla_data(info->attrs[NL80211_ATTR_MAC]), 10589 ETH_ALEN); 10590 else 10591 eth_broadcast_addr(request->req.bssid); 10592 10593 request->req.tsf_report_link_id = 10594 nl80211_link_id_or_invalid(info->attrs); 10595 request->req.wdev = wdev; 10596 request->req.wiphy = &rdev->wiphy; 10597 request->req.scan_start = jiffies; 10598 10599 rdev->scan_req = request; 10600 err = cfg80211_scan(rdev); 10601 10602 if (err) 10603 goto out_free; 10604 10605 nl80211_send_scan_start(rdev, wdev); 10606 dev_hold(wdev->netdev); 10607 10608 return 0; 10609 10610 out_free: 10611 rdev->scan_req = NULL; 10612 kfree(request); 10613 10614 return err; 10615 } 10616 10617 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info) 10618 { 10619 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10620 struct wireless_dev *wdev = info->user_ptr[1]; 10621 10622 if (!rdev->ops->abort_scan) 10623 return -EOPNOTSUPP; 10624 10625 if (rdev->scan_msg) 10626 return 0; 10627 10628 if (!rdev->scan_req) 10629 return -ENOENT; 10630 10631 rdev_abort_scan(rdev, wdev); 10632 return 0; 10633 } 10634 10635 static int 10636 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans, 10637 struct cfg80211_sched_scan_request *request, 10638 struct nlattr **attrs) 10639 { 10640 int tmp, err, i = 0; 10641 struct nlattr *attr; 10642 10643 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 10644 u32 interval; 10645 10646 /* 10647 * If scan plans are not specified, 10648 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this 10649 * case one scan plan will be set with the specified scan 10650 * interval and infinite number of iterations. 10651 */ 10652 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]); 10653 if (!interval) 10654 return -EINVAL; 10655 10656 request->scan_plans[0].interval = 10657 DIV_ROUND_UP(interval, MSEC_PER_SEC); 10658 if (!request->scan_plans[0].interval) 10659 return -EINVAL; 10660 10661 if (request->scan_plans[0].interval > 10662 wiphy->max_sched_scan_plan_interval) 10663 request->scan_plans[0].interval = 10664 wiphy->max_sched_scan_plan_interval; 10665 10666 return 0; 10667 } 10668 10669 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) { 10670 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1]; 10671 10672 if (WARN_ON(i >= n_plans)) 10673 return -EINVAL; 10674 10675 err = nla_parse_nested_deprecated(plan, 10676 NL80211_SCHED_SCAN_PLAN_MAX, 10677 attr, nl80211_plan_policy, 10678 NULL); 10679 if (err) 10680 return err; 10681 10682 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]) 10683 return -EINVAL; 10684 10685 request->scan_plans[i].interval = 10686 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]); 10687 if (!request->scan_plans[i].interval || 10688 request->scan_plans[i].interval > 10689 wiphy->max_sched_scan_plan_interval) 10690 return -EINVAL; 10691 10692 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) { 10693 request->scan_plans[i].iterations = 10694 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]); 10695 if (!request->scan_plans[i].iterations || 10696 (request->scan_plans[i].iterations > 10697 wiphy->max_sched_scan_plan_iterations)) 10698 return -EINVAL; 10699 } else if (i < n_plans - 1) { 10700 /* 10701 * All scan plans but the last one must specify 10702 * a finite number of iterations 10703 */ 10704 return -EINVAL; 10705 } 10706 10707 i++; 10708 } 10709 10710 /* 10711 * The last scan plan must not specify the number of 10712 * iterations, it is supposed to run infinitely 10713 */ 10714 if (request->scan_plans[n_plans - 1].iterations) 10715 return -EINVAL; 10716 10717 return 0; 10718 } 10719 10720 static struct cfg80211_sched_scan_request * 10721 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev, 10722 struct nlattr **attrs, int max_match_sets) 10723 { 10724 struct cfg80211_sched_scan_request *request; 10725 struct nlattr *attr; 10726 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0; 10727 enum nl80211_band band; 10728 size_t ie_len, size; 10729 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1]; 10730 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF; 10731 10732 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 10733 n_channels = validate_scan_freqs( 10734 attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 10735 if (!n_channels) 10736 return ERR_PTR(-EINVAL); 10737 } else { 10738 n_channels = ieee80211_get_num_supported_channels(wiphy); 10739 } 10740 10741 if (attrs[NL80211_ATTR_SCAN_SSIDS]) 10742 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 10743 tmp) 10744 n_ssids++; 10745 10746 if (n_ssids > wiphy->max_sched_scan_ssids) 10747 return ERR_PTR(-EINVAL); 10748 10749 /* 10750 * First, count the number of 'real' matchsets. Due to an issue with 10751 * the old implementation, matchsets containing only the RSSI attribute 10752 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default' 10753 * RSSI for all matchsets, rather than their own matchset for reporting 10754 * all APs with a strong RSSI. This is needed to be compatible with 10755 * older userspace that treated a matchset with only the RSSI as the 10756 * global RSSI for all other matchsets - if there are other matchsets. 10757 */ 10758 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 10759 nla_for_each_nested(attr, 10760 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 10761 tmp) { 10762 struct nlattr *rssi; 10763 10764 err = nla_parse_nested_deprecated(tb, 10765 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 10766 attr, 10767 nl80211_match_policy, 10768 NULL); 10769 if (err) 10770 return ERR_PTR(err); 10771 10772 /* SSID and BSSID are mutually exclusive */ 10773 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] && 10774 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) 10775 return ERR_PTR(-EINVAL); 10776 10777 /* add other standalone attributes here */ 10778 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] || 10779 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) { 10780 n_match_sets++; 10781 continue; 10782 } 10783 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 10784 if (rssi) 10785 default_match_rssi = nla_get_s32(rssi); 10786 } 10787 } 10788 10789 /* However, if there's no other matchset, add the RSSI one */ 10790 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF) 10791 n_match_sets = 1; 10792 10793 if (n_match_sets > max_match_sets) 10794 return ERR_PTR(-EINVAL); 10795 10796 if (attrs[NL80211_ATTR_IE]) 10797 ie_len = nla_len(attrs[NL80211_ATTR_IE]); 10798 else 10799 ie_len = 0; 10800 10801 if (ie_len > wiphy->max_sched_scan_ie_len) 10802 return ERR_PTR(-EINVAL); 10803 10804 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 10805 /* 10806 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since 10807 * each scan plan already specifies its own interval 10808 */ 10809 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 10810 return ERR_PTR(-EINVAL); 10811 10812 nla_for_each_nested(attr, 10813 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) 10814 n_plans++; 10815 } else { 10816 /* 10817 * The scan interval attribute is kept for backward 10818 * compatibility. If no scan plans are specified and sched scan 10819 * interval is specified, one scan plan will be set with this 10820 * scan interval and infinite number of iterations. 10821 */ 10822 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 10823 return ERR_PTR(-EINVAL); 10824 10825 n_plans = 1; 10826 } 10827 10828 if (!n_plans || n_plans > wiphy->max_sched_scan_plans) 10829 return ERR_PTR(-EINVAL); 10830 10831 if (!wiphy_ext_feature_isset( 10832 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) && 10833 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] || 10834 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST])) 10835 return ERR_PTR(-EINVAL); 10836 10837 size = struct_size(request, channels, n_channels); 10838 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 10839 size = size_add(size, array_size(sizeof(*request->match_sets), 10840 n_match_sets)); 10841 size = size_add(size, array_size(sizeof(*request->scan_plans), 10842 n_plans)); 10843 size = size_add(size, ie_len); 10844 request = kzalloc(size, GFP_KERNEL); 10845 if (!request) 10846 return ERR_PTR(-ENOMEM); 10847 request->n_channels = n_channels; 10848 10849 if (n_ssids) 10850 request->ssids = (void *)request + 10851 struct_size(request, channels, n_channels); 10852 request->n_ssids = n_ssids; 10853 if (ie_len) { 10854 if (n_ssids) 10855 request->ie = (void *)(request->ssids + n_ssids); 10856 else 10857 request->ie = (void *)(request->channels + n_channels); 10858 } 10859 10860 if (n_match_sets) { 10861 if (request->ie) 10862 request->match_sets = (void *)(request->ie + ie_len); 10863 else if (n_ssids) 10864 request->match_sets = 10865 (void *)(request->ssids + n_ssids); 10866 else 10867 request->match_sets = 10868 (void *)(request->channels + n_channels); 10869 } 10870 request->n_match_sets = n_match_sets; 10871 10872 if (n_match_sets) 10873 request->scan_plans = (void *)(request->match_sets + 10874 n_match_sets); 10875 else if (request->ie) 10876 request->scan_plans = (void *)(request->ie + ie_len); 10877 else if (n_ssids) 10878 request->scan_plans = (void *)(request->ssids + n_ssids); 10879 else 10880 request->scan_plans = (void *)(request->channels + n_channels); 10881 10882 request->n_scan_plans = n_plans; 10883 10884 i = 0; 10885 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 10886 /* user specified, bail out if channel not found */ 10887 nla_for_each_nested(attr, 10888 attrs[NL80211_ATTR_SCAN_FREQUENCIES], 10889 tmp) { 10890 struct ieee80211_channel *chan; 10891 10892 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 10893 10894 if (!chan) { 10895 err = -EINVAL; 10896 goto out_free; 10897 } 10898 10899 /* ignore disabled channels */ 10900 if (chan->flags & IEEE80211_CHAN_DISABLED) 10901 continue; 10902 10903 request->channels[i] = chan; 10904 i++; 10905 } 10906 } else { 10907 /* all channels */ 10908 for (band = 0; band < NUM_NL80211_BANDS; band++) { 10909 int j; 10910 10911 if (!wiphy->bands[band]) 10912 continue; 10913 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 10914 struct ieee80211_channel *chan; 10915 10916 chan = &wiphy->bands[band]->channels[j]; 10917 10918 if (chan->flags & IEEE80211_CHAN_DISABLED) 10919 continue; 10920 10921 request->channels[i] = chan; 10922 i++; 10923 } 10924 } 10925 } 10926 10927 if (!i) { 10928 err = -EINVAL; 10929 goto out_free; 10930 } 10931 10932 request->n_channels = i; 10933 10934 i = 0; 10935 if (n_ssids) { 10936 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 10937 tmp) { 10938 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 10939 err = -EINVAL; 10940 goto out_free; 10941 } 10942 request->ssids[i].ssid_len = nla_len(attr); 10943 memcpy(request->ssids[i].ssid, nla_data(attr), 10944 nla_len(attr)); 10945 i++; 10946 } 10947 } 10948 10949 i = 0; 10950 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 10951 nla_for_each_nested(attr, 10952 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 10953 tmp) { 10954 struct nlattr *ssid, *bssid, *rssi; 10955 10956 err = nla_parse_nested_deprecated(tb, 10957 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 10958 attr, 10959 nl80211_match_policy, 10960 NULL); 10961 if (err) 10962 goto out_free; 10963 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]; 10964 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]; 10965 10966 if (!ssid && !bssid) { 10967 i++; 10968 continue; 10969 } 10970 10971 if (WARN_ON(i >= n_match_sets)) { 10972 /* this indicates a programming error, 10973 * the loop above should have verified 10974 * things properly 10975 */ 10976 err = -EINVAL; 10977 goto out_free; 10978 } 10979 10980 if (ssid) { 10981 memcpy(request->match_sets[i].ssid.ssid, 10982 nla_data(ssid), nla_len(ssid)); 10983 request->match_sets[i].ssid.ssid_len = 10984 nla_len(ssid); 10985 } 10986 if (bssid) 10987 memcpy(request->match_sets[i].bssid, 10988 nla_data(bssid), ETH_ALEN); 10989 10990 /* special attribute - old implementation w/a */ 10991 request->match_sets[i].rssi_thold = default_match_rssi; 10992 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 10993 if (rssi) 10994 request->match_sets[i].rssi_thold = 10995 nla_get_s32(rssi); 10996 i++; 10997 } 10998 10999 /* there was no other matchset, so the RSSI one is alone */ 11000 if (i == 0 && n_match_sets) 11001 request->match_sets[0].rssi_thold = default_match_rssi; 11002 11003 request->min_rssi_thold = INT_MAX; 11004 for (i = 0; i < n_match_sets; i++) 11005 request->min_rssi_thold = 11006 min(request->match_sets[i].rssi_thold, 11007 request->min_rssi_thold); 11008 } else { 11009 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF; 11010 } 11011 11012 if (ie_len) { 11013 request->ie_len = ie_len; 11014 memcpy((void *)request->ie, 11015 nla_data(attrs[NL80211_ATTR_IE]), 11016 request->ie_len); 11017 } 11018 11019 err = nl80211_check_scan_flags_sched(wiphy, wdev, attrs, request); 11020 if (err) 11021 goto out_free; 11022 11023 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY]) 11024 request->delay = 11025 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]); 11026 11027 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) { 11028 request->relative_rssi = nla_get_s8( 11029 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]); 11030 request->relative_rssi_set = true; 11031 } 11032 11033 if (request->relative_rssi_set && 11034 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) { 11035 struct nl80211_bss_select_rssi_adjust *rssi_adjust; 11036 11037 rssi_adjust = nla_data( 11038 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]); 11039 request->rssi_adjust.band = rssi_adjust->band; 11040 request->rssi_adjust.delta = rssi_adjust->delta; 11041 if (!is_band_valid(wiphy, request->rssi_adjust.band)) { 11042 err = -EINVAL; 11043 goto out_free; 11044 } 11045 } 11046 11047 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs); 11048 if (err) 11049 goto out_free; 11050 11051 request->scan_start = jiffies; 11052 11053 return request; 11054 11055 out_free: 11056 kfree(request); 11057 return ERR_PTR(err); 11058 } 11059 11060 static int nl80211_start_sched_scan(struct sk_buff *skb, 11061 struct genl_info *info) 11062 { 11063 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11064 struct net_device *dev = info->user_ptr[1]; 11065 struct wireless_dev *wdev = dev->ieee80211_ptr; 11066 struct cfg80211_sched_scan_request *sched_scan_req; 11067 bool want_multi; 11068 int err; 11069 11070 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start) 11071 return -EOPNOTSUPP; 11072 11073 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI]; 11074 err = cfg80211_sched_scan_req_possible(rdev, want_multi); 11075 if (err) 11076 return err; 11077 11078 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev, 11079 info->attrs, 11080 rdev->wiphy.max_match_sets); 11081 11082 err = PTR_ERR_OR_ZERO(sched_scan_req); 11083 if (err) 11084 goto out_err; 11085 11086 /* leave request id zero for legacy request 11087 * or if driver does not support multi-scheduled scan 11088 */ 11089 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) 11090 sched_scan_req->reqid = cfg80211_assign_cookie(rdev); 11091 11092 err = rdev_sched_scan_start(rdev, dev, sched_scan_req); 11093 if (err) 11094 goto out_free; 11095 11096 sched_scan_req->dev = dev; 11097 sched_scan_req->wiphy = &rdev->wiphy; 11098 11099 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 11100 sched_scan_req->owner_nlportid = info->snd_portid; 11101 11102 cfg80211_add_sched_scan_req(rdev, sched_scan_req); 11103 11104 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN); 11105 return 0; 11106 11107 out_free: 11108 kfree(sched_scan_req); 11109 out_err: 11110 return err; 11111 } 11112 11113 static int nl80211_stop_sched_scan(struct sk_buff *skb, 11114 struct genl_info *info) 11115 { 11116 struct cfg80211_sched_scan_request *req; 11117 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11118 u64 cookie; 11119 11120 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop) 11121 return -EOPNOTSUPP; 11122 11123 if (info->attrs[NL80211_ATTR_COOKIE]) { 11124 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 11125 return __cfg80211_stop_sched_scan(rdev, cookie, false); 11126 } 11127 11128 req = list_first_or_null_rcu(&rdev->sched_scan_req_list, 11129 struct cfg80211_sched_scan_request, 11130 list); 11131 if (!req || req->reqid || 11132 (req->owner_nlportid && 11133 req->owner_nlportid != info->snd_portid)) 11134 return -ENOENT; 11135 11136 return cfg80211_stop_sched_scan_req(rdev, req, false); 11137 } 11138 11139 static int nl80211_start_radar_detection(struct sk_buff *skb, 11140 struct genl_info *info) 11141 { 11142 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11143 struct net_device *dev = info->user_ptr[1]; 11144 struct wireless_dev *wdev = dev->ieee80211_ptr; 11145 int link_id = nl80211_link_id(info->attrs); 11146 struct wiphy *wiphy = wdev->wiphy; 11147 struct cfg80211_chan_def chandef; 11148 enum nl80211_dfs_regions dfs_region; 11149 unsigned int cac_time_ms; 11150 int err; 11151 11152 flush_delayed_work(&rdev->dfs_update_channels_wk); 11153 11154 switch (wdev->iftype) { 11155 case NL80211_IFTYPE_AP: 11156 case NL80211_IFTYPE_P2P_GO: 11157 case NL80211_IFTYPE_MESH_POINT: 11158 case NL80211_IFTYPE_ADHOC: 11159 break; 11160 default: 11161 /* caution - see cfg80211_beaconing_iface_active() below */ 11162 return -EINVAL; 11163 } 11164 11165 guard(wiphy)(wiphy); 11166 11167 dfs_region = reg_get_dfs_region(wiphy); 11168 if (dfs_region == NL80211_DFS_UNSET) 11169 return -EINVAL; 11170 11171 err = nl80211_parse_chandef(rdev, info, &chandef); 11172 if (err) 11173 return err; 11174 11175 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 11176 if (err < 0) 11177 return err; 11178 11179 if (err == 0) 11180 return -EINVAL; 11181 11182 if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) 11183 return -EINVAL; 11184 11185 if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) 11186 return cfg80211_start_background_radar_detection(rdev, wdev, 11187 &chandef); 11188 11189 if (cfg80211_beaconing_iface_active(wdev)) { 11190 /* During MLO other link(s) can beacon, only the current link 11191 * can not already beacon 11192 */ 11193 if (wdev->valid_links && 11194 !wdev->links[link_id].ap.beacon_interval) { 11195 /* nothing */ 11196 } else { 11197 return -EBUSY; 11198 } 11199 } 11200 11201 if (wdev->links[link_id].cac_started) 11202 return -EBUSY; 11203 11204 /* CAC start is offloaded to HW and can't be started manually */ 11205 if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) 11206 return -EOPNOTSUPP; 11207 11208 if (!rdev->ops->start_radar_detection) 11209 return -EOPNOTSUPP; 11210 11211 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef); 11212 if (WARN_ON(!cac_time_ms)) 11213 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS; 11214 11215 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms, 11216 link_id); 11217 if (err) 11218 return err; 11219 11220 switch (wdev->iftype) { 11221 case NL80211_IFTYPE_AP: 11222 case NL80211_IFTYPE_P2P_GO: 11223 wdev->links[link_id].ap.chandef = chandef; 11224 break; 11225 case NL80211_IFTYPE_ADHOC: 11226 wdev->u.ibss.chandef = chandef; 11227 break; 11228 case NL80211_IFTYPE_MESH_POINT: 11229 wdev->u.mesh.chandef = chandef; 11230 break; 11231 default: 11232 break; 11233 } 11234 wdev->links[link_id].cac_started = true; 11235 wdev->links[link_id].cac_start_time = jiffies; 11236 wdev->links[link_id].cac_time_ms = cac_time_ms; 11237 11238 return 0; 11239 } 11240 11241 static int nl80211_notify_radar_detection(struct sk_buff *skb, 11242 struct genl_info *info) 11243 { 11244 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11245 struct net_device *dev = info->user_ptr[1]; 11246 struct wireless_dev *wdev = dev->ieee80211_ptr; 11247 struct wiphy *wiphy = wdev->wiphy; 11248 struct cfg80211_chan_def chandef; 11249 enum nl80211_dfs_regions dfs_region; 11250 int err; 11251 11252 dfs_region = reg_get_dfs_region(wiphy); 11253 if (dfs_region == NL80211_DFS_UNSET) { 11254 GENL_SET_ERR_MSG(info, 11255 "DFS Region is not set. Unexpected Radar indication"); 11256 return -EINVAL; 11257 } 11258 11259 err = nl80211_parse_chandef(rdev, info, &chandef); 11260 if (err) { 11261 GENL_SET_ERR_MSG(info, "Unable to extract chandef info"); 11262 return err; 11263 } 11264 11265 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 11266 if (err < 0) { 11267 GENL_SET_ERR_MSG(info, "chandef is invalid"); 11268 return err; 11269 } 11270 11271 if (err == 0) { 11272 GENL_SET_ERR_MSG(info, 11273 "Unexpected Radar indication for chandef/iftype"); 11274 return -EINVAL; 11275 } 11276 11277 /* Do not process this notification if radar is already detected 11278 * by kernel on this channel, and return success. 11279 */ 11280 if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE) 11281 return 0; 11282 11283 cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE); 11284 11285 cfg80211_sched_dfs_chan_update(rdev); 11286 11287 rdev->radar_chandef = chandef; 11288 11289 /* Propagate this notification to other radios as well */ 11290 queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk); 11291 11292 return 0; 11293 } 11294 11295 static int nl80211_parse_counter_offsets(struct cfg80211_registered_device *rdev, 11296 const u8 *data, size_t datalen, 11297 int first_count, struct nlattr *attr, 11298 const u16 **offsets, unsigned int *n_offsets) 11299 { 11300 int i; 11301 11302 *n_offsets = 0; 11303 11304 if (!attr) 11305 return 0; 11306 11307 if (!nla_len(attr) || (nla_len(attr) % sizeof(u16))) 11308 return -EINVAL; 11309 11310 *n_offsets = nla_len(attr) / sizeof(u16); 11311 if (rdev->wiphy.max_num_csa_counters && 11312 (*n_offsets > rdev->wiphy.max_num_csa_counters)) 11313 return -EINVAL; 11314 11315 *offsets = nla_data(attr); 11316 11317 /* sanity checks - counters should fit and be the same */ 11318 for (i = 0; i < *n_offsets; i++) { 11319 u16 offset = (*offsets)[i]; 11320 11321 if (offset >= datalen) 11322 return -EINVAL; 11323 11324 if (first_count != -1 && data[offset] != first_count) 11325 return -EINVAL; 11326 } 11327 11328 return 0; 11329 } 11330 11331 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info) 11332 { 11333 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11334 unsigned int link_id = nl80211_link_id(info->attrs); 11335 struct net_device *dev = info->user_ptr[1]; 11336 struct wireless_dev *wdev = dev->ieee80211_ptr; 11337 struct cfg80211_csa_settings params; 11338 struct nlattr **csa_attrs = NULL; 11339 int err; 11340 bool need_new_beacon = false; 11341 bool need_handle_dfs_flag = true; 11342 u32 cs_count; 11343 11344 if (!rdev->ops->channel_switch || 11345 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 11346 return -EOPNOTSUPP; 11347 11348 switch (dev->ieee80211_ptr->iftype) { 11349 case NL80211_IFTYPE_AP: 11350 case NL80211_IFTYPE_P2P_GO: 11351 need_new_beacon = true; 11352 /* For all modes except AP the handle_dfs flag needs to be 11353 * supplied to tell the kernel that userspace will handle radar 11354 * events when they happen. Otherwise a switch to a channel 11355 * requiring DFS will be rejected. 11356 */ 11357 need_handle_dfs_flag = false; 11358 11359 /* useless if AP is not running */ 11360 if (!wdev->links[link_id].ap.beacon_interval) 11361 return -ENOTCONN; 11362 break; 11363 case NL80211_IFTYPE_ADHOC: 11364 if (!wdev->u.ibss.ssid_len) 11365 return -ENOTCONN; 11366 break; 11367 case NL80211_IFTYPE_MESH_POINT: 11368 if (!wdev->u.mesh.id_len) 11369 return -ENOTCONN; 11370 break; 11371 default: 11372 return -EOPNOTSUPP; 11373 } 11374 11375 memset(¶ms, 0, sizeof(params)); 11376 params.beacon_csa.ftm_responder = -1; 11377 11378 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 11379 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]) 11380 return -EINVAL; 11381 11382 /* only important for AP, IBSS and mesh create IEs internally */ 11383 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES]) 11384 return -EINVAL; 11385 11386 /* Even though the attribute is u32, the specification says 11387 * u8, so let's make sure we don't overflow. 11388 */ 11389 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]); 11390 if (cs_count > 255) 11391 return -EINVAL; 11392 11393 params.count = cs_count; 11394 11395 if (!need_new_beacon) 11396 goto skip_beacons; 11397 11398 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_after, 11399 info->extack); 11400 if (err) 11401 goto free; 11402 11403 csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs), 11404 GFP_KERNEL); 11405 if (!csa_attrs) { 11406 err = -ENOMEM; 11407 goto free; 11408 } 11409 11410 err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX, 11411 info->attrs[NL80211_ATTR_CSA_IES], 11412 nl80211_policy, info->extack); 11413 if (err) 11414 goto free; 11415 11416 err = nl80211_parse_beacon(rdev, csa_attrs, ¶ms.beacon_csa, 11417 info->extack); 11418 if (err) 11419 goto free; 11420 11421 if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 11422 err = -EINVAL; 11423 goto free; 11424 } 11425 11426 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.tail, 11427 params.beacon_csa.tail_len, 11428 params.count, 11429 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON], 11430 ¶ms.counter_offsets_beacon, 11431 ¶ms.n_counter_offsets_beacon); 11432 if (err) 11433 goto free; 11434 11435 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.probe_resp, 11436 params.beacon_csa.probe_resp_len, 11437 params.count, 11438 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP], 11439 ¶ms.counter_offsets_presp, 11440 ¶ms.n_counter_offsets_presp); 11441 if (err) 11442 goto free; 11443 11444 skip_beacons: 11445 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 11446 if (err) 11447 goto free; 11448 11449 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 11450 wdev->iftype)) { 11451 err = -EINVAL; 11452 goto free; 11453 } 11454 11455 err = cfg80211_chandef_dfs_required(wdev->wiphy, 11456 ¶ms.chandef, 11457 wdev->iftype); 11458 if (err < 0) 11459 goto free; 11460 11461 if (err > 0) { 11462 params.radar_required = true; 11463 if (need_handle_dfs_flag && 11464 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) { 11465 err = -EINVAL; 11466 goto free; 11467 } 11468 } 11469 11470 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX]) 11471 params.block_tx = true; 11472 11473 if ((wdev->iftype == NL80211_IFTYPE_AP || 11474 wdev->iftype == NL80211_IFTYPE_P2P_GO) && 11475 info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 11476 err = nl80211_parse_unsol_bcast_probe_resp( 11477 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 11478 ¶ms.unsol_bcast_probe_resp); 11479 if (err) 11480 goto free; 11481 } 11482 11483 params.link_id = link_id; 11484 err = rdev_channel_switch(rdev, dev, ¶ms); 11485 11486 free: 11487 kfree(params.beacon_after.mbssid_ies); 11488 kfree(params.beacon_csa.mbssid_ies); 11489 kfree(params.beacon_after.rnr_ies); 11490 kfree(params.beacon_csa.rnr_ies); 11491 kfree(csa_attrs); 11492 return err; 11493 } 11494 11495 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb, 11496 u32 seq, int flags, 11497 struct cfg80211_registered_device *rdev, 11498 struct wireless_dev *wdev, 11499 struct cfg80211_internal_bss *intbss) 11500 { 11501 struct cfg80211_bss *res = &intbss->pub; 11502 const struct cfg80211_bss_ies *ies; 11503 unsigned int link_id; 11504 void *hdr; 11505 struct nlattr *bss; 11506 11507 lockdep_assert_wiphy(wdev->wiphy); 11508 11509 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 11510 NL80211_CMD_NEW_SCAN_RESULTS); 11511 if (!hdr) 11512 return -1; 11513 11514 genl_dump_check_consistent(cb, hdr); 11515 11516 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation)) 11517 goto nla_put_failure; 11518 if (wdev->netdev && 11519 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex)) 11520 goto nla_put_failure; 11521 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 11522 NL80211_ATTR_PAD)) 11523 goto nla_put_failure; 11524 11525 bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS); 11526 if (!bss) 11527 goto nla_put_failure; 11528 if ((!is_zero_ether_addr(res->bssid) && 11529 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid))) 11530 goto nla_put_failure; 11531 11532 rcu_read_lock(); 11533 /* indicate whether we have probe response data or not */ 11534 if (rcu_access_pointer(res->proberesp_ies) && 11535 nla_put_flag(msg, NL80211_BSS_PRESP_DATA)) 11536 goto fail_unlock_rcu; 11537 11538 /* this pointer prefers to be pointed to probe response data 11539 * but is always valid 11540 */ 11541 ies = rcu_dereference(res->ies); 11542 if (ies) { 11543 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf, 11544 NL80211_BSS_PAD)) 11545 goto fail_unlock_rcu; 11546 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS, 11547 ies->len, ies->data)) 11548 goto fail_unlock_rcu; 11549 } 11550 11551 /* and this pointer is always (unless driver didn't know) beacon data */ 11552 ies = rcu_dereference(res->beacon_ies); 11553 if (ies && ies->from_beacon) { 11554 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf, 11555 NL80211_BSS_PAD)) 11556 goto fail_unlock_rcu; 11557 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES, 11558 ies->len, ies->data)) 11559 goto fail_unlock_rcu; 11560 } 11561 rcu_read_unlock(); 11562 11563 if (res->beacon_interval && 11564 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval)) 11565 goto nla_put_failure; 11566 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) || 11567 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) || 11568 nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET, 11569 res->channel->freq_offset) || 11570 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO, 11571 jiffies_to_msecs(jiffies - intbss->ts))) 11572 goto nla_put_failure; 11573 11574 if (intbss->parent_tsf && 11575 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF, 11576 intbss->parent_tsf, NL80211_BSS_PAD) || 11577 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN, 11578 intbss->parent_bssid))) 11579 goto nla_put_failure; 11580 11581 if (res->ts_boottime && 11582 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME, 11583 res->ts_boottime, NL80211_BSS_PAD)) 11584 goto nla_put_failure; 11585 11586 if (!nl80211_put_signal(msg, intbss->pub.chains, 11587 intbss->pub.chain_signal, 11588 NL80211_BSS_CHAIN_SIGNAL)) 11589 goto nla_put_failure; 11590 11591 if (intbss->bss_source != BSS_SOURCE_STA_PROFILE) { 11592 switch (rdev->wiphy.signal_type) { 11593 case CFG80211_SIGNAL_TYPE_MBM: 11594 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, 11595 res->signal)) 11596 goto nla_put_failure; 11597 break; 11598 case CFG80211_SIGNAL_TYPE_UNSPEC: 11599 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, 11600 res->signal)) 11601 goto nla_put_failure; 11602 break; 11603 default: 11604 break; 11605 } 11606 } 11607 11608 switch (wdev->iftype) { 11609 case NL80211_IFTYPE_P2P_CLIENT: 11610 case NL80211_IFTYPE_STATION: 11611 for_each_valid_link(wdev, link_id) { 11612 if (intbss == wdev->links[link_id].client.current_bss && 11613 (nla_put_u32(msg, NL80211_BSS_STATUS, 11614 NL80211_BSS_STATUS_ASSOCIATED) || 11615 (wdev->valid_links && 11616 (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID, 11617 link_id) || 11618 nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN, 11619 wdev->u.client.connected_addr))))) 11620 goto nla_put_failure; 11621 } 11622 break; 11623 case NL80211_IFTYPE_ADHOC: 11624 if (intbss == wdev->u.ibss.current_bss && 11625 nla_put_u32(msg, NL80211_BSS_STATUS, 11626 NL80211_BSS_STATUS_IBSS_JOINED)) 11627 goto nla_put_failure; 11628 break; 11629 default: 11630 break; 11631 } 11632 11633 if (nla_put_u32(msg, NL80211_BSS_USE_FOR, res->use_for)) 11634 goto nla_put_failure; 11635 11636 if (res->cannot_use_reasons && 11637 nla_put_u64_64bit(msg, NL80211_BSS_CANNOT_USE_REASONS, 11638 res->cannot_use_reasons, 11639 NL80211_BSS_PAD)) 11640 goto nla_put_failure; 11641 11642 nla_nest_end(msg, bss); 11643 11644 genlmsg_end(msg, hdr); 11645 return 0; 11646 11647 fail_unlock_rcu: 11648 rcu_read_unlock(); 11649 nla_put_failure: 11650 genlmsg_cancel(msg, hdr); 11651 return -EMSGSIZE; 11652 } 11653 11654 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb) 11655 { 11656 struct cfg80211_registered_device *rdev; 11657 struct cfg80211_internal_bss *scan; 11658 struct wireless_dev *wdev; 11659 struct nlattr **attrbuf; 11660 int start = cb->args[2], idx = 0; 11661 bool dump_include_use_data; 11662 int err; 11663 11664 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 11665 if (!attrbuf) 11666 return -ENOMEM; 11667 11668 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 11669 if (err) { 11670 kfree(attrbuf); 11671 return err; 11672 } 11673 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 11674 __acquire(&rdev->wiphy.mtx); 11675 11676 dump_include_use_data = 11677 attrbuf[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA]; 11678 kfree(attrbuf); 11679 11680 spin_lock_bh(&rdev->bss_lock); 11681 11682 /* 11683 * dump_scan will be called multiple times to break up the scan results 11684 * into multiple messages. It is unlikely that any more bss-es will be 11685 * expired after the first call, so only call only call this on the 11686 * first dump_scan invocation. 11687 */ 11688 if (start == 0) 11689 cfg80211_bss_expire(rdev); 11690 11691 cb->seq = rdev->bss_generation; 11692 11693 list_for_each_entry(scan, &rdev->bss_list, list) { 11694 if (++idx <= start) 11695 continue; 11696 if (!dump_include_use_data && 11697 !(scan->pub.use_for & NL80211_BSS_USE_FOR_NORMAL)) 11698 continue; 11699 if (nl80211_send_bss(skb, cb, 11700 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11701 rdev, wdev, scan) < 0) { 11702 idx--; 11703 break; 11704 } 11705 } 11706 11707 spin_unlock_bh(&rdev->bss_lock); 11708 11709 cb->args[2] = idx; 11710 wiphy_unlock(&rdev->wiphy); 11711 11712 return skb->len; 11713 } 11714 11715 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq, 11716 int flags, struct net_device *dev, 11717 bool allow_radio_stats, 11718 struct survey_info *survey) 11719 { 11720 void *hdr; 11721 struct nlattr *infoattr; 11722 11723 /* skip radio stats if userspace didn't request them */ 11724 if (!survey->channel && !allow_radio_stats) 11725 return 0; 11726 11727 hdr = nl80211hdr_put(msg, portid, seq, flags, 11728 NL80211_CMD_NEW_SURVEY_RESULTS); 11729 if (!hdr) 11730 return -ENOMEM; 11731 11732 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 11733 goto nla_put_failure; 11734 11735 infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO); 11736 if (!infoattr) 11737 goto nla_put_failure; 11738 11739 if (survey->channel && 11740 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY, 11741 survey->channel->center_freq)) 11742 goto nla_put_failure; 11743 11744 if (survey->channel && survey->channel->freq_offset && 11745 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET, 11746 survey->channel->freq_offset)) 11747 goto nla_put_failure; 11748 11749 if ((survey->filled & SURVEY_INFO_NOISE_DBM) && 11750 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise)) 11751 goto nla_put_failure; 11752 if ((survey->filled & SURVEY_INFO_IN_USE) && 11753 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE)) 11754 goto nla_put_failure; 11755 if ((survey->filled & SURVEY_INFO_TIME) && 11756 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME, 11757 survey->time, NL80211_SURVEY_INFO_PAD)) 11758 goto nla_put_failure; 11759 if ((survey->filled & SURVEY_INFO_TIME_BUSY) && 11760 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY, 11761 survey->time_busy, NL80211_SURVEY_INFO_PAD)) 11762 goto nla_put_failure; 11763 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) && 11764 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY, 11765 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD)) 11766 goto nla_put_failure; 11767 if ((survey->filled & SURVEY_INFO_TIME_RX) && 11768 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX, 11769 survey->time_rx, NL80211_SURVEY_INFO_PAD)) 11770 goto nla_put_failure; 11771 if ((survey->filled & SURVEY_INFO_TIME_TX) && 11772 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX, 11773 survey->time_tx, NL80211_SURVEY_INFO_PAD)) 11774 goto nla_put_failure; 11775 if ((survey->filled & SURVEY_INFO_TIME_SCAN) && 11776 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN, 11777 survey->time_scan, NL80211_SURVEY_INFO_PAD)) 11778 goto nla_put_failure; 11779 if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) && 11780 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX, 11781 survey->time_bss_rx, NL80211_SURVEY_INFO_PAD)) 11782 goto nla_put_failure; 11783 11784 nla_nest_end(msg, infoattr); 11785 11786 genlmsg_end(msg, hdr); 11787 return 0; 11788 11789 nla_put_failure: 11790 genlmsg_cancel(msg, hdr); 11791 return -EMSGSIZE; 11792 } 11793 11794 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb) 11795 { 11796 struct nlattr **attrbuf; 11797 struct survey_info survey; 11798 struct cfg80211_registered_device *rdev; 11799 struct wireless_dev *wdev; 11800 int survey_idx = cb->args[2]; 11801 int res; 11802 bool radio_stats; 11803 11804 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 11805 if (!attrbuf) 11806 return -ENOMEM; 11807 11808 res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 11809 if (res) { 11810 kfree(attrbuf); 11811 return res; 11812 } 11813 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 11814 __acquire(&rdev->wiphy.mtx); 11815 11816 /* prepare_wdev_dump parsed the attributes */ 11817 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS]; 11818 11819 if (!wdev->netdev) { 11820 res = -EINVAL; 11821 goto out_err; 11822 } 11823 11824 if (!rdev->ops->dump_survey) { 11825 res = -EOPNOTSUPP; 11826 goto out_err; 11827 } 11828 11829 while (1) { 11830 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey); 11831 if (res == -ENOENT) 11832 break; 11833 if (res) 11834 goto out_err; 11835 11836 /* don't send disabled channels, but do send non-channel data */ 11837 if (survey.channel && 11838 survey.channel->flags & IEEE80211_CHAN_DISABLED) { 11839 survey_idx++; 11840 continue; 11841 } 11842 11843 if (nl80211_send_survey(skb, 11844 NETLINK_CB(cb->skb).portid, 11845 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11846 wdev->netdev, radio_stats, &survey) < 0) 11847 goto out; 11848 survey_idx++; 11849 } 11850 11851 out: 11852 cb->args[2] = survey_idx; 11853 res = skb->len; 11854 out_err: 11855 kfree(attrbuf); 11856 wiphy_unlock(&rdev->wiphy); 11857 return res; 11858 } 11859 11860 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info) 11861 { 11862 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11863 struct net_device *dev = info->user_ptr[1]; 11864 struct ieee80211_channel *chan; 11865 const u8 *bssid, *ssid; 11866 int err, ssid_len; 11867 enum nl80211_auth_type auth_type; 11868 struct key_parse key; 11869 bool local_state_change; 11870 struct cfg80211_auth_request req = {}; 11871 u32 freq; 11872 11873 if (!info->attrs[NL80211_ATTR_MAC]) 11874 return -EINVAL; 11875 11876 if (!info->attrs[NL80211_ATTR_AUTH_TYPE]) 11877 return -EINVAL; 11878 11879 if (!info->attrs[NL80211_ATTR_SSID]) 11880 return -EINVAL; 11881 11882 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 11883 return -EINVAL; 11884 11885 err = nl80211_parse_key(info, &key); 11886 if (err) 11887 return err; 11888 11889 if (key.idx >= 0) { 11890 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP) 11891 return -EINVAL; 11892 if (!key.p.key || !key.p.key_len) 11893 return -EINVAL; 11894 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 || 11895 key.p.key_len != WLAN_KEY_LEN_WEP40) && 11896 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 || 11897 key.p.key_len != WLAN_KEY_LEN_WEP104)) 11898 return -EINVAL; 11899 if (key.idx > 3) 11900 return -EINVAL; 11901 } else { 11902 key.p.key_len = 0; 11903 key.p.key = NULL; 11904 } 11905 11906 if (key.idx >= 0) { 11907 int i; 11908 bool ok = false; 11909 11910 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) { 11911 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) { 11912 ok = true; 11913 break; 11914 } 11915 } 11916 if (!ok) 11917 return -EINVAL; 11918 } 11919 11920 if (!rdev->ops->auth) 11921 return -EOPNOTSUPP; 11922 11923 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11924 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11925 return -EOPNOTSUPP; 11926 11927 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11928 freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 11929 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 11930 freq += 11931 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 11932 11933 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 11934 if (!chan) 11935 return -EINVAL; 11936 11937 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11938 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11939 11940 if (info->attrs[NL80211_ATTR_IE]) { 11941 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11942 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11943 } 11944 11945 if (info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]) { 11946 req.supported_selectors = 11947 nla_data(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 11948 req.supported_selectors_len = 11949 nla_len(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 11950 } 11951 11952 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 11953 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE)) 11954 return -EINVAL; 11955 11956 if ((auth_type == NL80211_AUTHTYPE_SAE || 11957 auth_type == NL80211_AUTHTYPE_FILS_SK || 11958 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 11959 auth_type == NL80211_AUTHTYPE_FILS_PK) && 11960 !info->attrs[NL80211_ATTR_AUTH_DATA]) 11961 return -EINVAL; 11962 11963 if (info->attrs[NL80211_ATTR_AUTH_DATA]) { 11964 if (auth_type != NL80211_AUTHTYPE_SAE && 11965 auth_type != NL80211_AUTHTYPE_FILS_SK && 11966 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS && 11967 auth_type != NL80211_AUTHTYPE_FILS_PK) 11968 return -EINVAL; 11969 req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]); 11970 req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]); 11971 } 11972 11973 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11974 11975 /* 11976 * Since we no longer track auth state, ignore 11977 * requests to only change local state. 11978 */ 11979 if (local_state_change) 11980 return 0; 11981 11982 req.auth_type = auth_type; 11983 req.key = key.p.key; 11984 req.key_len = key.p.key_len; 11985 req.key_idx = key.idx; 11986 req.link_id = nl80211_link_id_or_invalid(info->attrs); 11987 if (req.link_id >= 0) { 11988 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 11989 return -EINVAL; 11990 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 11991 return -EINVAL; 11992 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 11993 if (!is_valid_ether_addr(req.ap_mld_addr)) 11994 return -EINVAL; 11995 } 11996 11997 req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, 11998 IEEE80211_BSS_TYPE_ESS, 11999 IEEE80211_PRIVACY_ANY); 12000 if (!req.bss) 12001 return -ENOENT; 12002 12003 err = cfg80211_mlme_auth(rdev, dev, &req); 12004 12005 cfg80211_put_bss(&rdev->wiphy, req.bss); 12006 12007 return err; 12008 } 12009 12010 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev, 12011 struct genl_info *info) 12012 { 12013 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12014 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set"); 12015 return -EINVAL; 12016 } 12017 12018 if (!rdev->ops->tx_control_port || 12019 !wiphy_ext_feature_isset(&rdev->wiphy, 12020 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 12021 return -EOPNOTSUPP; 12022 12023 return 0; 12024 } 12025 12026 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 12027 struct genl_info *info, 12028 struct cfg80211_crypto_settings *settings, 12029 int cipher_limit) 12030 { 12031 memset(settings, 0, sizeof(*settings)); 12032 12033 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT]; 12034 12035 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 12036 u16 proto; 12037 12038 proto = nla_get_u16( 12039 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 12040 settings->control_port_ethertype = cpu_to_be16(proto); 12041 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 12042 proto != ETH_P_PAE) 12043 return -EINVAL; 12044 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]) 12045 settings->control_port_no_encrypt = true; 12046 } else 12047 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE); 12048 12049 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 12050 int r = validate_pae_over_nl80211(rdev, info); 12051 12052 if (r < 0) 12053 return r; 12054 12055 settings->control_port_over_nl80211 = true; 12056 12057 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH]) 12058 settings->control_port_no_preauth = true; 12059 } 12060 12061 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) { 12062 void *data; 12063 int len, i; 12064 12065 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 12066 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 12067 settings->n_ciphers_pairwise = len / sizeof(u32); 12068 12069 if (len % sizeof(u32)) 12070 return -EINVAL; 12071 12072 if (settings->n_ciphers_pairwise > cipher_limit) 12073 return -EINVAL; 12074 12075 memcpy(settings->ciphers_pairwise, data, len); 12076 12077 for (i = 0; i < settings->n_ciphers_pairwise; i++) 12078 if (!cfg80211_supported_cipher_suite( 12079 &rdev->wiphy, 12080 settings->ciphers_pairwise[i])) 12081 return -EINVAL; 12082 } 12083 12084 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) { 12085 settings->cipher_group = 12086 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]); 12087 if (!cfg80211_supported_cipher_suite(&rdev->wiphy, 12088 settings->cipher_group)) 12089 return -EINVAL; 12090 } 12091 12092 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) 12093 settings->wpa_versions = 12094 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]); 12095 12096 if (info->attrs[NL80211_ATTR_AKM_SUITES]) { 12097 void *data; 12098 int len; 12099 12100 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]); 12101 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]); 12102 settings->n_akm_suites = len / sizeof(u32); 12103 12104 if (len % sizeof(u32)) 12105 return -EINVAL; 12106 12107 if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites) 12108 return -EINVAL; 12109 12110 memcpy(settings->akm_suites, data, len); 12111 } 12112 12113 if (info->attrs[NL80211_ATTR_PMK]) { 12114 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN) 12115 return -EINVAL; 12116 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12117 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) && 12118 !wiphy_ext_feature_isset(&rdev->wiphy, 12119 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK)) 12120 return -EINVAL; 12121 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]); 12122 } 12123 12124 if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) { 12125 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12126 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 12127 !wiphy_ext_feature_isset(&rdev->wiphy, 12128 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP)) 12129 return -EINVAL; 12130 settings->sae_pwd = 12131 nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 12132 settings->sae_pwd_len = 12133 nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 12134 } 12135 12136 settings->sae_pwe = 12137 nla_get_u8_default(info->attrs[NL80211_ATTR_SAE_PWE], 12138 NL80211_SAE_PWE_UNSPECIFIED); 12139 12140 return 0; 12141 } 12142 12143 static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev, 12144 const u8 *ssid, int ssid_len, 12145 struct nlattr **attrs, 12146 int assoc_link_id, int link_id) 12147 { 12148 struct ieee80211_channel *chan; 12149 struct cfg80211_bss *bss; 12150 const u8 *bssid; 12151 u32 freq, use_for = 0; 12152 12153 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ]) 12154 return ERR_PTR(-EINVAL); 12155 12156 bssid = nla_data(attrs[NL80211_ATTR_MAC]); 12157 12158 freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ])); 12159 if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 12160 freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 12161 12162 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 12163 if (!chan) 12164 return ERR_PTR(-EINVAL); 12165 12166 if (assoc_link_id >= 0) 12167 use_for = NL80211_BSS_USE_FOR_MLD_LINK; 12168 if (assoc_link_id == link_id) 12169 use_for |= NL80211_BSS_USE_FOR_NORMAL; 12170 12171 bss = __cfg80211_get_bss(&rdev->wiphy, chan, bssid, 12172 ssid, ssid_len, 12173 IEEE80211_BSS_TYPE_ESS, 12174 IEEE80211_PRIVACY_ANY, 12175 use_for); 12176 if (!bss) 12177 return ERR_PTR(-ENOENT); 12178 12179 return bss; 12180 } 12181 12182 static int nl80211_process_links(struct cfg80211_registered_device *rdev, 12183 struct cfg80211_assoc_link *links, 12184 int assoc_link_id, 12185 const u8 *ssid, int ssid_len, 12186 struct genl_info *info) 12187 { 12188 unsigned int attrsize = NUM_NL80211_ATTR * sizeof(struct nlattr *); 12189 struct nlattr **attrs __free(kfree) = kzalloc(attrsize, GFP_KERNEL); 12190 struct nlattr *link; 12191 unsigned int link_id; 12192 int rem, err; 12193 12194 if (!attrs) 12195 return -ENOMEM; 12196 12197 nla_for_each_nested(link, info->attrs[NL80211_ATTR_MLO_LINKS], rem) { 12198 memset(attrs, 0, attrsize); 12199 12200 nla_parse_nested(attrs, NL80211_ATTR_MAX, link, NULL, NULL); 12201 12202 if (!attrs[NL80211_ATTR_MLO_LINK_ID]) { 12203 NL_SET_BAD_ATTR(info->extack, link); 12204 return -EINVAL; 12205 } 12206 12207 link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]); 12208 /* cannot use the same link ID again */ 12209 if (links[link_id].bss) { 12210 NL_SET_BAD_ATTR(info->extack, link); 12211 return -EINVAL; 12212 } 12213 links[link_id].bss = 12214 nl80211_assoc_bss(rdev, ssid, ssid_len, attrs, 12215 assoc_link_id, link_id); 12216 if (IS_ERR(links[link_id].bss)) { 12217 err = PTR_ERR(links[link_id].bss); 12218 links[link_id].bss = NULL; 12219 NL_SET_ERR_MSG_ATTR(info->extack, link, 12220 "Error fetching BSS for link"); 12221 return err; 12222 } 12223 12224 if (attrs[NL80211_ATTR_IE]) { 12225 links[link_id].elems = nla_data(attrs[NL80211_ATTR_IE]); 12226 links[link_id].elems_len = 12227 nla_len(attrs[NL80211_ATTR_IE]); 12228 12229 if (cfg80211_find_elem(WLAN_EID_FRAGMENT, 12230 links[link_id].elems, 12231 links[link_id].elems_len)) { 12232 NL_SET_ERR_MSG_ATTR(info->extack, 12233 attrs[NL80211_ATTR_IE], 12234 "cannot deal with fragmentation"); 12235 return -EINVAL; 12236 } 12237 12238 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 12239 links[link_id].elems, 12240 links[link_id].elems_len)) { 12241 NL_SET_ERR_MSG_ATTR(info->extack, 12242 attrs[NL80211_ATTR_IE], 12243 "cannot deal with non-inheritance"); 12244 return -EINVAL; 12245 } 12246 } 12247 } 12248 12249 return 0; 12250 } 12251 12252 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info) 12253 { 12254 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12255 struct net_device *dev = info->user_ptr[1]; 12256 struct cfg80211_assoc_request req = {}; 12257 const u8 *ap_addr, *ssid; 12258 unsigned int link_id; 12259 int err, ssid_len; 12260 12261 if (dev->ieee80211_ptr->conn_owner_nlportid && 12262 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12263 return -EPERM; 12264 12265 if (!info->attrs[NL80211_ATTR_SSID]) 12266 return -EINVAL; 12267 12268 if (!rdev->ops->assoc) 12269 return -EOPNOTSUPP; 12270 12271 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12272 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12273 return -EOPNOTSUPP; 12274 12275 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12276 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12277 12278 if (info->attrs[NL80211_ATTR_IE]) { 12279 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12280 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12281 12282 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 12283 req.ie, req.ie_len)) { 12284 NL_SET_ERR_MSG_ATTR(info->extack, 12285 info->attrs[NL80211_ATTR_IE], 12286 "non-inheritance makes no sense"); 12287 return -EINVAL; 12288 } 12289 } 12290 12291 if (info->attrs[NL80211_ATTR_USE_MFP]) { 12292 enum nl80211_mfp mfp = 12293 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 12294 if (mfp == NL80211_MFP_REQUIRED) 12295 req.use_mfp = true; 12296 else if (mfp != NL80211_MFP_NO) 12297 return -EINVAL; 12298 } 12299 12300 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 12301 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 12302 12303 if (info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]) { 12304 req.supported_selectors = 12305 nla_data(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 12306 req.supported_selectors_len = 12307 nla_len(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 12308 } 12309 12310 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 12311 req.flags |= ASSOC_REQ_DISABLE_HT; 12312 12313 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12314 memcpy(&req.ht_capa_mask, 12315 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 12316 sizeof(req.ht_capa_mask)); 12317 12318 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 12319 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12320 return -EINVAL; 12321 memcpy(&req.ht_capa, 12322 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 12323 sizeof(req.ht_capa)); 12324 } 12325 12326 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 12327 req.flags |= ASSOC_REQ_DISABLE_VHT; 12328 12329 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 12330 req.flags |= ASSOC_REQ_DISABLE_HE; 12331 12332 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 12333 req.flags |= ASSOC_REQ_DISABLE_EHT; 12334 12335 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 12336 memcpy(&req.vht_capa_mask, 12337 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 12338 sizeof(req.vht_capa_mask)); 12339 12340 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 12341 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 12342 return -EINVAL; 12343 memcpy(&req.vht_capa, 12344 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 12345 sizeof(req.vht_capa)); 12346 } 12347 12348 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 12349 if (!((rdev->wiphy.features & 12350 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 12351 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 12352 !wiphy_ext_feature_isset(&rdev->wiphy, 12353 NL80211_EXT_FEATURE_RRM)) 12354 return -EINVAL; 12355 req.flags |= ASSOC_REQ_USE_RRM; 12356 } 12357 12358 if (info->attrs[NL80211_ATTR_FILS_KEK]) { 12359 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 12360 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 12361 if (!info->attrs[NL80211_ATTR_FILS_NONCES]) 12362 return -EINVAL; 12363 req.fils_nonces = 12364 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 12365 } 12366 12367 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) { 12368 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 12369 return -EINVAL; 12370 memcpy(&req.s1g_capa_mask, 12371 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]), 12372 sizeof(req.s1g_capa_mask)); 12373 } 12374 12375 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) { 12376 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) 12377 return -EINVAL; 12378 memcpy(&req.s1g_capa, 12379 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]), 12380 sizeof(req.s1g_capa)); 12381 } 12382 12383 if (nla_get_flag(info->attrs[NL80211_ATTR_ASSOC_SPP_AMSDU])) { 12384 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12385 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT)) { 12386 GENL_SET_ERR_MSG(info, "SPP A-MSDUs not supported"); 12387 return -EINVAL; 12388 } 12389 req.flags |= ASSOC_REQ_SPP_AMSDU; 12390 } 12391 12392 req.link_id = nl80211_link_id_or_invalid(info->attrs); 12393 12394 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 12395 if (req.link_id < 0) 12396 return -EINVAL; 12397 12398 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 12399 return -EINVAL; 12400 12401 if (info->attrs[NL80211_ATTR_MAC] || 12402 info->attrs[NL80211_ATTR_WIPHY_FREQ] || 12403 !info->attrs[NL80211_ATTR_MLD_ADDR]) 12404 return -EINVAL; 12405 12406 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 12407 ap_addr = req.ap_mld_addr; 12408 12409 err = nl80211_process_links(rdev, req.links, req.link_id, 12410 ssid, ssid_len, info); 12411 if (err) 12412 goto free; 12413 12414 if (!req.links[req.link_id].bss) { 12415 err = -EINVAL; 12416 goto free; 12417 } 12418 12419 if (req.links[req.link_id].elems_len) { 12420 GENL_SET_ERR_MSG(info, 12421 "cannot have per-link elems on assoc link"); 12422 err = -EINVAL; 12423 goto free; 12424 } 12425 12426 if (info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]) 12427 req.ext_mld_capa_ops = 12428 nla_get_u16(info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]); 12429 } else { 12430 if (req.link_id >= 0) 12431 return -EINVAL; 12432 12433 req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs, 12434 -1, -1); 12435 if (IS_ERR(req.bss)) 12436 return PTR_ERR(req.bss); 12437 ap_addr = req.bss->bssid; 12438 12439 if (info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]) 12440 return -EINVAL; 12441 } 12442 12443 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1); 12444 if (!err) { 12445 struct nlattr *link; 12446 int rem = 0; 12447 12448 err = cfg80211_mlme_assoc(rdev, dev, &req, 12449 info->extack); 12450 12451 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12452 dev->ieee80211_ptr->conn_owner_nlportid = 12453 info->snd_portid; 12454 memcpy(dev->ieee80211_ptr->disconnect_bssid, 12455 ap_addr, ETH_ALEN); 12456 } 12457 12458 /* Report error from first problematic link */ 12459 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 12460 nla_for_each_nested(link, 12461 info->attrs[NL80211_ATTR_MLO_LINKS], 12462 rem) { 12463 struct nlattr *link_id_attr = 12464 nla_find_nested(link, NL80211_ATTR_MLO_LINK_ID); 12465 12466 if (!link_id_attr) 12467 continue; 12468 12469 link_id = nla_get_u8(link_id_attr); 12470 12471 if (link_id == req.link_id) 12472 continue; 12473 12474 if (!req.links[link_id].error || 12475 WARN_ON(req.links[link_id].error > 0)) 12476 continue; 12477 12478 WARN_ON(err >= 0); 12479 12480 NL_SET_BAD_ATTR(info->extack, link); 12481 err = req.links[link_id].error; 12482 break; 12483 } 12484 } 12485 } 12486 12487 free: 12488 for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++) 12489 cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss); 12490 cfg80211_put_bss(&rdev->wiphy, req.bss); 12491 12492 return err; 12493 } 12494 12495 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info) 12496 { 12497 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12498 struct net_device *dev = info->user_ptr[1]; 12499 const u8 *ie = NULL, *bssid; 12500 int ie_len = 0; 12501 u16 reason_code; 12502 bool local_state_change; 12503 12504 if (dev->ieee80211_ptr->conn_owner_nlportid && 12505 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12506 return -EPERM; 12507 12508 if (!info->attrs[NL80211_ATTR_MAC]) 12509 return -EINVAL; 12510 12511 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 12512 return -EINVAL; 12513 12514 if (!rdev->ops->deauth) 12515 return -EOPNOTSUPP; 12516 12517 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12518 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12519 return -EOPNOTSUPP; 12520 12521 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12522 12523 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 12524 if (reason_code == 0) { 12525 /* Reason Code 0 is reserved */ 12526 return -EINVAL; 12527 } 12528 12529 if (info->attrs[NL80211_ATTR_IE]) { 12530 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12531 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12532 } 12533 12534 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 12535 12536 return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code, 12537 local_state_change); 12538 } 12539 12540 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info) 12541 { 12542 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12543 struct net_device *dev = info->user_ptr[1]; 12544 const u8 *ie = NULL, *bssid; 12545 int ie_len = 0; 12546 u16 reason_code; 12547 bool local_state_change; 12548 12549 if (dev->ieee80211_ptr->conn_owner_nlportid && 12550 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12551 return -EPERM; 12552 12553 if (!info->attrs[NL80211_ATTR_MAC]) 12554 return -EINVAL; 12555 12556 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 12557 return -EINVAL; 12558 12559 if (!rdev->ops->disassoc) 12560 return -EOPNOTSUPP; 12561 12562 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12563 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12564 return -EOPNOTSUPP; 12565 12566 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12567 12568 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 12569 if (reason_code == 0) { 12570 /* Reason Code 0 is reserved */ 12571 return -EINVAL; 12572 } 12573 12574 if (info->attrs[NL80211_ATTR_IE]) { 12575 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12576 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12577 } 12578 12579 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 12580 12581 return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code, 12582 local_state_change); 12583 } 12584 12585 static bool 12586 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev, 12587 int mcast_rate[NUM_NL80211_BANDS], 12588 int rateval) 12589 { 12590 struct wiphy *wiphy = &rdev->wiphy; 12591 bool found = false; 12592 int band, i; 12593 12594 for (band = 0; band < NUM_NL80211_BANDS; band++) { 12595 struct ieee80211_supported_band *sband; 12596 12597 sband = wiphy->bands[band]; 12598 if (!sband) 12599 continue; 12600 12601 for (i = 0; i < sband->n_bitrates; i++) { 12602 if (sband->bitrates[i].bitrate == rateval) { 12603 mcast_rate[band] = i + 1; 12604 found = true; 12605 break; 12606 } 12607 } 12608 } 12609 12610 return found; 12611 } 12612 12613 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info) 12614 { 12615 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12616 struct net_device *dev = info->user_ptr[1]; 12617 struct cfg80211_ibss_params ibss; 12618 struct wiphy *wiphy; 12619 struct cfg80211_cached_keys *connkeys = NULL; 12620 int err; 12621 12622 memset(&ibss, 0, sizeof(ibss)); 12623 12624 if (!info->attrs[NL80211_ATTR_SSID] || 12625 !nla_len(info->attrs[NL80211_ATTR_SSID])) 12626 return -EINVAL; 12627 12628 ibss.beacon_interval = 100; 12629 12630 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) 12631 ibss.beacon_interval = 12632 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 12633 12634 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC, 12635 ibss.beacon_interval); 12636 if (err) 12637 return err; 12638 12639 if (!rdev->ops->join_ibss) 12640 return -EOPNOTSUPP; 12641 12642 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 12643 return -EOPNOTSUPP; 12644 12645 wiphy = &rdev->wiphy; 12646 12647 if (info->attrs[NL80211_ATTR_MAC]) { 12648 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12649 12650 if (!is_valid_ether_addr(ibss.bssid)) 12651 return -EINVAL; 12652 } 12653 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12654 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12655 12656 if (info->attrs[NL80211_ATTR_IE]) { 12657 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12658 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12659 } 12660 12661 err = nl80211_parse_chandef(rdev, info, &ibss.chandef); 12662 if (err) 12663 return err; 12664 12665 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef, 12666 NL80211_IFTYPE_ADHOC)) 12667 return -EINVAL; 12668 12669 switch (ibss.chandef.width) { 12670 case NL80211_CHAN_WIDTH_5: 12671 case NL80211_CHAN_WIDTH_10: 12672 case NL80211_CHAN_WIDTH_20_NOHT: 12673 break; 12674 case NL80211_CHAN_WIDTH_20: 12675 case NL80211_CHAN_WIDTH_40: 12676 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 12677 return -EINVAL; 12678 break; 12679 case NL80211_CHAN_WIDTH_80: 12680 case NL80211_CHAN_WIDTH_80P80: 12681 case NL80211_CHAN_WIDTH_160: 12682 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 12683 return -EINVAL; 12684 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12685 NL80211_EXT_FEATURE_VHT_IBSS)) 12686 return -EINVAL; 12687 break; 12688 case NL80211_CHAN_WIDTH_320: 12689 return -EINVAL; 12690 default: 12691 return -EINVAL; 12692 } 12693 12694 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED]; 12695 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 12696 12697 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 12698 u8 *rates = 12699 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 12700 int n_rates = 12701 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 12702 struct ieee80211_supported_band *sband = 12703 wiphy->bands[ibss.chandef.chan->band]; 12704 12705 err = ieee80211_get_ratemask(sband, rates, n_rates, 12706 &ibss.basic_rates); 12707 if (err) 12708 return err; 12709 } 12710 12711 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12712 memcpy(&ibss.ht_capa_mask, 12713 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 12714 sizeof(ibss.ht_capa_mask)); 12715 12716 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 12717 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12718 return -EINVAL; 12719 memcpy(&ibss.ht_capa, 12720 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 12721 sizeof(ibss.ht_capa)); 12722 } 12723 12724 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 12725 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate, 12726 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 12727 return -EINVAL; 12728 12729 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) { 12730 bool no_ht = false; 12731 12732 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht); 12733 if (IS_ERR(connkeys)) 12734 return PTR_ERR(connkeys); 12735 12736 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) && 12737 no_ht) { 12738 kfree_sensitive(connkeys); 12739 return -EINVAL; 12740 } 12741 } 12742 12743 ibss.control_port = 12744 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]); 12745 12746 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 12747 int r = validate_pae_over_nl80211(rdev, info); 12748 12749 if (r < 0) { 12750 kfree_sensitive(connkeys); 12751 return r; 12752 } 12753 12754 ibss.control_port_over_nl80211 = true; 12755 } 12756 12757 ibss.userspace_handles_dfs = 12758 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 12759 12760 err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys); 12761 if (err) 12762 kfree_sensitive(connkeys); 12763 else if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 12764 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 12765 12766 return err; 12767 } 12768 12769 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info) 12770 { 12771 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12772 struct net_device *dev = info->user_ptr[1]; 12773 12774 if (!rdev->ops->leave_ibss) 12775 return -EOPNOTSUPP; 12776 12777 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 12778 return -EOPNOTSUPP; 12779 12780 return cfg80211_leave_ibss(rdev, dev, false); 12781 } 12782 12783 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info) 12784 { 12785 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12786 struct net_device *dev = info->user_ptr[1]; 12787 int mcast_rate[NUM_NL80211_BANDS]; 12788 u32 nla_rate; 12789 12790 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC && 12791 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 12792 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB) 12793 return -EOPNOTSUPP; 12794 12795 if (!rdev->ops->set_mcast_rate) 12796 return -EOPNOTSUPP; 12797 12798 memset(mcast_rate, 0, sizeof(mcast_rate)); 12799 12800 if (!info->attrs[NL80211_ATTR_MCAST_RATE]) 12801 return -EINVAL; 12802 12803 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]); 12804 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate)) 12805 return -EINVAL; 12806 12807 return rdev_set_mcast_rate(rdev, dev, mcast_rate); 12808 } 12809 12810 static struct sk_buff * 12811 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev, 12812 struct wireless_dev *wdev, int approxlen, 12813 u32 portid, u32 seq, enum nl80211_commands cmd, 12814 enum nl80211_attrs attr, 12815 const struct nl80211_vendor_cmd_info *info, 12816 gfp_t gfp) 12817 { 12818 struct sk_buff *skb; 12819 void *hdr; 12820 struct nlattr *data; 12821 12822 skb = nlmsg_new(approxlen + 100, gfp); 12823 if (!skb) 12824 return NULL; 12825 12826 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd); 12827 if (!hdr) { 12828 kfree_skb(skb); 12829 return NULL; 12830 } 12831 12832 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 12833 goto nla_put_failure; 12834 12835 if (info) { 12836 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID, 12837 info->vendor_id)) 12838 goto nla_put_failure; 12839 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD, 12840 info->subcmd)) 12841 goto nla_put_failure; 12842 } 12843 12844 if (wdev) { 12845 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 12846 wdev_id(wdev), NL80211_ATTR_PAD)) 12847 goto nla_put_failure; 12848 if (wdev->netdev && 12849 nla_put_u32(skb, NL80211_ATTR_IFINDEX, 12850 wdev->netdev->ifindex)) 12851 goto nla_put_failure; 12852 } 12853 12854 data = nla_nest_start_noflag(skb, attr); 12855 if (!data) 12856 goto nla_put_failure; 12857 12858 ((void **)skb->cb)[0] = rdev; 12859 ((void **)skb->cb)[1] = hdr; 12860 ((void **)skb->cb)[2] = data; 12861 12862 return skb; 12863 12864 nla_put_failure: 12865 kfree_skb(skb); 12866 return NULL; 12867 } 12868 12869 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy, 12870 struct wireless_dev *wdev, 12871 enum nl80211_commands cmd, 12872 enum nl80211_attrs attr, 12873 unsigned int portid, 12874 int vendor_event_idx, 12875 int approxlen, gfp_t gfp) 12876 { 12877 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 12878 const struct nl80211_vendor_cmd_info *info; 12879 12880 switch (cmd) { 12881 case NL80211_CMD_TESTMODE: 12882 if (WARN_ON(vendor_event_idx != -1)) 12883 return NULL; 12884 info = NULL; 12885 break; 12886 case NL80211_CMD_VENDOR: 12887 if (WARN_ON(vendor_event_idx < 0 || 12888 vendor_event_idx >= wiphy->n_vendor_events)) 12889 return NULL; 12890 info = &wiphy->vendor_events[vendor_event_idx]; 12891 break; 12892 default: 12893 WARN_ON(1); 12894 return NULL; 12895 } 12896 12897 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0, 12898 cmd, attr, info, gfp); 12899 } 12900 EXPORT_SYMBOL(__cfg80211_alloc_event_skb); 12901 12902 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp) 12903 { 12904 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 12905 void *hdr = ((void **)skb->cb)[1]; 12906 struct nlmsghdr *nlhdr = nlmsg_hdr(skb); 12907 struct nlattr *data = ((void **)skb->cb)[2]; 12908 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE; 12909 12910 /* clear CB data for netlink core to own from now on */ 12911 memset(skb->cb, 0, sizeof(skb->cb)); 12912 12913 nla_nest_end(skb, data); 12914 genlmsg_end(skb, hdr); 12915 12916 if (nlhdr->nlmsg_pid) { 12917 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb, 12918 nlhdr->nlmsg_pid); 12919 } else { 12920 if (data->nla_type == NL80211_ATTR_VENDOR_DATA) 12921 mcgrp = NL80211_MCGRP_VENDOR; 12922 12923 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 12924 skb, 0, mcgrp, gfp); 12925 } 12926 } 12927 EXPORT_SYMBOL(__cfg80211_send_event_skb); 12928 12929 #ifdef CONFIG_NL80211_TESTMODE 12930 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info) 12931 { 12932 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12933 struct wireless_dev *wdev; 12934 int err; 12935 12936 lockdep_assert_held(&rdev->wiphy.mtx); 12937 12938 wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 12939 info->attrs); 12940 12941 if (!rdev->ops->testmode_cmd) 12942 return -EOPNOTSUPP; 12943 12944 if (IS_ERR(wdev)) { 12945 err = PTR_ERR(wdev); 12946 if (err != -EINVAL) 12947 return err; 12948 wdev = NULL; 12949 } else if (wdev->wiphy != &rdev->wiphy) { 12950 return -EINVAL; 12951 } 12952 12953 if (!info->attrs[NL80211_ATTR_TESTDATA]) 12954 return -EINVAL; 12955 12956 rdev->cur_cmd_info = info; 12957 err = rdev_testmode_cmd(rdev, wdev, 12958 nla_data(info->attrs[NL80211_ATTR_TESTDATA]), 12959 nla_len(info->attrs[NL80211_ATTR_TESTDATA])); 12960 rdev->cur_cmd_info = NULL; 12961 12962 return err; 12963 } 12964 12965 static int nl80211_testmode_dump(struct sk_buff *skb, 12966 struct netlink_callback *cb) 12967 { 12968 struct cfg80211_registered_device *rdev; 12969 struct nlattr **attrbuf = NULL; 12970 int err; 12971 long phy_idx; 12972 void *data = NULL; 12973 int data_len = 0; 12974 12975 rtnl_lock(); 12976 12977 if (cb->args[0]) { 12978 /* 12979 * 0 is a valid index, but not valid for args[0], 12980 * so we need to offset by 1. 12981 */ 12982 phy_idx = cb->args[0] - 1; 12983 12984 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx); 12985 if (!rdev) { 12986 err = -ENOENT; 12987 goto out_err; 12988 } 12989 } else { 12990 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 12991 GFP_KERNEL); 12992 if (!attrbuf) { 12993 err = -ENOMEM; 12994 goto out_err; 12995 } 12996 12997 err = nlmsg_parse_deprecated(cb->nlh, 12998 GENL_HDRLEN + nl80211_fam.hdrsize, 12999 attrbuf, nl80211_fam.maxattr, 13000 nl80211_policy, NULL); 13001 if (err) 13002 goto out_err; 13003 13004 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 13005 if (IS_ERR(rdev)) { 13006 err = PTR_ERR(rdev); 13007 goto out_err; 13008 } 13009 phy_idx = rdev->wiphy_idx; 13010 13011 if (attrbuf[NL80211_ATTR_TESTDATA]) 13012 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA]; 13013 } 13014 13015 if (cb->args[1]) { 13016 data = nla_data((void *)cb->args[1]); 13017 data_len = nla_len((void *)cb->args[1]); 13018 } 13019 13020 if (!rdev->ops->testmode_dump) { 13021 err = -EOPNOTSUPP; 13022 goto out_err; 13023 } 13024 13025 while (1) { 13026 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 13027 cb->nlh->nlmsg_seq, NLM_F_MULTI, 13028 NL80211_CMD_TESTMODE); 13029 struct nlattr *tmdata; 13030 13031 if (!hdr) 13032 break; 13033 13034 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) { 13035 genlmsg_cancel(skb, hdr); 13036 break; 13037 } 13038 13039 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA); 13040 if (!tmdata) { 13041 genlmsg_cancel(skb, hdr); 13042 break; 13043 } 13044 err = rdev_testmode_dump(rdev, skb, cb, data, data_len); 13045 nla_nest_end(skb, tmdata); 13046 13047 if (err == -ENOBUFS || err == -ENOENT) { 13048 genlmsg_cancel(skb, hdr); 13049 break; 13050 } else if (err) { 13051 genlmsg_cancel(skb, hdr); 13052 goto out_err; 13053 } 13054 13055 genlmsg_end(skb, hdr); 13056 } 13057 13058 err = skb->len; 13059 /* see above */ 13060 cb->args[0] = phy_idx + 1; 13061 out_err: 13062 kfree(attrbuf); 13063 rtnl_unlock(); 13064 return err; 13065 } 13066 #endif 13067 13068 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info) 13069 { 13070 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13071 struct net_device *dev = info->user_ptr[1]; 13072 struct cfg80211_connect_params connect; 13073 struct wiphy *wiphy; 13074 struct cfg80211_cached_keys *connkeys = NULL; 13075 u32 freq = 0; 13076 int err; 13077 13078 memset(&connect, 0, sizeof(connect)); 13079 13080 if (!info->attrs[NL80211_ATTR_SSID] || 13081 !nla_len(info->attrs[NL80211_ATTR_SSID])) 13082 return -EINVAL; 13083 13084 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 13085 connect.auth_type = 13086 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 13087 if (!nl80211_valid_auth_type(rdev, connect.auth_type, 13088 NL80211_CMD_CONNECT)) 13089 return -EINVAL; 13090 } else 13091 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 13092 13093 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY]; 13094 13095 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] && 13096 !wiphy_ext_feature_isset(&rdev->wiphy, 13097 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 13098 return -EINVAL; 13099 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS]; 13100 13101 err = nl80211_crypto_settings(rdev, info, &connect.crypto, 13102 NL80211_MAX_NR_CIPHER_SUITES); 13103 if (err) 13104 return err; 13105 13106 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13107 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 13108 return -EOPNOTSUPP; 13109 13110 wiphy = &rdev->wiphy; 13111 13112 connect.bg_scan_period = -1; 13113 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] && 13114 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) { 13115 connect.bg_scan_period = 13116 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]); 13117 } 13118 13119 if (info->attrs[NL80211_ATTR_MAC]) 13120 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 13121 else if (info->attrs[NL80211_ATTR_MAC_HINT]) 13122 connect.bssid_hint = 13123 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]); 13124 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 13125 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 13126 13127 if (info->attrs[NL80211_ATTR_IE]) { 13128 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 13129 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 13130 } 13131 13132 if (info->attrs[NL80211_ATTR_USE_MFP]) { 13133 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 13134 if (connect.mfp == NL80211_MFP_OPTIONAL && 13135 !wiphy_ext_feature_isset(&rdev->wiphy, 13136 NL80211_EXT_FEATURE_MFP_OPTIONAL)) 13137 return -EOPNOTSUPP; 13138 } else { 13139 connect.mfp = NL80211_MFP_NO; 13140 } 13141 13142 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 13143 connect.prev_bssid = 13144 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 13145 13146 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) 13147 freq = MHZ_TO_KHZ(nla_get_u32( 13148 info->attrs[NL80211_ATTR_WIPHY_FREQ])); 13149 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 13150 freq += 13151 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 13152 13153 if (freq) { 13154 connect.channel = nl80211_get_valid_chan(wiphy, freq); 13155 if (!connect.channel) 13156 return -EINVAL; 13157 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) { 13158 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]); 13159 freq = MHZ_TO_KHZ(freq); 13160 connect.channel_hint = nl80211_get_valid_chan(wiphy, freq); 13161 if (!connect.channel_hint) 13162 return -EINVAL; 13163 } 13164 13165 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 13166 connect.edmg.channels = 13167 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 13168 13169 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 13170 connect.edmg.bw_config = 13171 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 13172 } 13173 13174 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) { 13175 connkeys = nl80211_parse_connkeys(rdev, info, NULL); 13176 if (IS_ERR(connkeys)) 13177 return PTR_ERR(connkeys); 13178 } 13179 13180 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 13181 connect.flags |= ASSOC_REQ_DISABLE_HT; 13182 13183 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 13184 memcpy(&connect.ht_capa_mask, 13185 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 13186 sizeof(connect.ht_capa_mask)); 13187 13188 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 13189 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) { 13190 kfree_sensitive(connkeys); 13191 return -EINVAL; 13192 } 13193 memcpy(&connect.ht_capa, 13194 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 13195 sizeof(connect.ht_capa)); 13196 } 13197 13198 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 13199 connect.flags |= ASSOC_REQ_DISABLE_VHT; 13200 13201 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 13202 connect.flags |= ASSOC_REQ_DISABLE_HE; 13203 13204 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 13205 connect.flags |= ASSOC_REQ_DISABLE_EHT; 13206 13207 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 13208 memcpy(&connect.vht_capa_mask, 13209 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 13210 sizeof(connect.vht_capa_mask)); 13211 13212 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 13213 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) { 13214 kfree_sensitive(connkeys); 13215 return -EINVAL; 13216 } 13217 memcpy(&connect.vht_capa, 13218 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 13219 sizeof(connect.vht_capa)); 13220 } 13221 13222 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 13223 if (!((rdev->wiphy.features & 13224 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 13225 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 13226 !wiphy_ext_feature_isset(&rdev->wiphy, 13227 NL80211_EXT_FEATURE_RRM)) { 13228 kfree_sensitive(connkeys); 13229 return -EINVAL; 13230 } 13231 connect.flags |= ASSOC_REQ_USE_RRM; 13232 } 13233 13234 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 13235 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 13236 kfree_sensitive(connkeys); 13237 return -EOPNOTSUPP; 13238 } 13239 13240 if (info->attrs[NL80211_ATTR_BSS_SELECT]) { 13241 /* bss selection makes no sense if bssid is set */ 13242 if (connect.bssid) { 13243 kfree_sensitive(connkeys); 13244 return -EINVAL; 13245 } 13246 13247 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT], 13248 wiphy, &connect.bss_select); 13249 if (err) { 13250 kfree_sensitive(connkeys); 13251 return err; 13252 } 13253 } 13254 13255 if (wiphy_ext_feature_isset(&rdev->wiphy, 13256 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 13257 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 13258 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 13259 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 13260 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13261 connect.fils_erp_username = 13262 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13263 connect.fils_erp_username_len = 13264 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13265 connect.fils_erp_realm = 13266 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13267 connect.fils_erp_realm_len = 13268 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13269 connect.fils_erp_next_seq_num = 13270 nla_get_u16( 13271 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 13272 connect.fils_erp_rrk = 13273 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13274 connect.fils_erp_rrk_len = 13275 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13276 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 13277 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 13278 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 13279 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13280 kfree_sensitive(connkeys); 13281 return -EINVAL; 13282 } 13283 13284 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) { 13285 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 13286 kfree_sensitive(connkeys); 13287 GENL_SET_ERR_MSG(info, 13288 "external auth requires connection ownership"); 13289 return -EINVAL; 13290 } 13291 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT; 13292 } 13293 13294 if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT])) 13295 connect.flags |= CONNECT_REQ_MLO_SUPPORT; 13296 13297 err = cfg80211_connect(rdev, dev, &connect, connkeys, 13298 connect.prev_bssid); 13299 if (err) 13300 kfree_sensitive(connkeys); 13301 13302 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 13303 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 13304 if (connect.bssid) 13305 memcpy(dev->ieee80211_ptr->disconnect_bssid, 13306 connect.bssid, ETH_ALEN); 13307 else 13308 eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid); 13309 } 13310 13311 return err; 13312 } 13313 13314 static int nl80211_update_connect_params(struct sk_buff *skb, 13315 struct genl_info *info) 13316 { 13317 struct cfg80211_connect_params connect = {}; 13318 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13319 struct net_device *dev = info->user_ptr[1]; 13320 struct wireless_dev *wdev = dev->ieee80211_ptr; 13321 bool fils_sk_offload; 13322 u32 auth_type; 13323 u32 changed = 0; 13324 13325 if (!rdev->ops->update_connect_params) 13326 return -EOPNOTSUPP; 13327 13328 if (info->attrs[NL80211_ATTR_IE]) { 13329 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 13330 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 13331 changed |= UPDATE_ASSOC_IES; 13332 } 13333 13334 fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy, 13335 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD); 13336 13337 /* 13338 * when driver supports fils-sk offload all attributes must be 13339 * provided. So the else covers "fils-sk-not-all" and 13340 * "no-fils-sk-any". 13341 */ 13342 if (fils_sk_offload && 13343 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 13344 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 13345 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 13346 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13347 connect.fils_erp_username = 13348 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13349 connect.fils_erp_username_len = 13350 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13351 connect.fils_erp_realm = 13352 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13353 connect.fils_erp_realm_len = 13354 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13355 connect.fils_erp_next_seq_num = 13356 nla_get_u16( 13357 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 13358 connect.fils_erp_rrk = 13359 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13360 connect.fils_erp_rrk_len = 13361 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13362 changed |= UPDATE_FILS_ERP_INFO; 13363 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 13364 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 13365 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 13366 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13367 return -EINVAL; 13368 } 13369 13370 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 13371 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 13372 if (!nl80211_valid_auth_type(rdev, auth_type, 13373 NL80211_CMD_CONNECT)) 13374 return -EINVAL; 13375 13376 if (auth_type == NL80211_AUTHTYPE_FILS_SK && 13377 fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO)) 13378 return -EINVAL; 13379 13380 connect.auth_type = auth_type; 13381 changed |= UPDATE_AUTH_TYPE; 13382 } 13383 13384 if (!wdev->connected) 13385 return -ENOLINK; 13386 13387 return rdev_update_connect_params(rdev, dev, &connect, changed); 13388 } 13389 13390 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info) 13391 { 13392 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13393 struct net_device *dev = info->user_ptr[1]; 13394 u16 reason; 13395 13396 if (dev->ieee80211_ptr->conn_owner_nlportid && 13397 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 13398 return -EPERM; 13399 13400 reason = nla_get_u16_default(info->attrs[NL80211_ATTR_REASON_CODE], 13401 WLAN_REASON_DEAUTH_LEAVING); 13402 13403 if (reason == 0) 13404 return -EINVAL; 13405 13406 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13407 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 13408 return -EOPNOTSUPP; 13409 13410 return cfg80211_disconnect(rdev, dev, reason, true); 13411 } 13412 13413 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info) 13414 { 13415 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13416 struct net *net; 13417 int err; 13418 13419 if (info->attrs[NL80211_ATTR_PID]) { 13420 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]); 13421 13422 net = get_net_ns_by_pid(pid); 13423 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) { 13424 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]); 13425 13426 net = get_net_ns_by_fd(fd); 13427 } else { 13428 return -EINVAL; 13429 } 13430 13431 if (IS_ERR(net)) 13432 return PTR_ERR(net); 13433 13434 err = 0; 13435 13436 /* check if anything to do */ 13437 if (!net_eq(wiphy_net(&rdev->wiphy), net)) 13438 err = cfg80211_switch_netns(rdev, net); 13439 13440 put_net(net); 13441 return err; 13442 } 13443 13444 static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info) 13445 { 13446 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13447 struct net_device *dev = info->user_ptr[1]; 13448 struct cfg80211_pmksa pmksa; 13449 bool ap_pmksa_caching_support = false; 13450 13451 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 13452 13453 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 13454 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 13455 13456 if (!info->attrs[NL80211_ATTR_PMKID]) 13457 return -EINVAL; 13458 13459 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 13460 13461 if (info->attrs[NL80211_ATTR_MAC]) { 13462 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 13463 } else if (info->attrs[NL80211_ATTR_SSID] && 13464 info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 13465 info->attrs[NL80211_ATTR_PMK]) { 13466 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 13467 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 13468 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 13469 } else { 13470 return -EINVAL; 13471 } 13472 13473 if (info->attrs[NL80211_ATTR_PMK]) { 13474 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 13475 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 13476 } 13477 13478 if (info->attrs[NL80211_ATTR_PMK_LIFETIME]) 13479 pmksa.pmk_lifetime = 13480 nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]); 13481 13482 if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]) 13483 pmksa.pmk_reauth_threshold = 13484 nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]); 13485 13486 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13487 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 13488 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 13489 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 13490 ap_pmksa_caching_support)) 13491 return -EOPNOTSUPP; 13492 13493 if (!rdev->ops->set_pmksa) 13494 return -EOPNOTSUPP; 13495 13496 return rdev_set_pmksa(rdev, dev, &pmksa); 13497 } 13498 13499 static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info) 13500 { 13501 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13502 struct net_device *dev = info->user_ptr[1]; 13503 struct cfg80211_pmksa pmksa; 13504 bool sae_offload_support = false; 13505 bool owe_offload_support = false; 13506 bool ap_pmksa_caching_support = false; 13507 13508 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 13509 13510 sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 13511 NL80211_EXT_FEATURE_SAE_OFFLOAD); 13512 owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 13513 NL80211_EXT_FEATURE_OWE_OFFLOAD); 13514 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 13515 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 13516 13517 if (info->attrs[NL80211_ATTR_PMKID]) 13518 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 13519 13520 if (info->attrs[NL80211_ATTR_MAC]) { 13521 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 13522 } else if (info->attrs[NL80211_ATTR_SSID]) { 13523 /* SSID based pmksa flush supported only for FILS, 13524 * OWE/SAE OFFLOAD cases 13525 */ 13526 if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 13527 info->attrs[NL80211_ATTR_PMK]) { 13528 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 13529 } else if (!sae_offload_support && !owe_offload_support) { 13530 return -EINVAL; 13531 } 13532 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 13533 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 13534 } else { 13535 return -EINVAL; 13536 } 13537 13538 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13539 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 13540 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 13541 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 13542 ap_pmksa_caching_support)) 13543 return -EOPNOTSUPP; 13544 13545 if (!rdev->ops->del_pmksa) 13546 return -EOPNOTSUPP; 13547 13548 return rdev_del_pmksa(rdev, dev, &pmksa); 13549 } 13550 13551 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info) 13552 { 13553 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13554 struct net_device *dev = info->user_ptr[1]; 13555 13556 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13557 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 13558 return -EOPNOTSUPP; 13559 13560 if (!rdev->ops->flush_pmksa) 13561 return -EOPNOTSUPP; 13562 13563 return rdev_flush_pmksa(rdev, dev); 13564 } 13565 13566 static int nl80211_tdls_mgmt(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 u8 action_code, dialog_token; 13571 u32 peer_capability = 0; 13572 u16 status_code; 13573 u8 *peer; 13574 int link_id; 13575 bool initiator; 13576 13577 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 13578 !rdev->ops->tdls_mgmt) 13579 return -EOPNOTSUPP; 13580 13581 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] || 13582 !info->attrs[NL80211_ATTR_STATUS_CODE] || 13583 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] || 13584 !info->attrs[NL80211_ATTR_IE] || 13585 !info->attrs[NL80211_ATTR_MAC]) 13586 return -EINVAL; 13587 13588 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 13589 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]); 13590 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 13591 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]); 13592 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]); 13593 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]) 13594 peer_capability = 13595 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]); 13596 link_id = nl80211_link_id_or_invalid(info->attrs); 13597 13598 return rdev_tdls_mgmt(rdev, dev, peer, link_id, action_code, 13599 dialog_token, status_code, peer_capability, 13600 initiator, 13601 nla_data(info->attrs[NL80211_ATTR_IE]), 13602 nla_len(info->attrs[NL80211_ATTR_IE])); 13603 } 13604 13605 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info) 13606 { 13607 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13608 struct net_device *dev = info->user_ptr[1]; 13609 enum nl80211_tdls_operation operation; 13610 u8 *peer; 13611 13612 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 13613 !rdev->ops->tdls_oper) 13614 return -EOPNOTSUPP; 13615 13616 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] || 13617 !info->attrs[NL80211_ATTR_MAC]) 13618 return -EINVAL; 13619 13620 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]); 13621 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 13622 13623 return rdev_tdls_oper(rdev, dev, peer, operation); 13624 } 13625 13626 static int nl80211_remain_on_channel(struct sk_buff *skb, 13627 struct genl_info *info) 13628 { 13629 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13630 unsigned int link_id = nl80211_link_id(info->attrs); 13631 struct wireless_dev *wdev = info->user_ptr[1]; 13632 struct cfg80211_chan_def chandef; 13633 struct sk_buff *msg; 13634 void *hdr; 13635 u64 cookie; 13636 u32 duration; 13637 int err; 13638 13639 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 13640 !info->attrs[NL80211_ATTR_DURATION]) 13641 return -EINVAL; 13642 13643 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 13644 13645 if (!rdev->ops->remain_on_channel || 13646 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)) 13647 return -EOPNOTSUPP; 13648 13649 /* 13650 * We should be on that channel for at least a minimum amount of 13651 * time (10ms) but no longer than the driver supports. 13652 */ 13653 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 13654 duration > rdev->wiphy.max_remain_on_channel_duration) 13655 return -EINVAL; 13656 13657 err = nl80211_parse_chandef(rdev, info, &chandef); 13658 if (err) 13659 return err; 13660 13661 if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) { 13662 const struct cfg80211_chan_def *oper_chandef, *compat_chandef; 13663 13664 oper_chandef = wdev_chandef(wdev, link_id); 13665 13666 if (WARN_ON(!oper_chandef)) { 13667 /* cannot happen since we must beacon to get here */ 13668 WARN_ON(1); 13669 return -EBUSY; 13670 } 13671 13672 /* note: returns first one if identical chandefs */ 13673 compat_chandef = cfg80211_chandef_compatible(&chandef, 13674 oper_chandef); 13675 13676 if (compat_chandef != &chandef) 13677 return -EBUSY; 13678 } 13679 13680 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13681 if (!msg) 13682 return -ENOMEM; 13683 13684 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13685 NL80211_CMD_REMAIN_ON_CHANNEL); 13686 if (!hdr) { 13687 err = -ENOBUFS; 13688 goto free_msg; 13689 } 13690 13691 err = rdev_remain_on_channel(rdev, wdev, chandef.chan, 13692 duration, &cookie); 13693 13694 if (err) 13695 goto free_msg; 13696 13697 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 13698 NL80211_ATTR_PAD)) 13699 goto nla_put_failure; 13700 13701 genlmsg_end(msg, hdr); 13702 13703 return genlmsg_reply(msg, info); 13704 13705 nla_put_failure: 13706 err = -ENOBUFS; 13707 free_msg: 13708 nlmsg_free(msg); 13709 return err; 13710 } 13711 13712 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb, 13713 struct genl_info *info) 13714 { 13715 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13716 struct wireless_dev *wdev = info->user_ptr[1]; 13717 u64 cookie; 13718 13719 if (!info->attrs[NL80211_ATTR_COOKIE]) 13720 return -EINVAL; 13721 13722 if (!rdev->ops->cancel_remain_on_channel) 13723 return -EOPNOTSUPP; 13724 13725 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 13726 13727 return rdev_cancel_remain_on_channel(rdev, wdev, cookie); 13728 } 13729 13730 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb, 13731 struct genl_info *info) 13732 { 13733 struct cfg80211_bitrate_mask mask; 13734 unsigned int link_id = nl80211_link_id(info->attrs); 13735 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13736 struct net_device *dev = info->user_ptr[1]; 13737 int err; 13738 13739 if (!rdev->ops->set_bitrate_mask) 13740 return -EOPNOTSUPP; 13741 13742 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 13743 NL80211_ATTR_TX_RATES, &mask, 13744 dev, true, link_id); 13745 if (err) 13746 return err; 13747 13748 return rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask); 13749 } 13750 13751 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info) 13752 { 13753 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13754 struct wireless_dev *wdev = info->user_ptr[1]; 13755 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION; 13756 13757 if (!info->attrs[NL80211_ATTR_FRAME_MATCH]) 13758 return -EINVAL; 13759 13760 if (info->attrs[NL80211_ATTR_FRAME_TYPE]) 13761 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]); 13762 13763 switch (wdev->iftype) { 13764 case NL80211_IFTYPE_STATION: 13765 case NL80211_IFTYPE_ADHOC: 13766 case NL80211_IFTYPE_P2P_CLIENT: 13767 case NL80211_IFTYPE_AP: 13768 case NL80211_IFTYPE_AP_VLAN: 13769 case NL80211_IFTYPE_MESH_POINT: 13770 case NL80211_IFTYPE_P2P_GO: 13771 case NL80211_IFTYPE_P2P_DEVICE: 13772 break; 13773 case NL80211_IFTYPE_NAN: 13774 if (!wiphy_ext_feature_isset(wdev->wiphy, 13775 NL80211_EXT_FEATURE_SECURE_NAN) && 13776 !(wdev->wiphy->nan_capa.flags & 13777 WIPHY_NAN_FLAGS_USERSPACE_DE)) 13778 return -EOPNOTSUPP; 13779 break; 13780 default: 13781 return -EOPNOTSUPP; 13782 } 13783 13784 /* not much point in registering if we can't reply */ 13785 if (!rdev->ops->mgmt_tx) 13786 return -EOPNOTSUPP; 13787 13788 if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] && 13789 !wiphy_ext_feature_isset(&rdev->wiphy, 13790 NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) { 13791 GENL_SET_ERR_MSG(info, 13792 "multicast RX registrations are not supported"); 13793 return -EOPNOTSUPP; 13794 } 13795 13796 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type, 13797 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]), 13798 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]), 13799 info->attrs[NL80211_ATTR_RECEIVE_MULTICAST], 13800 info->extack); 13801 } 13802 13803 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info) 13804 { 13805 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13806 struct wireless_dev *wdev = info->user_ptr[1]; 13807 struct cfg80211_chan_def chandef; 13808 int err; 13809 void *hdr = NULL; 13810 u64 cookie; 13811 struct sk_buff *msg = NULL; 13812 struct cfg80211_mgmt_tx_params params = { 13813 .dont_wait_for_ack = 13814 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK], 13815 }; 13816 13817 if (!info->attrs[NL80211_ATTR_FRAME]) 13818 return -EINVAL; 13819 13820 if (!rdev->ops->mgmt_tx) 13821 return -EOPNOTSUPP; 13822 13823 switch (wdev->iftype) { 13824 case NL80211_IFTYPE_P2P_DEVICE: 13825 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 13826 return -EINVAL; 13827 break; 13828 case NL80211_IFTYPE_STATION: 13829 case NL80211_IFTYPE_ADHOC: 13830 case NL80211_IFTYPE_P2P_CLIENT: 13831 case NL80211_IFTYPE_AP: 13832 case NL80211_IFTYPE_AP_VLAN: 13833 case NL80211_IFTYPE_MESH_POINT: 13834 case NL80211_IFTYPE_P2P_GO: 13835 break; 13836 case NL80211_IFTYPE_NAN: 13837 if (!wiphy_ext_feature_isset(wdev->wiphy, 13838 NL80211_EXT_FEATURE_SECURE_NAN) && 13839 !(wdev->wiphy->nan_capa.flags & 13840 WIPHY_NAN_FLAGS_USERSPACE_DE)) 13841 return -EOPNOTSUPP; 13842 break; 13843 default: 13844 return -EOPNOTSUPP; 13845 } 13846 13847 if (info->attrs[NL80211_ATTR_DURATION]) { 13848 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 13849 return -EINVAL; 13850 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 13851 13852 /* 13853 * We should wait on the channel for at least a minimum amount 13854 * of time (10ms) but no longer than the driver supports. 13855 */ 13856 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 13857 params.wait > rdev->wiphy.max_remain_on_channel_duration) 13858 return -EINVAL; 13859 } 13860 13861 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK]; 13862 13863 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 13864 return -EINVAL; 13865 13866 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 13867 13868 /* get the channel if any has been specified, otherwise pass NULL to 13869 * the driver. The latter will use the current one 13870 */ 13871 chandef.chan = NULL; 13872 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 13873 err = nl80211_parse_chandef(rdev, info, &chandef); 13874 if (err) 13875 return err; 13876 } 13877 13878 if (!chandef.chan && params.offchan) 13879 return -EINVAL; 13880 13881 if (params.offchan && 13882 !cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) 13883 return -EBUSY; 13884 13885 params.link_id = nl80211_link_id_or_invalid(info->attrs); 13886 /* 13887 * This now races due to the unlock, but we cannot check 13888 * the valid links for the _station_ anyway, so that's up 13889 * to the driver. 13890 */ 13891 if (params.link_id >= 0 && 13892 !(wdev->valid_links & BIT(params.link_id))) 13893 return -EINVAL; 13894 13895 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 13896 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 13897 13898 err = nl80211_parse_counter_offsets(rdev, NULL, params.len, -1, 13899 info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX], 13900 ¶ms.csa_offsets, 13901 ¶ms.n_csa_offsets); 13902 if (err) 13903 return err; 13904 13905 if (!params.dont_wait_for_ack) { 13906 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13907 if (!msg) 13908 return -ENOMEM; 13909 13910 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13911 NL80211_CMD_FRAME); 13912 if (!hdr) { 13913 err = -ENOBUFS; 13914 goto free_msg; 13915 } 13916 } 13917 13918 params.chan = chandef.chan; 13919 err = cfg80211_mlme_mgmt_tx(rdev, wdev, ¶ms, &cookie); 13920 if (err) 13921 goto free_msg; 13922 13923 if (msg) { 13924 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 13925 NL80211_ATTR_PAD)) 13926 goto nla_put_failure; 13927 13928 genlmsg_end(msg, hdr); 13929 return genlmsg_reply(msg, info); 13930 } 13931 13932 return 0; 13933 13934 nla_put_failure: 13935 err = -ENOBUFS; 13936 free_msg: 13937 nlmsg_free(msg); 13938 return err; 13939 } 13940 13941 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info) 13942 { 13943 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13944 struct wireless_dev *wdev = info->user_ptr[1]; 13945 u64 cookie; 13946 13947 if (!info->attrs[NL80211_ATTR_COOKIE]) 13948 return -EINVAL; 13949 13950 if (!rdev->ops->mgmt_tx_cancel_wait) 13951 return -EOPNOTSUPP; 13952 13953 switch (wdev->iftype) { 13954 case NL80211_IFTYPE_STATION: 13955 case NL80211_IFTYPE_ADHOC: 13956 case NL80211_IFTYPE_P2P_CLIENT: 13957 case NL80211_IFTYPE_AP: 13958 case NL80211_IFTYPE_AP_VLAN: 13959 case NL80211_IFTYPE_P2P_GO: 13960 case NL80211_IFTYPE_P2P_DEVICE: 13961 break; 13962 case NL80211_IFTYPE_NAN: 13963 if (!wiphy_ext_feature_isset(wdev->wiphy, 13964 NL80211_EXT_FEATURE_SECURE_NAN)) 13965 return -EOPNOTSUPP; 13966 break; 13967 default: 13968 return -EOPNOTSUPP; 13969 } 13970 13971 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 13972 13973 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie); 13974 } 13975 13976 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info) 13977 { 13978 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13979 struct wireless_dev *wdev; 13980 struct net_device *dev = info->user_ptr[1]; 13981 u8 ps_state; 13982 bool state; 13983 int err; 13984 13985 if (!info->attrs[NL80211_ATTR_PS_STATE]) 13986 return -EINVAL; 13987 13988 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]); 13989 13990 wdev = dev->ieee80211_ptr; 13991 13992 if (!rdev->ops->set_power_mgmt) 13993 return -EOPNOTSUPP; 13994 13995 state = (ps_state == NL80211_PS_ENABLED) ? true : false; 13996 13997 if (state == wdev->ps) 13998 return 0; 13999 14000 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout); 14001 if (!err) 14002 wdev->ps = state; 14003 return err; 14004 } 14005 14006 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info) 14007 { 14008 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14009 enum nl80211_ps_state ps_state; 14010 struct wireless_dev *wdev; 14011 struct net_device *dev = info->user_ptr[1]; 14012 struct sk_buff *msg; 14013 void *hdr; 14014 int err; 14015 14016 wdev = dev->ieee80211_ptr; 14017 14018 if (!rdev->ops->set_power_mgmt) 14019 return -EOPNOTSUPP; 14020 14021 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14022 if (!msg) 14023 return -ENOMEM; 14024 14025 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14026 NL80211_CMD_GET_POWER_SAVE); 14027 if (!hdr) { 14028 err = -ENOBUFS; 14029 goto free_msg; 14030 } 14031 14032 if (wdev->ps) 14033 ps_state = NL80211_PS_ENABLED; 14034 else 14035 ps_state = NL80211_PS_DISABLED; 14036 14037 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state)) 14038 goto nla_put_failure; 14039 14040 genlmsg_end(msg, hdr); 14041 return genlmsg_reply(msg, info); 14042 14043 nla_put_failure: 14044 err = -ENOBUFS; 14045 free_msg: 14046 nlmsg_free(msg); 14047 return err; 14048 } 14049 14050 static const struct nla_policy 14051 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = { 14052 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY }, 14053 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 }, 14054 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 }, 14055 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 }, 14056 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 }, 14057 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 }, 14058 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 }, 14059 }; 14060 14061 static int nl80211_set_cqm_txe(struct genl_info *info, 14062 u32 rate, u32 pkts, u32 intvl) 14063 { 14064 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14065 struct net_device *dev = info->user_ptr[1]; 14066 struct wireless_dev *wdev = dev->ieee80211_ptr; 14067 14068 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL) 14069 return -EINVAL; 14070 14071 if (!rdev->ops->set_cqm_txe_config) 14072 return -EOPNOTSUPP; 14073 14074 if (wdev->iftype != NL80211_IFTYPE_STATION && 14075 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 14076 return -EOPNOTSUPP; 14077 14078 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl); 14079 } 14080 14081 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev, 14082 struct net_device *dev, 14083 struct cfg80211_cqm_config *cqm_config) 14084 { 14085 struct wireless_dev *wdev = dev->ieee80211_ptr; 14086 s32 last, low, high; 14087 u32 hyst; 14088 int i, n, low_index; 14089 int err; 14090 14091 /* 14092 * Obtain current RSSI value if possible, if not and no RSSI threshold 14093 * event has been received yet, we should receive an event after a 14094 * connection is established and enough beacons received to calculate 14095 * the average. 14096 */ 14097 if (!cqm_config->last_rssi_event_value && 14098 wdev->links[0].client.current_bss && 14099 rdev->ops->get_station) { 14100 struct station_info sinfo = {}; 14101 u8 *mac_addr; 14102 14103 mac_addr = wdev->links[0].client.current_bss->pub.bssid; 14104 14105 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 14106 if (err) 14107 return err; 14108 14109 cfg80211_sinfo_release_content(&sinfo); 14110 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG)) 14111 cqm_config->last_rssi_event_value = 14112 (s8) sinfo.rx_beacon_signal_avg; 14113 } 14114 14115 last = cqm_config->last_rssi_event_value; 14116 hyst = cqm_config->rssi_hyst; 14117 n = cqm_config->n_rssi_thresholds; 14118 14119 for (i = 0; i < n; i++) { 14120 i = array_index_nospec(i, n); 14121 if (last < cqm_config->rssi_thresholds[i]) 14122 break; 14123 } 14124 14125 low_index = i - 1; 14126 if (low_index >= 0) { 14127 low_index = array_index_nospec(low_index, n); 14128 low = cqm_config->rssi_thresholds[low_index] - hyst; 14129 } else { 14130 low = S32_MIN; 14131 } 14132 if (i < n) { 14133 i = array_index_nospec(i, n); 14134 high = cqm_config->rssi_thresholds[i] + hyst - 1; 14135 } else { 14136 high = S32_MAX; 14137 } 14138 14139 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high); 14140 } 14141 14142 static int nl80211_set_cqm_rssi(struct genl_info *info, 14143 const s32 *thresholds, int n_thresholds, 14144 u32 hysteresis) 14145 { 14146 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14147 struct cfg80211_cqm_config *cqm_config = NULL, *old; 14148 struct net_device *dev = info->user_ptr[1]; 14149 struct wireless_dev *wdev = dev->ieee80211_ptr; 14150 s32 prev = S32_MIN; 14151 int i, err; 14152 14153 /* Check all values negative and sorted */ 14154 for (i = 0; i < n_thresholds; i++) { 14155 if (thresholds[i] > 0 || thresholds[i] <= prev) 14156 return -EINVAL; 14157 14158 prev = thresholds[i]; 14159 } 14160 14161 if (wdev->iftype != NL80211_IFTYPE_STATION && 14162 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 14163 return -EOPNOTSUPP; 14164 14165 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */ 14166 n_thresholds = 0; 14167 14168 old = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 14169 14170 /* if already disabled just succeed */ 14171 if (!n_thresholds && !old) 14172 return 0; 14173 14174 if (n_thresholds > 1) { 14175 if (!wiphy_ext_feature_isset(&rdev->wiphy, 14176 NL80211_EXT_FEATURE_CQM_RSSI_LIST) || 14177 !rdev->ops->set_cqm_rssi_range_config) 14178 return -EOPNOTSUPP; 14179 } else { 14180 if (!rdev->ops->set_cqm_rssi_config) 14181 return -EOPNOTSUPP; 14182 } 14183 14184 if (n_thresholds) { 14185 cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds, 14186 n_thresholds), 14187 GFP_KERNEL); 14188 if (!cqm_config) 14189 return -ENOMEM; 14190 14191 cqm_config->rssi_hyst = hysteresis; 14192 cqm_config->n_rssi_thresholds = n_thresholds; 14193 memcpy(cqm_config->rssi_thresholds, thresholds, 14194 flex_array_size(cqm_config, rssi_thresholds, 14195 n_thresholds)); 14196 cqm_config->use_range_api = n_thresholds > 1 || 14197 !rdev->ops->set_cqm_rssi_config; 14198 14199 rcu_assign_pointer(wdev->cqm_config, cqm_config); 14200 14201 if (cqm_config->use_range_api) 14202 err = cfg80211_cqm_rssi_update(rdev, dev, cqm_config); 14203 else 14204 err = rdev_set_cqm_rssi_config(rdev, dev, 14205 thresholds[0], 14206 hysteresis); 14207 } else { 14208 RCU_INIT_POINTER(wdev->cqm_config, NULL); 14209 /* if enabled as range also disable via range */ 14210 if (old->use_range_api) 14211 err = rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0); 14212 else 14213 err = rdev_set_cqm_rssi_config(rdev, dev, 0, 0); 14214 } 14215 14216 if (err) { 14217 rcu_assign_pointer(wdev->cqm_config, old); 14218 kfree_rcu(cqm_config, rcu_head); 14219 } else { 14220 kfree_rcu(old, rcu_head); 14221 } 14222 14223 return err; 14224 } 14225 14226 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info) 14227 { 14228 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1]; 14229 struct nlattr *cqm; 14230 int err; 14231 14232 cqm = info->attrs[NL80211_ATTR_CQM]; 14233 if (!cqm) 14234 return -EINVAL; 14235 14236 err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm, 14237 nl80211_attr_cqm_policy, 14238 info->extack); 14239 if (err) 14240 return err; 14241 14242 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] && 14243 attrs[NL80211_ATTR_CQM_RSSI_HYST]) { 14244 const s32 *thresholds = 14245 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 14246 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 14247 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]); 14248 14249 if (len % 4) 14250 return -EINVAL; 14251 14252 return nl80211_set_cqm_rssi(info, thresholds, len / 4, 14253 hysteresis); 14254 } 14255 14256 if (attrs[NL80211_ATTR_CQM_TXE_RATE] && 14257 attrs[NL80211_ATTR_CQM_TXE_PKTS] && 14258 attrs[NL80211_ATTR_CQM_TXE_INTVL]) { 14259 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]); 14260 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]); 14261 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]); 14262 14263 return nl80211_set_cqm_txe(info, rate, pkts, intvl); 14264 } 14265 14266 return -EINVAL; 14267 } 14268 14269 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info) 14270 { 14271 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14272 struct net_device *dev = info->user_ptr[1]; 14273 struct ocb_setup setup = {}; 14274 int err; 14275 14276 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 14277 if (err) 14278 return err; 14279 14280 return cfg80211_join_ocb(rdev, dev, &setup); 14281 } 14282 14283 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info) 14284 { 14285 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14286 struct net_device *dev = info->user_ptr[1]; 14287 14288 return cfg80211_leave_ocb(rdev, dev); 14289 } 14290 14291 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info) 14292 { 14293 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14294 struct net_device *dev = info->user_ptr[1]; 14295 struct mesh_config cfg; 14296 struct mesh_setup setup; 14297 int err; 14298 14299 /* start with default */ 14300 memcpy(&cfg, &default_mesh_config, sizeof(cfg)); 14301 memcpy(&setup, &default_mesh_setup, sizeof(setup)); 14302 14303 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) { 14304 /* and parse parameters if given */ 14305 err = nl80211_parse_mesh_config(info, &cfg, NULL); 14306 if (err) 14307 return err; 14308 } 14309 14310 if (!info->attrs[NL80211_ATTR_MESH_ID] || 14311 !nla_len(info->attrs[NL80211_ATTR_MESH_ID])) 14312 return -EINVAL; 14313 14314 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]); 14315 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 14316 14317 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 14318 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate, 14319 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 14320 return -EINVAL; 14321 14322 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) { 14323 setup.beacon_interval = 14324 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 14325 14326 err = cfg80211_validate_beacon_int(rdev, 14327 NL80211_IFTYPE_MESH_POINT, 14328 setup.beacon_interval); 14329 if (err) 14330 return err; 14331 } 14332 14333 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) { 14334 setup.dtim_period = 14335 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 14336 if (setup.dtim_period < 1 || setup.dtim_period > 100) 14337 return -EINVAL; 14338 } 14339 14340 if (info->attrs[NL80211_ATTR_MESH_SETUP]) { 14341 /* parse additional setup parameters if given */ 14342 err = nl80211_parse_mesh_setup(info, &setup); 14343 if (err) 14344 return err; 14345 } 14346 14347 if (setup.user_mpm) 14348 cfg.auto_open_plinks = false; 14349 14350 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 14351 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 14352 if (err) 14353 return err; 14354 } else { 14355 /* __cfg80211_join_mesh() will sort it out */ 14356 setup.chandef.chan = NULL; 14357 } 14358 14359 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 14360 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 14361 int n_rates = 14362 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 14363 struct ieee80211_supported_band *sband; 14364 14365 if (!setup.chandef.chan) 14366 return -EINVAL; 14367 14368 sband = rdev->wiphy.bands[setup.chandef.chan->band]; 14369 14370 err = ieee80211_get_ratemask(sband, rates, n_rates, 14371 &setup.basic_rates); 14372 if (err) 14373 return err; 14374 } 14375 14376 if (info->attrs[NL80211_ATTR_TX_RATES]) { 14377 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 14378 NL80211_ATTR_TX_RATES, 14379 &setup.beacon_rate, 14380 dev, false, 0); 14381 if (err) 14382 return err; 14383 14384 if (!setup.chandef.chan) 14385 return -EINVAL; 14386 14387 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band, 14388 &setup.beacon_rate); 14389 if (err) 14390 return err; 14391 } 14392 14393 setup.userspace_handles_dfs = 14394 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 14395 14396 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 14397 int r = validate_pae_over_nl80211(rdev, info); 14398 14399 if (r < 0) 14400 return r; 14401 14402 setup.control_port_over_nl80211 = true; 14403 } 14404 14405 err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg); 14406 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) 14407 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 14408 14409 return err; 14410 } 14411 14412 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info) 14413 { 14414 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14415 struct net_device *dev = info->user_ptr[1]; 14416 14417 return cfg80211_leave_mesh(rdev, dev); 14418 } 14419 14420 #ifdef CONFIG_PM 14421 static int nl80211_send_wowlan_patterns(struct sk_buff *msg, 14422 struct cfg80211_registered_device *rdev) 14423 { 14424 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config; 14425 struct nlattr *nl_pats, *nl_pat; 14426 int i, pat_len; 14427 14428 if (!wowlan->n_patterns) 14429 return 0; 14430 14431 nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN); 14432 if (!nl_pats) 14433 return -ENOBUFS; 14434 14435 for (i = 0; i < wowlan->n_patterns; i++) { 14436 nl_pat = nla_nest_start_noflag(msg, i + 1); 14437 if (!nl_pat) 14438 return -ENOBUFS; 14439 pat_len = wowlan->patterns[i].pattern_len; 14440 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8), 14441 wowlan->patterns[i].mask) || 14442 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 14443 wowlan->patterns[i].pattern) || 14444 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 14445 wowlan->patterns[i].pkt_offset)) 14446 return -ENOBUFS; 14447 nla_nest_end(msg, nl_pat); 14448 } 14449 nla_nest_end(msg, nl_pats); 14450 14451 return 0; 14452 } 14453 14454 static int nl80211_send_wowlan_tcp(struct sk_buff *msg, 14455 struct cfg80211_wowlan_tcp *tcp) 14456 { 14457 struct nlattr *nl_tcp; 14458 14459 if (!tcp) 14460 return 0; 14461 14462 nl_tcp = nla_nest_start_noflag(msg, 14463 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 14464 if (!nl_tcp) 14465 return -ENOBUFS; 14466 14467 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) || 14468 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) || 14469 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) || 14470 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) || 14471 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) || 14472 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 14473 tcp->payload_len, tcp->payload) || 14474 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 14475 tcp->data_interval) || 14476 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 14477 tcp->wake_len, tcp->wake_data) || 14478 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK, 14479 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask)) 14480 return -ENOBUFS; 14481 14482 if (tcp->payload_seq.len && 14483 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ, 14484 sizeof(tcp->payload_seq), &tcp->payload_seq)) 14485 return -ENOBUFS; 14486 14487 if (tcp->payload_tok.len && 14488 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 14489 sizeof(tcp->payload_tok) + tcp->tokens_size, 14490 &tcp->payload_tok)) 14491 return -ENOBUFS; 14492 14493 nla_nest_end(msg, nl_tcp); 14494 14495 return 0; 14496 } 14497 14498 static int nl80211_send_wowlan_nd(struct sk_buff *msg, 14499 struct cfg80211_sched_scan_request *req) 14500 { 14501 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan; 14502 int i; 14503 14504 if (!req) 14505 return 0; 14506 14507 nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT); 14508 if (!nd) 14509 return -ENOBUFS; 14510 14511 if (req->n_scan_plans == 1 && 14512 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL, 14513 req->scan_plans[0].interval * 1000)) 14514 return -ENOBUFS; 14515 14516 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay)) 14517 return -ENOBUFS; 14518 14519 if (req->relative_rssi_set) { 14520 struct nl80211_bss_select_rssi_adjust rssi_adjust; 14521 14522 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI, 14523 req->relative_rssi)) 14524 return -ENOBUFS; 14525 14526 rssi_adjust.band = req->rssi_adjust.band; 14527 rssi_adjust.delta = req->rssi_adjust.delta; 14528 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST, 14529 sizeof(rssi_adjust), &rssi_adjust)) 14530 return -ENOBUFS; 14531 } 14532 14533 freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 14534 if (!freqs) 14535 return -ENOBUFS; 14536 14537 for (i = 0; i < req->n_channels; i++) { 14538 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 14539 return -ENOBUFS; 14540 } 14541 14542 nla_nest_end(msg, freqs); 14543 14544 if (req->n_match_sets) { 14545 matches = nla_nest_start_noflag(msg, 14546 NL80211_ATTR_SCHED_SCAN_MATCH); 14547 if (!matches) 14548 return -ENOBUFS; 14549 14550 for (i = 0; i < req->n_match_sets; i++) { 14551 match = nla_nest_start_noflag(msg, i); 14552 if (!match) 14553 return -ENOBUFS; 14554 14555 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID, 14556 req->match_sets[i].ssid.ssid_len, 14557 req->match_sets[i].ssid.ssid)) 14558 return -ENOBUFS; 14559 nla_nest_end(msg, match); 14560 } 14561 nla_nest_end(msg, matches); 14562 } 14563 14564 scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS); 14565 if (!scan_plans) 14566 return -ENOBUFS; 14567 14568 for (i = 0; i < req->n_scan_plans; i++) { 14569 scan_plan = nla_nest_start_noflag(msg, i + 1); 14570 if (!scan_plan) 14571 return -ENOBUFS; 14572 14573 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL, 14574 req->scan_plans[i].interval) || 14575 (req->scan_plans[i].iterations && 14576 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS, 14577 req->scan_plans[i].iterations))) 14578 return -ENOBUFS; 14579 nla_nest_end(msg, scan_plan); 14580 } 14581 nla_nest_end(msg, scan_plans); 14582 14583 nla_nest_end(msg, nd); 14584 14585 return 0; 14586 } 14587 14588 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info) 14589 { 14590 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14591 struct sk_buff *msg; 14592 void *hdr; 14593 u32 size = NLMSG_DEFAULT_SIZE; 14594 14595 if (!rdev->wiphy.wowlan) 14596 return -EOPNOTSUPP; 14597 14598 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) { 14599 /* adjust size to have room for all the data */ 14600 size += rdev->wiphy.wowlan_config->tcp->tokens_size + 14601 rdev->wiphy.wowlan_config->tcp->payload_len + 14602 rdev->wiphy.wowlan_config->tcp->wake_len + 14603 rdev->wiphy.wowlan_config->tcp->wake_len / 8; 14604 } 14605 14606 msg = nlmsg_new(size, GFP_KERNEL); 14607 if (!msg) 14608 return -ENOMEM; 14609 14610 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14611 NL80211_CMD_GET_WOWLAN); 14612 if (!hdr) 14613 goto nla_put_failure; 14614 14615 if (rdev->wiphy.wowlan_config) { 14616 struct nlattr *nl_wowlan; 14617 14618 nl_wowlan = nla_nest_start_noflag(msg, 14619 NL80211_ATTR_WOWLAN_TRIGGERS); 14620 if (!nl_wowlan) 14621 goto nla_put_failure; 14622 14623 if ((rdev->wiphy.wowlan_config->any && 14624 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 14625 (rdev->wiphy.wowlan_config->disconnect && 14626 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 14627 (rdev->wiphy.wowlan_config->magic_pkt && 14628 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 14629 (rdev->wiphy.wowlan_config->gtk_rekey_failure && 14630 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 14631 (rdev->wiphy.wowlan_config->eap_identity_req && 14632 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 14633 (rdev->wiphy.wowlan_config->four_way_handshake && 14634 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 14635 (rdev->wiphy.wowlan_config->rfkill_release && 14636 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 14637 goto nla_put_failure; 14638 14639 if (nl80211_send_wowlan_patterns(msg, rdev)) 14640 goto nla_put_failure; 14641 14642 if (nl80211_send_wowlan_tcp(msg, 14643 rdev->wiphy.wowlan_config->tcp)) 14644 goto nla_put_failure; 14645 14646 if (nl80211_send_wowlan_nd( 14647 msg, 14648 rdev->wiphy.wowlan_config->nd_config)) 14649 goto nla_put_failure; 14650 14651 nla_nest_end(msg, nl_wowlan); 14652 } 14653 14654 genlmsg_end(msg, hdr); 14655 return genlmsg_reply(msg, info); 14656 14657 nla_put_failure: 14658 nlmsg_free(msg); 14659 return -ENOBUFS; 14660 } 14661 14662 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev, 14663 struct nlattr *attr, 14664 struct cfg80211_wowlan *trig) 14665 { 14666 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP]; 14667 struct cfg80211_wowlan_tcp *cfg; 14668 struct nl80211_wowlan_tcp_data_token *tok = NULL; 14669 struct nl80211_wowlan_tcp_data_seq *seq = NULL; 14670 u32 size; 14671 u32 data_size, wake_size, tokens_size = 0, wake_mask_size; 14672 int err, port; 14673 14674 if (!rdev->wiphy.wowlan->tcp) 14675 return -EINVAL; 14676 14677 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr, 14678 nl80211_wowlan_tcp_policy, NULL); 14679 if (err) 14680 return err; 14681 14682 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] || 14683 !tb[NL80211_WOWLAN_TCP_DST_IPV4] || 14684 !tb[NL80211_WOWLAN_TCP_DST_MAC] || 14685 !tb[NL80211_WOWLAN_TCP_DST_PORT] || 14686 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] || 14687 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] || 14688 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] || 14689 !tb[NL80211_WOWLAN_TCP_WAKE_MASK]) 14690 return -EINVAL; 14691 14692 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]); 14693 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max) 14694 return -EINVAL; 14695 14696 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) > 14697 rdev->wiphy.wowlan->tcp->data_interval_max || 14698 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0) 14699 return -EINVAL; 14700 14701 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]); 14702 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max) 14703 return -EINVAL; 14704 14705 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]); 14706 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8)) 14707 return -EINVAL; 14708 14709 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) { 14710 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 14711 14712 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 14713 tokens_size = tokln - sizeof(*tok); 14714 14715 if (!tok->len || tokens_size % tok->len) 14716 return -EINVAL; 14717 if (!rdev->wiphy.wowlan->tcp->tok) 14718 return -EINVAL; 14719 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len) 14720 return -EINVAL; 14721 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len) 14722 return -EINVAL; 14723 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize) 14724 return -EINVAL; 14725 if (tok->offset + tok->len > data_size) 14726 return -EINVAL; 14727 } 14728 14729 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) { 14730 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]); 14731 if (!rdev->wiphy.wowlan->tcp->seq) 14732 return -EINVAL; 14733 if (seq->len == 0 || seq->len > 4) 14734 return -EINVAL; 14735 if (seq->len + seq->offset > data_size) 14736 return -EINVAL; 14737 } 14738 14739 size = sizeof(*cfg); 14740 size += data_size; 14741 size += wake_size + wake_mask_size; 14742 size += tokens_size; 14743 14744 cfg = kzalloc(size, GFP_KERNEL); 14745 if (!cfg) 14746 return -ENOMEM; 14747 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]); 14748 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]); 14749 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]), 14750 ETH_ALEN); 14751 port = nla_get_u16_default(tb[NL80211_WOWLAN_TCP_SRC_PORT], 0); 14752 #ifdef CONFIG_INET 14753 /* allocate a socket and port for it and use it */ 14754 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM, 14755 IPPROTO_TCP, &cfg->sock, 1); 14756 if (err) { 14757 kfree(cfg); 14758 return err; 14759 } 14760 if (inet_csk_get_port(cfg->sock->sk, port)) { 14761 sock_release(cfg->sock); 14762 kfree(cfg); 14763 return -EADDRINUSE; 14764 } 14765 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num; 14766 #else 14767 if (!port) { 14768 kfree(cfg); 14769 return -EINVAL; 14770 } 14771 cfg->src_port = port; 14772 #endif 14773 14774 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]); 14775 cfg->payload_len = data_size; 14776 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size; 14777 memcpy((void *)cfg->payload, 14778 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]), 14779 data_size); 14780 if (seq) 14781 cfg->payload_seq = *seq; 14782 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]); 14783 cfg->wake_len = wake_size; 14784 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size; 14785 memcpy((void *)cfg->wake_data, 14786 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]), 14787 wake_size); 14788 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size + 14789 data_size + wake_size; 14790 memcpy((void *)cfg->wake_mask, 14791 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]), 14792 wake_mask_size); 14793 if (tok) { 14794 cfg->tokens_size = tokens_size; 14795 cfg->payload_tok = *tok; 14796 memcpy(cfg->payload_tok.token_stream, tok->token_stream, 14797 tokens_size); 14798 } 14799 14800 trig->tcp = cfg; 14801 14802 return 0; 14803 } 14804 14805 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev, 14806 const struct wiphy_wowlan_support *wowlan, 14807 struct nlattr *attr, 14808 struct cfg80211_wowlan *trig) 14809 { 14810 struct nlattr **tb; 14811 int err; 14812 14813 tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 14814 if (!tb) 14815 return -ENOMEM; 14816 14817 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) { 14818 err = -EOPNOTSUPP; 14819 goto out; 14820 } 14821 14822 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr, 14823 nl80211_policy, NULL); 14824 if (err) 14825 goto out; 14826 14827 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb, 14828 wowlan->max_nd_match_sets); 14829 err = PTR_ERR_OR_ZERO(trig->nd_config); 14830 if (err) 14831 trig->nd_config = NULL; 14832 14833 out: 14834 kfree(tb); 14835 return err; 14836 } 14837 14838 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info) 14839 { 14840 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14841 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG]; 14842 struct cfg80211_wowlan new_triggers = {}; 14843 struct cfg80211_wowlan *ntrig; 14844 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan; 14845 int err, i; 14846 bool prev_enabled = rdev->wiphy.wowlan_config; 14847 bool regular = false; 14848 14849 if (!wowlan) 14850 return -EOPNOTSUPP; 14851 14852 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) { 14853 cfg80211_rdev_free_wowlan(rdev); 14854 rdev->wiphy.wowlan_config = NULL; 14855 goto set_wakeup; 14856 } 14857 14858 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG, 14859 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS], 14860 nl80211_wowlan_policy, info->extack); 14861 if (err) 14862 return err; 14863 14864 if (tb[NL80211_WOWLAN_TRIG_ANY]) { 14865 if (!(wowlan->flags & WIPHY_WOWLAN_ANY)) 14866 return -EINVAL; 14867 new_triggers.any = true; 14868 } 14869 14870 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) { 14871 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT)) 14872 return -EINVAL; 14873 new_triggers.disconnect = true; 14874 regular = true; 14875 } 14876 14877 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) { 14878 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT)) 14879 return -EINVAL; 14880 new_triggers.magic_pkt = true; 14881 regular = true; 14882 } 14883 14884 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED]) 14885 return -EINVAL; 14886 14887 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) { 14888 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE)) 14889 return -EINVAL; 14890 new_triggers.gtk_rekey_failure = true; 14891 regular = true; 14892 } 14893 14894 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) { 14895 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ)) 14896 return -EINVAL; 14897 new_triggers.eap_identity_req = true; 14898 regular = true; 14899 } 14900 14901 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) { 14902 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE)) 14903 return -EINVAL; 14904 new_triggers.four_way_handshake = true; 14905 regular = true; 14906 } 14907 14908 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) { 14909 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE)) 14910 return -EINVAL; 14911 new_triggers.rfkill_release = true; 14912 regular = true; 14913 } 14914 14915 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) { 14916 struct nlattr *pat; 14917 int n_patterns = 0; 14918 int rem, pat_len, mask_len, pkt_offset; 14919 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 14920 14921 regular = true; 14922 14923 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 14924 rem) 14925 n_patterns++; 14926 if (n_patterns > wowlan->n_patterns) 14927 return -EINVAL; 14928 14929 new_triggers.patterns = kcalloc(n_patterns, 14930 sizeof(new_triggers.patterns[0]), 14931 GFP_KERNEL); 14932 if (!new_triggers.patterns) 14933 return -ENOMEM; 14934 14935 new_triggers.n_patterns = n_patterns; 14936 i = 0; 14937 14938 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 14939 rem) { 14940 u8 *mask_pat; 14941 14942 err = nla_parse_nested_deprecated(pat_tb, 14943 MAX_NL80211_PKTPAT, 14944 pat, 14945 nl80211_packet_pattern_policy, 14946 info->extack); 14947 if (err) 14948 goto error; 14949 14950 err = -EINVAL; 14951 if (!pat_tb[NL80211_PKTPAT_MASK] || 14952 !pat_tb[NL80211_PKTPAT_PATTERN]) 14953 goto error; 14954 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 14955 mask_len = DIV_ROUND_UP(pat_len, 8); 14956 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 14957 goto error; 14958 if (pat_len > wowlan->pattern_max_len || 14959 pat_len < wowlan->pattern_min_len) 14960 goto error; 14961 14962 pkt_offset = 14963 nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET], 14964 0); 14965 if (pkt_offset > wowlan->max_pkt_offset) 14966 goto error; 14967 new_triggers.patterns[i].pkt_offset = pkt_offset; 14968 14969 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 14970 if (!mask_pat) { 14971 err = -ENOMEM; 14972 goto error; 14973 } 14974 new_triggers.patterns[i].mask = mask_pat; 14975 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 14976 mask_len); 14977 mask_pat += mask_len; 14978 new_triggers.patterns[i].pattern = mask_pat; 14979 new_triggers.patterns[i].pattern_len = pat_len; 14980 memcpy(mask_pat, 14981 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 14982 pat_len); 14983 i++; 14984 } 14985 } 14986 14987 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) { 14988 regular = true; 14989 err = nl80211_parse_wowlan_tcp( 14990 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION], 14991 &new_triggers); 14992 if (err) 14993 goto error; 14994 } 14995 14996 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) { 14997 regular = true; 14998 err = nl80211_parse_wowlan_nd( 14999 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT], 15000 &new_triggers); 15001 if (err) 15002 goto error; 15003 } 15004 15005 /* The 'any' trigger means the device continues operating more or less 15006 * as in its normal operation mode and wakes up the host on most of the 15007 * normal interrupts (like packet RX, ...) 15008 * It therefore makes little sense to combine with the more constrained 15009 * wakeup trigger modes. 15010 */ 15011 if (new_triggers.any && regular) { 15012 err = -EINVAL; 15013 goto error; 15014 } 15015 15016 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL); 15017 if (!ntrig) { 15018 err = -ENOMEM; 15019 goto error; 15020 } 15021 cfg80211_rdev_free_wowlan(rdev); 15022 rdev->wiphy.wowlan_config = ntrig; 15023 15024 set_wakeup: 15025 if (rdev->ops->set_wakeup && 15026 prev_enabled != !!rdev->wiphy.wowlan_config) 15027 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config); 15028 15029 return 0; 15030 error: 15031 for (i = 0; i < new_triggers.n_patterns; i++) 15032 kfree(new_triggers.patterns[i].mask); 15033 kfree(new_triggers.patterns); 15034 if (new_triggers.tcp && new_triggers.tcp->sock) 15035 sock_release(new_triggers.tcp->sock); 15036 kfree(new_triggers.tcp); 15037 kfree(new_triggers.nd_config); 15038 return err; 15039 } 15040 #endif 15041 15042 static int nl80211_send_coalesce_rules(struct sk_buff *msg, 15043 struct cfg80211_registered_device *rdev) 15044 { 15045 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules; 15046 int i, j, pat_len; 15047 struct cfg80211_coalesce_rules *rule; 15048 15049 if (!rdev->coalesce->n_rules) 15050 return 0; 15051 15052 nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE); 15053 if (!nl_rules) 15054 return -ENOBUFS; 15055 15056 for (i = 0; i < rdev->coalesce->n_rules; i++) { 15057 nl_rule = nla_nest_start_noflag(msg, i + 1); 15058 if (!nl_rule) 15059 return -ENOBUFS; 15060 15061 rule = &rdev->coalesce->rules[i]; 15062 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY, 15063 rule->delay)) 15064 return -ENOBUFS; 15065 15066 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION, 15067 rule->condition)) 15068 return -ENOBUFS; 15069 15070 nl_pats = nla_nest_start_noflag(msg, 15071 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN); 15072 if (!nl_pats) 15073 return -ENOBUFS; 15074 15075 for (j = 0; j < rule->n_patterns; j++) { 15076 nl_pat = nla_nest_start_noflag(msg, j + 1); 15077 if (!nl_pat) 15078 return -ENOBUFS; 15079 pat_len = rule->patterns[j].pattern_len; 15080 if (nla_put(msg, NL80211_PKTPAT_MASK, 15081 DIV_ROUND_UP(pat_len, 8), 15082 rule->patterns[j].mask) || 15083 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 15084 rule->patterns[j].pattern) || 15085 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 15086 rule->patterns[j].pkt_offset)) 15087 return -ENOBUFS; 15088 nla_nest_end(msg, nl_pat); 15089 } 15090 nla_nest_end(msg, nl_pats); 15091 nla_nest_end(msg, nl_rule); 15092 } 15093 nla_nest_end(msg, nl_rules); 15094 15095 return 0; 15096 } 15097 15098 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info) 15099 { 15100 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15101 struct sk_buff *msg; 15102 void *hdr; 15103 15104 if (!rdev->wiphy.coalesce) 15105 return -EOPNOTSUPP; 15106 15107 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15108 if (!msg) 15109 return -ENOMEM; 15110 15111 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15112 NL80211_CMD_GET_COALESCE); 15113 if (!hdr) 15114 goto nla_put_failure; 15115 15116 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev)) 15117 goto nla_put_failure; 15118 15119 genlmsg_end(msg, hdr); 15120 return genlmsg_reply(msg, info); 15121 15122 nla_put_failure: 15123 nlmsg_free(msg); 15124 return -ENOBUFS; 15125 } 15126 15127 void cfg80211_free_coalesce(struct cfg80211_coalesce *coalesce) 15128 { 15129 int i, j; 15130 struct cfg80211_coalesce_rules *rule; 15131 15132 if (!coalesce) 15133 return; 15134 15135 for (i = 0; i < coalesce->n_rules; i++) { 15136 rule = &coalesce->rules[i]; 15137 for (j = 0; j < rule->n_patterns; j++) 15138 kfree(rule->patterns[j].mask); 15139 kfree(rule->patterns); 15140 } 15141 kfree(coalesce); 15142 } 15143 15144 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev, 15145 struct nlattr *rule, 15146 struct cfg80211_coalesce_rules *new_rule) 15147 { 15148 int err, i; 15149 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 15150 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat; 15151 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0; 15152 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 15153 15154 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX, 15155 rule, nl80211_coalesce_policy, NULL); 15156 if (err) 15157 return err; 15158 15159 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY]) 15160 new_rule->delay = 15161 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]); 15162 if (new_rule->delay > coalesce->max_delay) 15163 return -EINVAL; 15164 15165 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION]) 15166 new_rule->condition = 15167 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]); 15168 15169 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN]) 15170 return -EINVAL; 15171 15172 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 15173 rem) 15174 n_patterns++; 15175 if (n_patterns > coalesce->n_patterns) 15176 return -EINVAL; 15177 15178 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]), 15179 GFP_KERNEL); 15180 if (!new_rule->patterns) 15181 return -ENOMEM; 15182 15183 new_rule->n_patterns = n_patterns; 15184 i = 0; 15185 15186 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 15187 rem) { 15188 u8 *mask_pat; 15189 15190 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT, 15191 pat, 15192 nl80211_packet_pattern_policy, 15193 NULL); 15194 if (err) 15195 return err; 15196 15197 if (!pat_tb[NL80211_PKTPAT_MASK] || 15198 !pat_tb[NL80211_PKTPAT_PATTERN]) 15199 return -EINVAL; 15200 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 15201 mask_len = DIV_ROUND_UP(pat_len, 8); 15202 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 15203 return -EINVAL; 15204 if (pat_len > coalesce->pattern_max_len || 15205 pat_len < coalesce->pattern_min_len) 15206 return -EINVAL; 15207 15208 pkt_offset = nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET], 15209 0); 15210 if (pkt_offset > coalesce->max_pkt_offset) 15211 return -EINVAL; 15212 new_rule->patterns[i].pkt_offset = pkt_offset; 15213 15214 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 15215 if (!mask_pat) 15216 return -ENOMEM; 15217 15218 new_rule->patterns[i].mask = mask_pat; 15219 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 15220 mask_len); 15221 15222 mask_pat += mask_len; 15223 new_rule->patterns[i].pattern = mask_pat; 15224 new_rule->patterns[i].pattern_len = pat_len; 15225 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 15226 pat_len); 15227 i++; 15228 } 15229 15230 return 0; 15231 } 15232 15233 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info) 15234 { 15235 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15236 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 15237 struct cfg80211_coalesce *new_coalesce; 15238 int err, rem_rule, n_rules = 0, i; 15239 struct nlattr *rule; 15240 15241 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce) 15242 return -EOPNOTSUPP; 15243 15244 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) { 15245 cfg80211_free_coalesce(rdev->coalesce); 15246 rdev->coalesce = NULL; 15247 rdev_set_coalesce(rdev, NULL); 15248 return 0; 15249 } 15250 15251 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 15252 rem_rule) 15253 n_rules++; 15254 if (n_rules > coalesce->n_rules) 15255 return -EINVAL; 15256 15257 new_coalesce = kzalloc(struct_size(new_coalesce, rules, n_rules), 15258 GFP_KERNEL); 15259 if (!new_coalesce) 15260 return -ENOMEM; 15261 15262 new_coalesce->n_rules = n_rules; 15263 i = 0; 15264 15265 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 15266 rem_rule) { 15267 err = nl80211_parse_coalesce_rule(rdev, rule, 15268 &new_coalesce->rules[i]); 15269 if (err) 15270 goto error; 15271 15272 i++; 15273 } 15274 15275 err = rdev_set_coalesce(rdev, new_coalesce); 15276 if (err) 15277 goto error; 15278 15279 cfg80211_free_coalesce(rdev->coalesce); 15280 rdev->coalesce = new_coalesce; 15281 15282 return 0; 15283 error: 15284 cfg80211_free_coalesce(new_coalesce); 15285 15286 return err; 15287 } 15288 15289 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info) 15290 { 15291 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15292 struct net_device *dev = info->user_ptr[1]; 15293 struct wireless_dev *wdev = dev->ieee80211_ptr; 15294 struct nlattr *tb[NUM_NL80211_REKEY_DATA]; 15295 struct cfg80211_gtk_rekey_data rekey_data = {}; 15296 int err; 15297 15298 if (!info->attrs[NL80211_ATTR_REKEY_DATA]) 15299 return -EINVAL; 15300 15301 err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA, 15302 info->attrs[NL80211_ATTR_REKEY_DATA], 15303 nl80211_rekey_policy, info->extack); 15304 if (err) 15305 return err; 15306 15307 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] || 15308 !tb[NL80211_REKEY_DATA_KCK]) 15309 return -EINVAL; 15310 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN && 15311 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 15312 nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN)) 15313 return -ERANGE; 15314 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN && 15315 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 15316 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) && 15317 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 && 15318 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32)) 15319 return -ERANGE; 15320 15321 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]); 15322 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]); 15323 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]); 15324 rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]); 15325 rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]); 15326 if (tb[NL80211_REKEY_DATA_AKM]) 15327 rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]); 15328 15329 if (!wdev->connected) 15330 return -ENOTCONN; 15331 15332 if (!rdev->ops->set_rekey_data) 15333 return -EOPNOTSUPP; 15334 15335 return rdev_set_rekey_data(rdev, dev, &rekey_data); 15336 } 15337 15338 static int nl80211_register_unexpected_frame(struct sk_buff *skb, 15339 struct genl_info *info) 15340 { 15341 struct net_device *dev = info->user_ptr[1]; 15342 struct wireless_dev *wdev = dev->ieee80211_ptr; 15343 15344 if (wdev->iftype != NL80211_IFTYPE_AP && 15345 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15346 return -EINVAL; 15347 15348 if (wdev->ap_unexpected_nlportid) 15349 return -EBUSY; 15350 15351 wdev->ap_unexpected_nlportid = info->snd_portid; 15352 return 0; 15353 } 15354 15355 static int nl80211_probe_client(struct sk_buff *skb, 15356 struct genl_info *info) 15357 { 15358 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15359 struct net_device *dev = info->user_ptr[1]; 15360 struct wireless_dev *wdev = dev->ieee80211_ptr; 15361 struct sk_buff *msg; 15362 void *hdr; 15363 const u8 *addr; 15364 u64 cookie; 15365 int err; 15366 15367 if (wdev->iftype != NL80211_IFTYPE_AP && 15368 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15369 return -EOPNOTSUPP; 15370 15371 if (!info->attrs[NL80211_ATTR_MAC]) 15372 return -EINVAL; 15373 15374 if (!rdev->ops->probe_client) 15375 return -EOPNOTSUPP; 15376 15377 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15378 if (!msg) 15379 return -ENOMEM; 15380 15381 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15382 NL80211_CMD_PROBE_CLIENT); 15383 if (!hdr) { 15384 err = -ENOBUFS; 15385 goto free_msg; 15386 } 15387 15388 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15389 15390 err = rdev_probe_client(rdev, dev, addr, &cookie); 15391 if (err) 15392 goto free_msg; 15393 15394 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 15395 NL80211_ATTR_PAD)) 15396 goto nla_put_failure; 15397 15398 genlmsg_end(msg, hdr); 15399 15400 return genlmsg_reply(msg, info); 15401 15402 nla_put_failure: 15403 err = -ENOBUFS; 15404 free_msg: 15405 nlmsg_free(msg); 15406 return err; 15407 } 15408 15409 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info) 15410 { 15411 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15412 struct cfg80211_beacon_registration *reg, *nreg; 15413 int rv; 15414 15415 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS)) 15416 return -EOPNOTSUPP; 15417 15418 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL); 15419 if (!nreg) 15420 return -ENOMEM; 15421 15422 /* First, check if already registered. */ 15423 spin_lock_bh(&rdev->beacon_registrations_lock); 15424 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 15425 if (reg->nlportid == info->snd_portid) { 15426 rv = -EALREADY; 15427 goto out_err; 15428 } 15429 } 15430 /* Add it to the list */ 15431 nreg->nlportid = info->snd_portid; 15432 list_add(&nreg->list, &rdev->beacon_registrations); 15433 15434 spin_unlock_bh(&rdev->beacon_registrations_lock); 15435 15436 return 0; 15437 out_err: 15438 spin_unlock_bh(&rdev->beacon_registrations_lock); 15439 kfree(nreg); 15440 return rv; 15441 } 15442 15443 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info) 15444 { 15445 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15446 struct wireless_dev *wdev = info->user_ptr[1]; 15447 int err; 15448 15449 if (!rdev->ops->start_p2p_device) 15450 return -EOPNOTSUPP; 15451 15452 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 15453 return -EOPNOTSUPP; 15454 15455 if (wdev_running(wdev)) 15456 return 0; 15457 15458 if (rfkill_blocked(rdev->wiphy.rfkill)) 15459 return -ERFKILL; 15460 15461 err = rdev_start_p2p_device(rdev, wdev); 15462 if (err) 15463 return err; 15464 15465 wdev->is_running = true; 15466 rdev->opencount++; 15467 15468 return 0; 15469 } 15470 15471 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info) 15472 { 15473 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15474 struct wireless_dev *wdev = info->user_ptr[1]; 15475 15476 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 15477 return -EOPNOTSUPP; 15478 15479 if (!rdev->ops->stop_p2p_device) 15480 return -EOPNOTSUPP; 15481 15482 cfg80211_stop_p2p_device(rdev, wdev); 15483 15484 return 0; 15485 } 15486 15487 static struct ieee80211_channel *nl80211_get_nan_channel(struct wiphy *wiphy, 15488 int freq) 15489 { 15490 struct ieee80211_channel *chan; 15491 struct cfg80211_chan_def def; 15492 15493 /* Check if the frequency is valid for NAN */ 15494 if (freq != 5220 && freq != 5745 && freq != 2437) 15495 return NULL; 15496 15497 chan = ieee80211_get_channel(wiphy, freq); 15498 if (!chan) 15499 return NULL; 15500 15501 cfg80211_chandef_create(&def, chan, NL80211_CHAN_NO_HT); 15502 15503 /* Check if the channel is allowed */ 15504 if (cfg80211_reg_can_beacon(wiphy, &def, NL80211_IFTYPE_NAN)) 15505 return chan; 15506 15507 return NULL; 15508 } 15509 15510 static int nl80211_parse_nan_band_config(struct wiphy *wiphy, 15511 struct nlattr **tb, 15512 struct cfg80211_nan_band_config *cfg, 15513 enum nl80211_band band) 15514 { 15515 if (BIT(band) & ~(u32)wiphy->nan_supported_bands) 15516 return -EINVAL; 15517 15518 if (tb[NL80211_NAN_BAND_CONF_FREQ]) { 15519 u16 freq = nla_get_u16(tb[NL80211_NAN_BAND_CONF_FREQ]); 15520 15521 if (band != NL80211_BAND_5GHZ) 15522 return -EINVAL; 15523 15524 cfg->chan = nl80211_get_nan_channel(wiphy, freq); 15525 if (!cfg->chan) 15526 return -EINVAL; 15527 } 15528 15529 if (tb[NL80211_NAN_BAND_CONF_RSSI_CLOSE]) { 15530 cfg->rssi_close = 15531 nla_get_s8(tb[NL80211_NAN_BAND_CONF_RSSI_CLOSE]); 15532 if (!tb[NL80211_NAN_BAND_CONF_RSSI_MIDDLE]) 15533 return -EINVAL; 15534 } 15535 15536 if (tb[NL80211_NAN_BAND_CONF_RSSI_MIDDLE]) { 15537 cfg->rssi_middle = 15538 nla_get_s8(tb[NL80211_NAN_BAND_CONF_RSSI_MIDDLE]); 15539 if (!cfg->rssi_close || cfg->rssi_middle >= cfg->rssi_close) 15540 return -EINVAL; 15541 } 15542 15543 if (tb[NL80211_NAN_BAND_CONF_WAKE_DW]) { 15544 cfg->awake_dw_interval = 15545 nla_get_u8(tb[NL80211_NAN_BAND_CONF_WAKE_DW]); 15546 15547 if (band == NL80211_BAND_2GHZ && cfg->awake_dw_interval == 0) 15548 return -EINVAL; 15549 } 15550 15551 cfg->disable_scan = 15552 nla_get_flag(tb[NL80211_NAN_BAND_CONF_DISABLE_SCAN]); 15553 return 0; 15554 } 15555 15556 static int nl80211_parse_nan_conf(struct wiphy *wiphy, 15557 struct genl_info *info, 15558 struct cfg80211_nan_conf *conf, 15559 u32 *changed_flags) 15560 { 15561 struct nlattr *attrs[NL80211_NAN_CONF_ATTR_MAX + 1]; 15562 int err, rem; 15563 u32 changed = 0; 15564 struct nlattr *band_config; 15565 15566 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) { 15567 conf->master_pref = 15568 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 15569 15570 changed |= CFG80211_NAN_CONF_CHANGED_PREF; 15571 } 15572 15573 if (info->attrs[NL80211_ATTR_BANDS]) { 15574 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 15575 15576 if (bands & ~(u32)wiphy->nan_supported_bands) 15577 return -EOPNOTSUPP; 15578 15579 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 15580 return -EINVAL; 15581 15582 conf->bands = bands; 15583 changed |= CFG80211_NAN_CONF_CHANGED_BANDS; 15584 } 15585 15586 conf->band_cfgs[NL80211_BAND_2GHZ].awake_dw_interval = 1; 15587 if (conf->bands & BIT(NL80211_BAND_5GHZ) || !conf->bands) 15588 conf->band_cfgs[NL80211_BAND_5GHZ].awake_dw_interval = 1; 15589 15590 /* On 2.4 GHz band use channel 6 */ 15591 conf->band_cfgs[NL80211_BAND_2GHZ].chan = 15592 nl80211_get_nan_channel(wiphy, 2437); 15593 if (!conf->band_cfgs[NL80211_BAND_2GHZ].chan) 15594 return -EINVAL; 15595 15596 if (!info->attrs[NL80211_ATTR_NAN_CONFIG]) 15597 goto out; 15598 15599 err = nla_parse_nested(attrs, NL80211_NAN_CONF_ATTR_MAX, 15600 info->attrs[NL80211_ATTR_NAN_CONFIG], NULL, 15601 info->extack); 15602 if (err) 15603 return err; 15604 15605 changed |= CFG80211_NAN_CONF_CHANGED_CONFIG; 15606 if (attrs[NL80211_NAN_CONF_CLUSTER_ID]) 15607 conf->cluster_id = 15608 nla_data(attrs[NL80211_NAN_CONF_CLUSTER_ID]); 15609 15610 if (attrs[NL80211_NAN_CONF_EXTRA_ATTRS]) { 15611 conf->extra_nan_attrs = 15612 nla_data(attrs[NL80211_NAN_CONF_EXTRA_ATTRS]); 15613 conf->extra_nan_attrs_len = 15614 nla_len(attrs[NL80211_NAN_CONF_EXTRA_ATTRS]); 15615 } 15616 15617 if (attrs[NL80211_NAN_CONF_VENDOR_ELEMS]) { 15618 conf->vendor_elems = 15619 nla_data(attrs[NL80211_NAN_CONF_VENDOR_ELEMS]); 15620 conf->vendor_elems_len = 15621 nla_len(attrs[NL80211_NAN_CONF_VENDOR_ELEMS]); 15622 } 15623 15624 if (attrs[NL80211_NAN_CONF_BAND_CONFIGS]) { 15625 nla_for_each_nested(band_config, 15626 attrs[NL80211_NAN_CONF_BAND_CONFIGS], 15627 rem) { 15628 enum nl80211_band band; 15629 struct cfg80211_nan_band_config *cfg; 15630 struct nlattr *tb[NL80211_NAN_BAND_CONF_ATTR_MAX + 1]; 15631 15632 err = nla_parse_nested(tb, 15633 NL80211_NAN_BAND_CONF_ATTR_MAX, 15634 band_config, NULL, 15635 info->extack); 15636 if (err) 15637 return err; 15638 15639 if (!tb[NL80211_NAN_BAND_CONF_BAND]) 15640 return -EINVAL; 15641 15642 band = nla_get_u8(tb[NL80211_NAN_BAND_CONF_BAND]); 15643 if (conf->bands && !(conf->bands & BIT(band))) 15644 return -EINVAL; 15645 15646 cfg = &conf->band_cfgs[band]; 15647 15648 err = nl80211_parse_nan_band_config(wiphy, tb, cfg, 15649 band); 15650 if (err) 15651 return err; 15652 } 15653 } 15654 15655 if (attrs[NL80211_NAN_CONF_SCAN_PERIOD]) 15656 conf->scan_period = 15657 nla_get_u16(attrs[NL80211_NAN_CONF_SCAN_PERIOD]); 15658 15659 if (attrs[NL80211_NAN_CONF_SCAN_DWELL_TIME]) 15660 conf->scan_dwell_time = 15661 nla_get_u16(attrs[NL80211_NAN_CONF_SCAN_DWELL_TIME]); 15662 15663 if (attrs[NL80211_NAN_CONF_DISCOVERY_BEACON_INTERVAL]) 15664 conf->discovery_beacon_interval = 15665 nla_get_u8(attrs[NL80211_NAN_CONF_DISCOVERY_BEACON_INTERVAL]); 15666 15667 if (attrs[NL80211_NAN_CONF_NOTIFY_DW]) 15668 conf->enable_dw_notification = 15669 nla_get_flag(attrs[NL80211_NAN_CONF_NOTIFY_DW]); 15670 15671 out: 15672 if (!conf->band_cfgs[NL80211_BAND_5GHZ].chan && 15673 (!conf->bands || conf->bands & BIT(NL80211_BAND_5GHZ))) { 15674 /* If no 5GHz channel is specified use default, if possible */ 15675 conf->band_cfgs[NL80211_BAND_5GHZ].chan = 15676 nl80211_get_nan_channel(wiphy, 5745); 15677 if (!conf->band_cfgs[NL80211_BAND_5GHZ].chan) 15678 conf->band_cfgs[NL80211_BAND_5GHZ].chan = 15679 nl80211_get_nan_channel(wiphy, 5220); 15680 15681 /* Return error if user space asked explicitly for 5 GHz */ 15682 if (!conf->band_cfgs[NL80211_BAND_5GHZ].chan && 15683 conf->bands & BIT(NL80211_BAND_5GHZ)) { 15684 NL_SET_ERR_MSG_ATTR(info->extack, 15685 info->attrs[NL80211_ATTR_BANDS], 15686 "5 GHz band operation is not allowed"); 15687 return -EINVAL; 15688 } 15689 } 15690 15691 if (changed_flags) 15692 *changed_flags = changed; 15693 15694 return 0; 15695 } 15696 15697 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info) 15698 { 15699 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15700 struct wireless_dev *wdev = info->user_ptr[1]; 15701 struct cfg80211_nan_conf conf = {}; 15702 int err; 15703 15704 if (wdev->iftype != NL80211_IFTYPE_NAN) 15705 return -EOPNOTSUPP; 15706 15707 if (wdev_running(wdev)) 15708 return -EEXIST; 15709 15710 if (rfkill_blocked(rdev->wiphy.rfkill)) 15711 return -ERFKILL; 15712 15713 /* Master preference is mandatory for START_NAN */ 15714 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) 15715 return -EINVAL; 15716 15717 err = nl80211_parse_nan_conf(&rdev->wiphy, info, &conf, NULL); 15718 if (err) 15719 return err; 15720 15721 err = rdev_start_nan(rdev, wdev, &conf); 15722 if (err) 15723 return err; 15724 15725 wdev->is_running = true; 15726 rdev->opencount++; 15727 15728 return 0; 15729 } 15730 15731 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info) 15732 { 15733 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15734 struct wireless_dev *wdev = info->user_ptr[1]; 15735 15736 if (wdev->iftype != NL80211_IFTYPE_NAN) 15737 return -EOPNOTSUPP; 15738 15739 cfg80211_stop_nan(rdev, wdev); 15740 15741 return 0; 15742 } 15743 15744 static int validate_nan_filter(struct nlattr *filter_attr) 15745 { 15746 struct nlattr *attr; 15747 int len = 0, n_entries = 0, rem; 15748 15749 nla_for_each_nested(attr, filter_attr, rem) { 15750 len += nla_len(attr); 15751 n_entries++; 15752 } 15753 15754 if (len >= U8_MAX) 15755 return -EINVAL; 15756 15757 return n_entries; 15758 } 15759 15760 static int handle_nan_filter(struct nlattr *attr_filter, 15761 struct cfg80211_nan_func *func, 15762 bool tx) 15763 { 15764 struct nlattr *attr; 15765 int n_entries, rem, i; 15766 struct cfg80211_nan_func_filter *filter; 15767 15768 n_entries = validate_nan_filter(attr_filter); 15769 if (n_entries < 0) 15770 return n_entries; 15771 15772 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters)); 15773 15774 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL); 15775 if (!filter) 15776 return -ENOMEM; 15777 15778 i = 0; 15779 nla_for_each_nested(attr, attr_filter, rem) { 15780 filter[i].filter = nla_memdup(attr, GFP_KERNEL); 15781 if (!filter[i].filter) 15782 goto err; 15783 15784 filter[i].len = nla_len(attr); 15785 i++; 15786 } 15787 if (tx) { 15788 func->num_tx_filters = n_entries; 15789 func->tx_filters = filter; 15790 } else { 15791 func->num_rx_filters = n_entries; 15792 func->rx_filters = filter; 15793 } 15794 15795 return 0; 15796 15797 err: 15798 i = 0; 15799 nla_for_each_nested(attr, attr_filter, rem) { 15800 kfree(filter[i].filter); 15801 i++; 15802 } 15803 kfree(filter); 15804 return -ENOMEM; 15805 } 15806 15807 static int nl80211_nan_add_func(struct sk_buff *skb, 15808 struct genl_info *info) 15809 { 15810 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15811 struct wireless_dev *wdev = info->user_ptr[1]; 15812 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr; 15813 struct cfg80211_nan_func *func; 15814 struct sk_buff *msg = NULL; 15815 void *hdr = NULL; 15816 int err = 0; 15817 15818 if (wdev->iftype != NL80211_IFTYPE_NAN) 15819 return -EOPNOTSUPP; 15820 15821 if (!wdev_running(wdev)) 15822 return -ENOTCONN; 15823 15824 if (!info->attrs[NL80211_ATTR_NAN_FUNC]) 15825 return -EINVAL; 15826 15827 err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX, 15828 info->attrs[NL80211_ATTR_NAN_FUNC], 15829 nl80211_nan_func_policy, 15830 info->extack); 15831 if (err) 15832 return err; 15833 15834 func = kzalloc(sizeof(*func), GFP_KERNEL); 15835 if (!func) 15836 return -ENOMEM; 15837 15838 func->cookie = cfg80211_assign_cookie(rdev); 15839 15840 if (!tb[NL80211_NAN_FUNC_TYPE]) { 15841 err = -EINVAL; 15842 goto out; 15843 } 15844 15845 15846 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]); 15847 15848 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) { 15849 err = -EINVAL; 15850 goto out; 15851 } 15852 15853 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]), 15854 sizeof(func->service_id)); 15855 15856 func->close_range = 15857 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]); 15858 15859 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) { 15860 func->serv_spec_info_len = 15861 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]); 15862 func->serv_spec_info = 15863 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]), 15864 func->serv_spec_info_len, 15865 GFP_KERNEL); 15866 if (!func->serv_spec_info) { 15867 err = -ENOMEM; 15868 goto out; 15869 } 15870 } 15871 15872 if (tb[NL80211_NAN_FUNC_TTL]) 15873 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]); 15874 15875 switch (func->type) { 15876 case NL80211_NAN_FUNC_PUBLISH: 15877 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) { 15878 err = -EINVAL; 15879 goto out; 15880 } 15881 15882 func->publish_type = 15883 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]); 15884 func->publish_bcast = 15885 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]); 15886 15887 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) && 15888 func->publish_bcast) { 15889 err = -EINVAL; 15890 goto out; 15891 } 15892 break; 15893 case NL80211_NAN_FUNC_SUBSCRIBE: 15894 func->subscribe_active = 15895 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]); 15896 break; 15897 case NL80211_NAN_FUNC_FOLLOW_UP: 15898 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] || 15899 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] || 15900 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) { 15901 err = -EINVAL; 15902 goto out; 15903 } 15904 15905 func->followup_id = 15906 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]); 15907 func->followup_reqid = 15908 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]); 15909 memcpy(func->followup_dest.addr, 15910 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]), 15911 sizeof(func->followup_dest.addr)); 15912 if (func->ttl) { 15913 err = -EINVAL; 15914 goto out; 15915 } 15916 break; 15917 default: 15918 err = -EINVAL; 15919 goto out; 15920 } 15921 15922 if (tb[NL80211_NAN_FUNC_SRF]) { 15923 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR]; 15924 15925 err = nla_parse_nested_deprecated(srf_tb, 15926 NL80211_NAN_SRF_ATTR_MAX, 15927 tb[NL80211_NAN_FUNC_SRF], 15928 nl80211_nan_srf_policy, 15929 info->extack); 15930 if (err) 15931 goto out; 15932 15933 func->srf_include = 15934 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]); 15935 15936 if (srf_tb[NL80211_NAN_SRF_BF]) { 15937 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] || 15938 !srf_tb[NL80211_NAN_SRF_BF_IDX]) { 15939 err = -EINVAL; 15940 goto out; 15941 } 15942 15943 func->srf_bf_len = 15944 nla_len(srf_tb[NL80211_NAN_SRF_BF]); 15945 func->srf_bf = 15946 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]), 15947 func->srf_bf_len, GFP_KERNEL); 15948 if (!func->srf_bf) { 15949 err = -ENOMEM; 15950 goto out; 15951 } 15952 15953 func->srf_bf_idx = 15954 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]); 15955 } else { 15956 struct nlattr *attr, *mac_attr = 15957 srf_tb[NL80211_NAN_SRF_MAC_ADDRS]; 15958 int n_entries, rem, i = 0; 15959 15960 if (!mac_attr) { 15961 err = -EINVAL; 15962 goto out; 15963 } 15964 15965 n_entries = validate_acl_mac_addrs(mac_attr); 15966 if (n_entries <= 0) { 15967 err = -EINVAL; 15968 goto out; 15969 } 15970 15971 func->srf_num_macs = n_entries; 15972 func->srf_macs = 15973 kcalloc(n_entries, sizeof(*func->srf_macs), 15974 GFP_KERNEL); 15975 if (!func->srf_macs) { 15976 err = -ENOMEM; 15977 goto out; 15978 } 15979 15980 nla_for_each_nested(attr, mac_attr, rem) 15981 memcpy(func->srf_macs[i++].addr, nla_data(attr), 15982 sizeof(*func->srf_macs)); 15983 } 15984 } 15985 15986 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) { 15987 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER], 15988 func, true); 15989 if (err) 15990 goto out; 15991 } 15992 15993 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) { 15994 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER], 15995 func, false); 15996 if (err) 15997 goto out; 15998 } 15999 16000 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 16001 if (!msg) { 16002 err = -ENOMEM; 16003 goto out; 16004 } 16005 16006 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 16007 NL80211_CMD_ADD_NAN_FUNCTION); 16008 /* This can't really happen - we just allocated 4KB */ 16009 if (WARN_ON(!hdr)) { 16010 err = -ENOMEM; 16011 goto out; 16012 } 16013 16014 err = rdev_add_nan_func(rdev, wdev, func); 16015 out: 16016 if (err < 0) { 16017 cfg80211_free_nan_func(func); 16018 nlmsg_free(msg); 16019 return err; 16020 } 16021 16022 /* propagate the instance id and cookie to userspace */ 16023 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie, 16024 NL80211_ATTR_PAD)) 16025 goto nla_put_failure; 16026 16027 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 16028 if (!func_attr) 16029 goto nla_put_failure; 16030 16031 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, 16032 func->instance_id)) 16033 goto nla_put_failure; 16034 16035 nla_nest_end(msg, func_attr); 16036 16037 genlmsg_end(msg, hdr); 16038 return genlmsg_reply(msg, info); 16039 16040 nla_put_failure: 16041 nlmsg_free(msg); 16042 return -ENOBUFS; 16043 } 16044 16045 static int nl80211_nan_del_func(struct sk_buff *skb, 16046 struct genl_info *info) 16047 { 16048 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16049 struct wireless_dev *wdev = info->user_ptr[1]; 16050 u64 cookie; 16051 16052 if (wdev->iftype != NL80211_IFTYPE_NAN) 16053 return -EOPNOTSUPP; 16054 16055 if (!wdev_running(wdev)) 16056 return -ENOTCONN; 16057 16058 if (!info->attrs[NL80211_ATTR_COOKIE]) 16059 return -EINVAL; 16060 16061 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 16062 16063 rdev_del_nan_func(rdev, wdev, cookie); 16064 16065 return 0; 16066 } 16067 16068 static int nl80211_nan_change_config(struct sk_buff *skb, 16069 struct genl_info *info) 16070 { 16071 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16072 struct wireless_dev *wdev = info->user_ptr[1]; 16073 struct cfg80211_nan_conf conf = {}; 16074 u32 changed = 0; 16075 int err; 16076 16077 if (wdev->iftype != NL80211_IFTYPE_NAN) 16078 return -EOPNOTSUPP; 16079 16080 if (!wdev_running(wdev)) 16081 return -ENOTCONN; 16082 16083 err = nl80211_parse_nan_conf(&rdev->wiphy, info, &conf, &changed); 16084 if (err) 16085 return err; 16086 16087 if (!changed) 16088 return -EINVAL; 16089 16090 return rdev_nan_change_conf(rdev, wdev, &conf, changed); 16091 } 16092 16093 void cfg80211_nan_match(struct wireless_dev *wdev, 16094 struct cfg80211_nan_match_params *match, gfp_t gfp) 16095 { 16096 struct wiphy *wiphy = wdev->wiphy; 16097 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16098 struct nlattr *match_attr, *local_func_attr, *peer_func_attr; 16099 struct sk_buff *msg; 16100 void *hdr; 16101 16102 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr)) 16103 return; 16104 16105 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16106 if (!msg) 16107 return; 16108 16109 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH); 16110 if (!hdr) { 16111 nlmsg_free(msg); 16112 return; 16113 } 16114 16115 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16116 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 16117 wdev->netdev->ifindex)) || 16118 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 16119 NL80211_ATTR_PAD)) 16120 goto nla_put_failure; 16121 16122 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie, 16123 NL80211_ATTR_PAD) || 16124 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr)) 16125 goto nla_put_failure; 16126 16127 match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH); 16128 if (!match_attr) 16129 goto nla_put_failure; 16130 16131 local_func_attr = nla_nest_start_noflag(msg, 16132 NL80211_NAN_MATCH_FUNC_LOCAL); 16133 if (!local_func_attr) 16134 goto nla_put_failure; 16135 16136 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id)) 16137 goto nla_put_failure; 16138 16139 nla_nest_end(msg, local_func_attr); 16140 16141 peer_func_attr = nla_nest_start_noflag(msg, 16142 NL80211_NAN_MATCH_FUNC_PEER); 16143 if (!peer_func_attr) 16144 goto nla_put_failure; 16145 16146 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) || 16147 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id)) 16148 goto nla_put_failure; 16149 16150 if (match->info && match->info_len && 16151 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len, 16152 match->info)) 16153 goto nla_put_failure; 16154 16155 nla_nest_end(msg, peer_func_attr); 16156 nla_nest_end(msg, match_attr); 16157 genlmsg_end(msg, hdr); 16158 16159 if (!wdev->owner_nlportid) 16160 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 16161 msg, 0, NL80211_MCGRP_NAN, gfp); 16162 else 16163 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 16164 wdev->owner_nlportid); 16165 16166 return; 16167 16168 nla_put_failure: 16169 nlmsg_free(msg); 16170 } 16171 EXPORT_SYMBOL(cfg80211_nan_match); 16172 16173 void cfg80211_nan_func_terminated(struct wireless_dev *wdev, 16174 u8 inst_id, 16175 enum nl80211_nan_func_term_reason reason, 16176 u64 cookie, gfp_t gfp) 16177 { 16178 struct wiphy *wiphy = wdev->wiphy; 16179 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16180 struct sk_buff *msg; 16181 struct nlattr *func_attr; 16182 void *hdr; 16183 16184 if (WARN_ON(!inst_id)) 16185 return; 16186 16187 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 16188 if (!msg) 16189 return; 16190 16191 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION); 16192 if (!hdr) { 16193 nlmsg_free(msg); 16194 return; 16195 } 16196 16197 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16198 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 16199 wdev->netdev->ifindex)) || 16200 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 16201 NL80211_ATTR_PAD)) 16202 goto nla_put_failure; 16203 16204 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 16205 NL80211_ATTR_PAD)) 16206 goto nla_put_failure; 16207 16208 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 16209 if (!func_attr) 16210 goto nla_put_failure; 16211 16212 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) || 16213 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason)) 16214 goto nla_put_failure; 16215 16216 nla_nest_end(msg, func_attr); 16217 genlmsg_end(msg, hdr); 16218 16219 if (!wdev->owner_nlportid) 16220 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 16221 msg, 0, NL80211_MCGRP_NAN, gfp); 16222 else 16223 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 16224 wdev->owner_nlportid); 16225 16226 return; 16227 16228 nla_put_failure: 16229 nlmsg_free(msg); 16230 } 16231 EXPORT_SYMBOL(cfg80211_nan_func_terminated); 16232 16233 static int nl80211_get_protocol_features(struct sk_buff *skb, 16234 struct genl_info *info) 16235 { 16236 void *hdr; 16237 struct sk_buff *msg; 16238 16239 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 16240 if (!msg) 16241 return -ENOMEM; 16242 16243 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 16244 NL80211_CMD_GET_PROTOCOL_FEATURES); 16245 if (!hdr) 16246 goto nla_put_failure; 16247 16248 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES, 16249 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP)) 16250 goto nla_put_failure; 16251 16252 genlmsg_end(msg, hdr); 16253 return genlmsg_reply(msg, info); 16254 16255 nla_put_failure: 16256 kfree_skb(msg); 16257 return -ENOBUFS; 16258 } 16259 16260 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info) 16261 { 16262 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16263 struct cfg80211_update_ft_ies_params ft_params; 16264 struct net_device *dev = info->user_ptr[1]; 16265 16266 if (!rdev->ops->update_ft_ies) 16267 return -EOPNOTSUPP; 16268 16269 if (!info->attrs[NL80211_ATTR_MDID] || 16270 !info->attrs[NL80211_ATTR_IE]) 16271 return -EINVAL; 16272 16273 memset(&ft_params, 0, sizeof(ft_params)); 16274 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]); 16275 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 16276 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 16277 16278 return rdev_update_ft_ies(rdev, dev, &ft_params); 16279 } 16280 16281 static int nl80211_crit_protocol_start(struct sk_buff *skb, 16282 struct genl_info *info) 16283 { 16284 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16285 struct wireless_dev *wdev = info->user_ptr[1]; 16286 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC; 16287 u16 duration; 16288 int ret; 16289 16290 if (!rdev->ops->crit_proto_start) 16291 return -EOPNOTSUPP; 16292 16293 if (WARN_ON(!rdev->ops->crit_proto_stop)) 16294 return -EINVAL; 16295 16296 if (rdev->crit_proto_nlportid) 16297 return -EBUSY; 16298 16299 /* determine protocol if provided */ 16300 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID]) 16301 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]); 16302 16303 if (proto >= NUM_NL80211_CRIT_PROTO) 16304 return -EINVAL; 16305 16306 /* timeout must be provided */ 16307 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]) 16308 return -EINVAL; 16309 16310 duration = 16311 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]); 16312 16313 ret = rdev_crit_proto_start(rdev, wdev, proto, duration); 16314 if (!ret) 16315 rdev->crit_proto_nlportid = info->snd_portid; 16316 16317 return ret; 16318 } 16319 16320 static int nl80211_crit_protocol_stop(struct sk_buff *skb, 16321 struct genl_info *info) 16322 { 16323 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16324 struct wireless_dev *wdev = info->user_ptr[1]; 16325 16326 if (!rdev->ops->crit_proto_stop) 16327 return -EOPNOTSUPP; 16328 16329 if (rdev->crit_proto_nlportid) { 16330 rdev->crit_proto_nlportid = 0; 16331 rdev_crit_proto_stop(rdev, wdev); 16332 } 16333 return 0; 16334 } 16335 16336 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd, 16337 struct nlattr *attr, 16338 struct netlink_ext_ack *extack) 16339 { 16340 if (vcmd->policy == VENDOR_CMD_RAW_DATA) { 16341 if (attr->nla_type & NLA_F_NESTED) { 16342 NL_SET_ERR_MSG_ATTR(extack, attr, 16343 "unexpected nested data"); 16344 return -EINVAL; 16345 } 16346 16347 return 0; 16348 } 16349 16350 if (!(attr->nla_type & NLA_F_NESTED)) { 16351 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data"); 16352 return -EINVAL; 16353 } 16354 16355 return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack); 16356 } 16357 16358 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info) 16359 { 16360 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16361 struct wireless_dev *wdev = 16362 __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 16363 info->attrs); 16364 int i, err; 16365 u32 vid, subcmd; 16366 16367 if (!rdev->wiphy.vendor_commands) 16368 return -EOPNOTSUPP; 16369 16370 if (IS_ERR(wdev)) { 16371 err = PTR_ERR(wdev); 16372 if (err != -EINVAL) 16373 return err; 16374 wdev = NULL; 16375 } else if (wdev->wiphy != &rdev->wiphy) { 16376 return -EINVAL; 16377 } 16378 16379 if (!info->attrs[NL80211_ATTR_VENDOR_ID] || 16380 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD]) 16381 return -EINVAL; 16382 16383 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]); 16384 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]); 16385 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 16386 const struct wiphy_vendor_command *vcmd; 16387 void *data = NULL; 16388 int len = 0; 16389 16390 vcmd = &rdev->wiphy.vendor_commands[i]; 16391 16392 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 16393 continue; 16394 16395 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 16396 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 16397 if (!wdev) 16398 return -EINVAL; 16399 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 16400 !wdev->netdev) 16401 return -EINVAL; 16402 16403 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 16404 if (!wdev_running(wdev)) 16405 return -ENETDOWN; 16406 } 16407 } else { 16408 wdev = NULL; 16409 } 16410 16411 if (!vcmd->doit) 16412 return -EOPNOTSUPP; 16413 16414 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) { 16415 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]); 16416 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]); 16417 16418 err = nl80211_vendor_check_policy(vcmd, 16419 info->attrs[NL80211_ATTR_VENDOR_DATA], 16420 info->extack); 16421 if (err) 16422 return err; 16423 } 16424 16425 rdev->cur_cmd_info = info; 16426 err = vcmd->doit(&rdev->wiphy, wdev, data, len); 16427 rdev->cur_cmd_info = NULL; 16428 return err; 16429 } 16430 16431 return -EOPNOTSUPP; 16432 } 16433 16434 static int nl80211_prepare_vendor_dump(struct sk_buff *skb, 16435 struct netlink_callback *cb, 16436 struct cfg80211_registered_device **rdev, 16437 struct wireless_dev **wdev) 16438 { 16439 struct nlattr **attrbuf; 16440 u32 vid, subcmd; 16441 unsigned int i; 16442 int vcmd_idx = -1; 16443 int err; 16444 void *data = NULL; 16445 unsigned int data_len = 0; 16446 16447 if (cb->args[0]) { 16448 /* subtract the 1 again here */ 16449 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 16450 struct wireless_dev *tmp; 16451 16452 if (!wiphy) 16453 return -ENODEV; 16454 *rdev = wiphy_to_rdev(wiphy); 16455 *wdev = NULL; 16456 16457 if (cb->args[1]) { 16458 list_for_each_entry(tmp, &wiphy->wdev_list, list) { 16459 if (tmp->identifier == cb->args[1] - 1) { 16460 *wdev = tmp; 16461 break; 16462 } 16463 } 16464 } 16465 16466 /* keep rtnl locked in successful case */ 16467 return 0; 16468 } 16469 16470 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 16471 if (!attrbuf) 16472 return -ENOMEM; 16473 16474 err = nlmsg_parse_deprecated(cb->nlh, 16475 GENL_HDRLEN + nl80211_fam.hdrsize, 16476 attrbuf, nl80211_fam.maxattr, 16477 nl80211_policy, NULL); 16478 if (err) 16479 goto out; 16480 16481 if (!attrbuf[NL80211_ATTR_VENDOR_ID] || 16482 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) { 16483 err = -EINVAL; 16484 goto out; 16485 } 16486 16487 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf); 16488 if (IS_ERR(*wdev)) 16489 *wdev = NULL; 16490 16491 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 16492 if (IS_ERR(*rdev)) { 16493 err = PTR_ERR(*rdev); 16494 goto out; 16495 } 16496 16497 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]); 16498 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]); 16499 16500 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) { 16501 const struct wiphy_vendor_command *vcmd; 16502 16503 vcmd = &(*rdev)->wiphy.vendor_commands[i]; 16504 16505 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 16506 continue; 16507 16508 if (!vcmd->dumpit) { 16509 err = -EOPNOTSUPP; 16510 goto out; 16511 } 16512 16513 vcmd_idx = i; 16514 break; 16515 } 16516 16517 if (vcmd_idx < 0) { 16518 err = -EOPNOTSUPP; 16519 goto out; 16520 } 16521 16522 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) { 16523 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]); 16524 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]); 16525 16526 err = nl80211_vendor_check_policy( 16527 &(*rdev)->wiphy.vendor_commands[vcmd_idx], 16528 attrbuf[NL80211_ATTR_VENDOR_DATA], 16529 cb->extack); 16530 if (err) 16531 goto out; 16532 } 16533 16534 /* 0 is the first index - add 1 to parse only once */ 16535 cb->args[0] = (*rdev)->wiphy_idx + 1; 16536 /* add 1 to know if it was NULL */ 16537 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0; 16538 cb->args[2] = vcmd_idx; 16539 cb->args[3] = (unsigned long)data; 16540 cb->args[4] = data_len; 16541 16542 /* keep rtnl locked in successful case */ 16543 err = 0; 16544 out: 16545 kfree(attrbuf); 16546 return err; 16547 } 16548 16549 static int nl80211_vendor_cmd_dump(struct sk_buff *skb, 16550 struct netlink_callback *cb) 16551 { 16552 struct cfg80211_registered_device *rdev; 16553 struct wireless_dev *wdev; 16554 unsigned int vcmd_idx; 16555 const struct wiphy_vendor_command *vcmd; 16556 void *data; 16557 int data_len; 16558 int err; 16559 struct nlattr *vendor_data; 16560 16561 rtnl_lock(); 16562 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev); 16563 if (err) 16564 goto out; 16565 16566 vcmd_idx = cb->args[2]; 16567 data = (void *)cb->args[3]; 16568 data_len = cb->args[4]; 16569 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx]; 16570 16571 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 16572 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 16573 if (!wdev) { 16574 err = -EINVAL; 16575 goto out; 16576 } 16577 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 16578 !wdev->netdev) { 16579 err = -EINVAL; 16580 goto out; 16581 } 16582 16583 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 16584 if (!wdev_running(wdev)) { 16585 err = -ENETDOWN; 16586 goto out; 16587 } 16588 } 16589 } 16590 16591 while (1) { 16592 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 16593 cb->nlh->nlmsg_seq, NLM_F_MULTI, 16594 NL80211_CMD_VENDOR); 16595 if (!hdr) 16596 break; 16597 16598 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16599 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 16600 wdev_id(wdev), 16601 NL80211_ATTR_PAD))) { 16602 genlmsg_cancel(skb, hdr); 16603 break; 16604 } 16605 16606 vendor_data = nla_nest_start_noflag(skb, 16607 NL80211_ATTR_VENDOR_DATA); 16608 if (!vendor_data) { 16609 genlmsg_cancel(skb, hdr); 16610 break; 16611 } 16612 16613 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len, 16614 (unsigned long *)&cb->args[5]); 16615 nla_nest_end(skb, vendor_data); 16616 16617 if (err == -ENOBUFS || err == -ENOENT) { 16618 genlmsg_cancel(skb, hdr); 16619 break; 16620 } else if (err <= 0) { 16621 genlmsg_cancel(skb, hdr); 16622 goto out; 16623 } 16624 16625 genlmsg_end(skb, hdr); 16626 } 16627 16628 err = skb->len; 16629 out: 16630 rtnl_unlock(); 16631 return err; 16632 } 16633 16634 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy, 16635 enum nl80211_commands cmd, 16636 enum nl80211_attrs attr, 16637 int approxlen) 16638 { 16639 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16640 16641 if (WARN_ON(!rdev->cur_cmd_info)) 16642 return NULL; 16643 16644 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen, 16645 rdev->cur_cmd_info->snd_portid, 16646 rdev->cur_cmd_info->snd_seq, 16647 cmd, attr, NULL, GFP_KERNEL); 16648 } 16649 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb); 16650 16651 int cfg80211_vendor_cmd_reply(struct sk_buff *skb) 16652 { 16653 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 16654 void *hdr = ((void **)skb->cb)[1]; 16655 struct nlattr *data = ((void **)skb->cb)[2]; 16656 16657 /* clear CB data for netlink core to own from now on */ 16658 memset(skb->cb, 0, sizeof(skb->cb)); 16659 16660 if (WARN_ON(!rdev->cur_cmd_info)) { 16661 kfree_skb(skb); 16662 return -EINVAL; 16663 } 16664 16665 nla_nest_end(skb, data); 16666 genlmsg_end(skb, hdr); 16667 return genlmsg_reply(skb, rdev->cur_cmd_info); 16668 } 16669 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply); 16670 16671 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy) 16672 { 16673 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16674 16675 if (WARN_ON(!rdev->cur_cmd_info)) 16676 return 0; 16677 16678 return rdev->cur_cmd_info->snd_portid; 16679 } 16680 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender); 16681 16682 static int nl80211_set_qos_map(struct sk_buff *skb, 16683 struct genl_info *info) 16684 { 16685 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16686 struct cfg80211_qos_map *qos_map = NULL; 16687 struct net_device *dev = info->user_ptr[1]; 16688 u8 *pos, len, num_des, des_len, des; 16689 int ret; 16690 16691 if (!rdev->ops->set_qos_map) 16692 return -EOPNOTSUPP; 16693 16694 if (info->attrs[NL80211_ATTR_QOS_MAP]) { 16695 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]); 16696 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]); 16697 16698 if (len % 2) 16699 return -EINVAL; 16700 16701 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL); 16702 if (!qos_map) 16703 return -ENOMEM; 16704 16705 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1; 16706 if (num_des) { 16707 des_len = num_des * 16708 sizeof(struct cfg80211_dscp_exception); 16709 memcpy(qos_map->dscp_exception, pos, des_len); 16710 qos_map->num_des = num_des; 16711 for (des = 0; des < num_des; des++) { 16712 if (qos_map->dscp_exception[des].up > 7) { 16713 kfree(qos_map); 16714 return -EINVAL; 16715 } 16716 } 16717 pos += des_len; 16718 } 16719 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN); 16720 } 16721 16722 ret = nl80211_key_allowed(dev->ieee80211_ptr); 16723 if (!ret) 16724 ret = rdev_set_qos_map(rdev, dev, qos_map); 16725 16726 kfree(qos_map); 16727 return ret; 16728 } 16729 16730 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info) 16731 { 16732 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16733 struct net_device *dev = info->user_ptr[1]; 16734 struct wireless_dev *wdev = dev->ieee80211_ptr; 16735 const u8 *peer; 16736 u8 tsid, up; 16737 u16 admitted_time = 0; 16738 16739 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)) 16740 return -EOPNOTSUPP; 16741 16742 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] || 16743 !info->attrs[NL80211_ATTR_USER_PRIO]) 16744 return -EINVAL; 16745 16746 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 16747 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]); 16748 16749 /* WMM uses TIDs 0-7 even for TSPEC */ 16750 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) { 16751 /* TODO: handle 802.11 TSPEC/admission control 16752 * need more attributes for that (e.g. BA session requirement); 16753 * change the WMM admission test above to allow both then 16754 */ 16755 return -EINVAL; 16756 } 16757 16758 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 16759 16760 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) { 16761 admitted_time = 16762 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]); 16763 if (!admitted_time) 16764 return -EINVAL; 16765 } 16766 16767 switch (wdev->iftype) { 16768 case NL80211_IFTYPE_STATION: 16769 case NL80211_IFTYPE_P2P_CLIENT: 16770 if (wdev->connected) 16771 break; 16772 return -ENOTCONN; 16773 default: 16774 return -EOPNOTSUPP; 16775 } 16776 16777 return rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time); 16778 } 16779 16780 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info) 16781 { 16782 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16783 struct net_device *dev = info->user_ptr[1]; 16784 const u8 *peer; 16785 u8 tsid; 16786 16787 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC]) 16788 return -EINVAL; 16789 16790 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 16791 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 16792 16793 return rdev_del_tx_ts(rdev, dev, tsid, peer); 16794 } 16795 16796 static int nl80211_tdls_channel_switch(struct sk_buff *skb, 16797 struct genl_info *info) 16798 { 16799 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16800 struct net_device *dev = info->user_ptr[1]; 16801 struct wireless_dev *wdev = dev->ieee80211_ptr; 16802 struct cfg80211_chan_def chandef = {}; 16803 const u8 *addr; 16804 u8 oper_class; 16805 int err; 16806 16807 if (!rdev->ops->tdls_channel_switch || 16808 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 16809 return -EOPNOTSUPP; 16810 16811 switch (dev->ieee80211_ptr->iftype) { 16812 case NL80211_IFTYPE_STATION: 16813 case NL80211_IFTYPE_P2P_CLIENT: 16814 break; 16815 default: 16816 return -EOPNOTSUPP; 16817 } 16818 16819 if (!info->attrs[NL80211_ATTR_MAC] || 16820 !info->attrs[NL80211_ATTR_OPER_CLASS]) 16821 return -EINVAL; 16822 16823 err = nl80211_parse_chandef(rdev, info, &chandef); 16824 if (err) 16825 return err; 16826 16827 /* 16828 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012 16829 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the 16830 * specification is not defined for them. 16831 */ 16832 if (chandef.chan->band == NL80211_BAND_2GHZ && 16833 chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 16834 chandef.width != NL80211_CHAN_WIDTH_20) 16835 return -EINVAL; 16836 16837 /* we will be active on the TDLS link */ 16838 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 16839 wdev->iftype)) 16840 return -EINVAL; 16841 16842 /* don't allow switching to DFS channels */ 16843 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype)) 16844 return -EINVAL; 16845 16846 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16847 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]); 16848 16849 return rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef); 16850 } 16851 16852 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb, 16853 struct genl_info *info) 16854 { 16855 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16856 struct net_device *dev = info->user_ptr[1]; 16857 const u8 *addr; 16858 16859 if (!rdev->ops->tdls_channel_switch || 16860 !rdev->ops->tdls_cancel_channel_switch || 16861 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 16862 return -EOPNOTSUPP; 16863 16864 switch (dev->ieee80211_ptr->iftype) { 16865 case NL80211_IFTYPE_STATION: 16866 case NL80211_IFTYPE_P2P_CLIENT: 16867 break; 16868 default: 16869 return -EOPNOTSUPP; 16870 } 16871 16872 if (!info->attrs[NL80211_ATTR_MAC]) 16873 return -EINVAL; 16874 16875 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16876 16877 rdev_tdls_cancel_channel_switch(rdev, dev, addr); 16878 16879 return 0; 16880 } 16881 16882 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb, 16883 struct genl_info *info) 16884 { 16885 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16886 struct net_device *dev = info->user_ptr[1]; 16887 struct wireless_dev *wdev = dev->ieee80211_ptr; 16888 const struct nlattr *nla; 16889 bool enabled; 16890 16891 if (!rdev->ops->set_multicast_to_unicast) 16892 return -EOPNOTSUPP; 16893 16894 if (wdev->iftype != NL80211_IFTYPE_AP && 16895 wdev->iftype != NL80211_IFTYPE_P2P_GO) 16896 return -EOPNOTSUPP; 16897 16898 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED]; 16899 enabled = nla_get_flag(nla); 16900 16901 return rdev_set_multicast_to_unicast(rdev, dev, enabled); 16902 } 16903 16904 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info) 16905 { 16906 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16907 struct net_device *dev = info->user_ptr[1]; 16908 struct wireless_dev *wdev = dev->ieee80211_ptr; 16909 struct cfg80211_pmk_conf pmk_conf = {}; 16910 16911 if (wdev->iftype != NL80211_IFTYPE_STATION && 16912 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16913 return -EOPNOTSUPP; 16914 16915 if (!wiphy_ext_feature_isset(&rdev->wiphy, 16916 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 16917 return -EOPNOTSUPP; 16918 16919 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK]) 16920 return -EINVAL; 16921 16922 if (!wdev->connected) 16923 return -ENOTCONN; 16924 16925 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 16926 if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN)) 16927 return -EINVAL; 16928 16929 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 16930 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 16931 if (pmk_conf.pmk_len != WLAN_PMK_LEN && 16932 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) 16933 return -EINVAL; 16934 16935 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) 16936 pmk_conf.pmk_r0_name = 16937 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]); 16938 16939 return rdev_set_pmk(rdev, dev, &pmk_conf); 16940 } 16941 16942 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info) 16943 { 16944 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16945 struct net_device *dev = info->user_ptr[1]; 16946 struct wireless_dev *wdev = dev->ieee80211_ptr; 16947 const u8 *aa; 16948 16949 if (wdev->iftype != NL80211_IFTYPE_STATION && 16950 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16951 return -EOPNOTSUPP; 16952 16953 if (!wiphy_ext_feature_isset(&rdev->wiphy, 16954 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 16955 return -EOPNOTSUPP; 16956 16957 if (!info->attrs[NL80211_ATTR_MAC]) 16958 return -EINVAL; 16959 16960 aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 16961 return rdev_del_pmk(rdev, dev, aa); 16962 } 16963 16964 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info) 16965 { 16966 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16967 struct net_device *dev = info->user_ptr[1]; 16968 struct cfg80211_external_auth_params params; 16969 16970 if (!rdev->ops->external_auth) 16971 return -EOPNOTSUPP; 16972 16973 if (!info->attrs[NL80211_ATTR_SSID] && 16974 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 16975 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 16976 return -EINVAL; 16977 16978 if (!info->attrs[NL80211_ATTR_BSSID]) 16979 return -EINVAL; 16980 16981 if (!info->attrs[NL80211_ATTR_STATUS_CODE]) 16982 return -EINVAL; 16983 16984 memset(¶ms, 0, sizeof(params)); 16985 16986 if (info->attrs[NL80211_ATTR_SSID]) { 16987 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 16988 if (params.ssid.ssid_len == 0) 16989 return -EINVAL; 16990 memcpy(params.ssid.ssid, 16991 nla_data(info->attrs[NL80211_ATTR_SSID]), 16992 params.ssid.ssid_len); 16993 } 16994 16995 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]), 16996 ETH_ALEN); 16997 16998 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 16999 17000 if (info->attrs[NL80211_ATTR_PMKID]) 17001 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 17002 17003 return rdev_external_auth(rdev, dev, ¶ms); 17004 } 17005 17006 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info) 17007 { 17008 bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK]; 17009 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17010 struct net_device *dev = info->user_ptr[1]; 17011 struct wireless_dev *wdev = dev->ieee80211_ptr; 17012 const u8 *buf; 17013 size_t len; 17014 u8 *dest; 17015 u16 proto; 17016 bool noencrypt; 17017 u64 cookie = 0; 17018 int link_id; 17019 int err; 17020 17021 if (!wiphy_ext_feature_isset(&rdev->wiphy, 17022 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 17023 return -EOPNOTSUPP; 17024 17025 if (!rdev->ops->tx_control_port) 17026 return -EOPNOTSUPP; 17027 17028 if (!info->attrs[NL80211_ATTR_FRAME] || 17029 !info->attrs[NL80211_ATTR_MAC] || 17030 !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 17031 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing"); 17032 return -EINVAL; 17033 } 17034 17035 switch (wdev->iftype) { 17036 case NL80211_IFTYPE_AP: 17037 case NL80211_IFTYPE_P2P_GO: 17038 case NL80211_IFTYPE_MESH_POINT: 17039 break; 17040 case NL80211_IFTYPE_ADHOC: 17041 if (wdev->u.ibss.current_bss) 17042 break; 17043 return -ENOTCONN; 17044 case NL80211_IFTYPE_STATION: 17045 case NL80211_IFTYPE_P2P_CLIENT: 17046 if (wdev->connected) 17047 break; 17048 return -ENOTCONN; 17049 default: 17050 return -EOPNOTSUPP; 17051 } 17052 17053 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 17054 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 17055 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 17056 proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 17057 noencrypt = 17058 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]); 17059 17060 link_id = nl80211_link_id_or_invalid(info->attrs); 17061 17062 err = rdev_tx_control_port(rdev, dev, buf, len, 17063 dest, cpu_to_be16(proto), noencrypt, link_id, 17064 dont_wait_for_ack ? NULL : &cookie); 17065 if (!err && !dont_wait_for_ack) 17066 nl_set_extack_cookie_u64(info->extack, cookie); 17067 return err; 17068 } 17069 17070 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb, 17071 struct genl_info *info) 17072 { 17073 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17074 struct net_device *dev = info->user_ptr[1]; 17075 struct wireless_dev *wdev = dev->ieee80211_ptr; 17076 struct cfg80211_ftm_responder_stats ftm_stats = {}; 17077 unsigned int link_id = nl80211_link_id(info->attrs); 17078 struct sk_buff *msg; 17079 void *hdr; 17080 struct nlattr *ftm_stats_attr; 17081 int err; 17082 17083 if (wdev->iftype != NL80211_IFTYPE_AP || 17084 !wdev->links[link_id].ap.beacon_interval) 17085 return -EOPNOTSUPP; 17086 17087 err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats); 17088 if (err) 17089 return err; 17090 17091 if (!ftm_stats.filled) 17092 return -ENODATA; 17093 17094 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17095 if (!msg) 17096 return -ENOMEM; 17097 17098 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 17099 NL80211_CMD_GET_FTM_RESPONDER_STATS); 17100 if (!hdr) 17101 goto nla_put_failure; 17102 17103 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 17104 goto nla_put_failure; 17105 17106 ftm_stats_attr = nla_nest_start_noflag(msg, 17107 NL80211_ATTR_FTM_RESPONDER_STATS); 17108 if (!ftm_stats_attr) 17109 goto nla_put_failure; 17110 17111 #define SET_FTM(field, name, type) \ 17112 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 17113 nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \ 17114 ftm_stats.field)) \ 17115 goto nla_put_failure; } while (0) 17116 #define SET_FTM_U64(field, name) \ 17117 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 17118 nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \ 17119 ftm_stats.field, NL80211_FTM_STATS_PAD)) \ 17120 goto nla_put_failure; } while (0) 17121 17122 SET_FTM(success_num, SUCCESS_NUM, u32); 17123 SET_FTM(partial_num, PARTIAL_NUM, u32); 17124 SET_FTM(failed_num, FAILED_NUM, u32); 17125 SET_FTM(asap_num, ASAP_NUM, u32); 17126 SET_FTM(non_asap_num, NON_ASAP_NUM, u32); 17127 SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC); 17128 SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32); 17129 SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32); 17130 SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32); 17131 #undef SET_FTM 17132 17133 nla_nest_end(msg, ftm_stats_attr); 17134 17135 genlmsg_end(msg, hdr); 17136 return genlmsg_reply(msg, info); 17137 17138 nla_put_failure: 17139 nlmsg_free(msg); 17140 return -ENOBUFS; 17141 } 17142 17143 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info) 17144 { 17145 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17146 struct cfg80211_update_owe_info owe_info; 17147 struct net_device *dev = info->user_ptr[1]; 17148 17149 if (!rdev->ops->update_owe_info) 17150 return -EOPNOTSUPP; 17151 17152 if (!info->attrs[NL80211_ATTR_STATUS_CODE] || 17153 !info->attrs[NL80211_ATTR_MAC]) 17154 return -EINVAL; 17155 17156 memset(&owe_info, 0, sizeof(owe_info)); 17157 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 17158 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN); 17159 17160 if (info->attrs[NL80211_ATTR_IE]) { 17161 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 17162 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 17163 } 17164 17165 return rdev_update_owe_info(rdev, dev, &owe_info); 17166 } 17167 17168 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info) 17169 { 17170 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17171 struct net_device *dev = info->user_ptr[1]; 17172 struct wireless_dev *wdev = dev->ieee80211_ptr; 17173 struct station_info sinfo = {}; 17174 const u8 *buf; 17175 size_t len; 17176 u8 *dest; 17177 int err; 17178 17179 if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station) 17180 return -EOPNOTSUPP; 17181 17182 if (!info->attrs[NL80211_ATTR_MAC] || 17183 !info->attrs[NL80211_ATTR_FRAME]) { 17184 GENL_SET_ERR_MSG(info, "Frame or MAC missing"); 17185 return -EINVAL; 17186 } 17187 17188 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 17189 return -EOPNOTSUPP; 17190 17191 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 17192 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 17193 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 17194 17195 if (len < sizeof(struct ethhdr)) 17196 return -EINVAL; 17197 17198 if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) || 17199 !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr)) 17200 return -EINVAL; 17201 17202 err = rdev_get_station(rdev, dev, dest, &sinfo); 17203 if (err) 17204 return err; 17205 17206 cfg80211_sinfo_release_content(&sinfo); 17207 17208 return rdev_probe_mesh_link(rdev, dev, dest, buf, len); 17209 } 17210 17211 static int parse_tid_conf(struct cfg80211_registered_device *rdev, 17212 struct nlattr *attrs[], struct net_device *dev, 17213 struct cfg80211_tid_cfg *tid_conf, 17214 struct genl_info *info, const u8 *peer, 17215 unsigned int link_id) 17216 { 17217 struct netlink_ext_ack *extack = info->extack; 17218 u64 mask; 17219 int err; 17220 17221 if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS]) 17222 return -EINVAL; 17223 17224 tid_conf->config_override = 17225 nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]); 17226 tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]); 17227 17228 if (tid_conf->config_override) { 17229 if (rdev->ops->reset_tid_config) { 17230 err = rdev_reset_tid_config(rdev, dev, peer, 17231 tid_conf->tids); 17232 if (err) 17233 return err; 17234 } else { 17235 return -EINVAL; 17236 } 17237 } 17238 17239 if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) { 17240 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK); 17241 tid_conf->noack = 17242 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]); 17243 } 17244 17245 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) { 17246 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT); 17247 tid_conf->retry_short = 17248 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]); 17249 17250 if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count) 17251 return -EINVAL; 17252 } 17253 17254 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) { 17255 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG); 17256 tid_conf->retry_long = 17257 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]); 17258 17259 if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count) 17260 return -EINVAL; 17261 } 17262 17263 if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) { 17264 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL); 17265 tid_conf->ampdu = 17266 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]); 17267 } 17268 17269 if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) { 17270 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL); 17271 tid_conf->rtscts = 17272 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]); 17273 } 17274 17275 if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) { 17276 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL); 17277 tid_conf->amsdu = 17278 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]); 17279 } 17280 17281 if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) { 17282 u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr; 17283 17284 tid_conf->txrate_type = nla_get_u8(attrs[idx]); 17285 17286 if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) { 17287 attr = NL80211_TID_CONFIG_ATTR_TX_RATE; 17288 err = nl80211_parse_tx_bitrate_mask(info, attrs, attr, 17289 &tid_conf->txrate_mask, dev, 17290 true, link_id); 17291 if (err) 17292 return err; 17293 17294 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE); 17295 } 17296 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE); 17297 } 17298 17299 if (peer) 17300 mask = rdev->wiphy.tid_config_support.peer; 17301 else 17302 mask = rdev->wiphy.tid_config_support.vif; 17303 17304 if (tid_conf->mask & ~mask) { 17305 NL_SET_ERR_MSG(extack, "unsupported TID configuration"); 17306 return -EOPNOTSUPP; 17307 } 17308 17309 return 0; 17310 } 17311 17312 static int nl80211_set_tid_config(struct sk_buff *skb, 17313 struct genl_info *info) 17314 { 17315 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17316 struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1]; 17317 unsigned int link_id = nl80211_link_id(info->attrs); 17318 struct net_device *dev = info->user_ptr[1]; 17319 struct cfg80211_tid_config *tid_config; 17320 struct nlattr *tid; 17321 int conf_idx = 0, rem_conf; 17322 int ret = -EINVAL; 17323 u32 num_conf = 0; 17324 17325 if (!info->attrs[NL80211_ATTR_TID_CONFIG]) 17326 return -EINVAL; 17327 17328 if (!rdev->ops->set_tid_config) 17329 return -EOPNOTSUPP; 17330 17331 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 17332 rem_conf) 17333 num_conf++; 17334 17335 tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf), 17336 GFP_KERNEL); 17337 if (!tid_config) 17338 return -ENOMEM; 17339 17340 tid_config->n_tid_conf = num_conf; 17341 17342 if (info->attrs[NL80211_ATTR_MAC]) 17343 tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 17344 17345 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 17346 rem_conf) { 17347 ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX, 17348 tid, NULL, NULL); 17349 17350 if (ret) 17351 goto bad_tid_conf; 17352 17353 ret = parse_tid_conf(rdev, attrs, dev, 17354 &tid_config->tid_conf[conf_idx], 17355 info, tid_config->peer, link_id); 17356 if (ret) 17357 goto bad_tid_conf; 17358 17359 conf_idx++; 17360 } 17361 17362 ret = rdev_set_tid_config(rdev, dev, tid_config); 17363 17364 bad_tid_conf: 17365 kfree(tid_config); 17366 return ret; 17367 } 17368 17369 static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info) 17370 { 17371 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17372 struct cfg80211_color_change_settings params = {}; 17373 struct net_device *dev = info->user_ptr[1]; 17374 struct wireless_dev *wdev = dev->ieee80211_ptr; 17375 struct nlattr **tb; 17376 u16 offset; 17377 int err; 17378 17379 if (!rdev->ops->color_change) 17380 return -EOPNOTSUPP; 17381 17382 if (!wiphy_ext_feature_isset(&rdev->wiphy, 17383 NL80211_EXT_FEATURE_BSS_COLOR)) 17384 return -EOPNOTSUPP; 17385 17386 if (wdev->iftype != NL80211_IFTYPE_AP) 17387 return -EOPNOTSUPP; 17388 17389 if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] || 17390 !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] || 17391 !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS]) 17392 return -EINVAL; 17393 17394 params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]); 17395 params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]); 17396 17397 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_next, 17398 info->extack); 17399 if (err) 17400 return err; 17401 17402 tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL); 17403 if (!tb) 17404 return -ENOMEM; 17405 17406 err = nla_parse_nested(tb, NL80211_ATTR_MAX, 17407 info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS], 17408 nl80211_policy, info->extack); 17409 if (err) 17410 goto out; 17411 17412 err = nl80211_parse_beacon(rdev, tb, ¶ms.beacon_color_change, 17413 info->extack); 17414 if (err) 17415 goto out; 17416 17417 if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 17418 err = -EINVAL; 17419 goto out; 17420 } 17421 17422 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) { 17423 err = -EINVAL; 17424 goto out; 17425 } 17426 17427 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 17428 if (offset >= params.beacon_color_change.tail_len) { 17429 err = -EINVAL; 17430 goto out; 17431 } 17432 17433 if (params.beacon_color_change.tail[offset] != params.count) { 17434 err = -EINVAL; 17435 goto out; 17436 } 17437 17438 params.counter_offset_beacon = offset; 17439 17440 if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 17441 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) != 17442 sizeof(u16)) { 17443 err = -EINVAL; 17444 goto out; 17445 } 17446 17447 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 17448 if (offset >= params.beacon_color_change.probe_resp_len) { 17449 err = -EINVAL; 17450 goto out; 17451 } 17452 17453 if (params.beacon_color_change.probe_resp[offset] != 17454 params.count) { 17455 err = -EINVAL; 17456 goto out; 17457 } 17458 17459 params.counter_offset_presp = offset; 17460 } 17461 17462 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 17463 err = nl80211_parse_unsol_bcast_probe_resp( 17464 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 17465 ¶ms.unsol_bcast_probe_resp); 17466 if (err) 17467 goto out; 17468 } 17469 17470 params.link_id = nl80211_link_id(info->attrs); 17471 err = rdev_color_change(rdev, dev, ¶ms); 17472 17473 out: 17474 kfree(params.beacon_next.mbssid_ies); 17475 kfree(params.beacon_color_change.mbssid_ies); 17476 kfree(params.beacon_next.rnr_ies); 17477 kfree(params.beacon_color_change.rnr_ies); 17478 kfree(tb); 17479 return err; 17480 } 17481 17482 static int nl80211_set_fils_aad(struct sk_buff *skb, 17483 struct genl_info *info) 17484 { 17485 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17486 struct net_device *dev = info->user_ptr[1]; 17487 struct cfg80211_fils_aad fils_aad = {}; 17488 u8 *nonces; 17489 17490 if (!info->attrs[NL80211_ATTR_MAC] || 17491 !info->attrs[NL80211_ATTR_FILS_KEK] || 17492 !info->attrs[NL80211_ATTR_FILS_NONCES]) 17493 return -EINVAL; 17494 17495 fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 17496 fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 17497 fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 17498 nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 17499 fils_aad.snonce = nonces; 17500 fils_aad.anonce = nonces + FILS_NONCE_LEN; 17501 17502 return rdev_set_fils_aad(rdev, dev, &fils_aad); 17503 } 17504 17505 static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info) 17506 { 17507 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17508 unsigned int link_id = nl80211_link_id(info->attrs); 17509 struct net_device *dev = info->user_ptr[1]; 17510 struct wireless_dev *wdev = dev->ieee80211_ptr; 17511 int ret; 17512 17513 if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO)) 17514 return -EINVAL; 17515 17516 switch (wdev->iftype) { 17517 case NL80211_IFTYPE_AP: 17518 break; 17519 default: 17520 return -EINVAL; 17521 } 17522 17523 if (!info->attrs[NL80211_ATTR_MAC] || 17524 !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC]))) 17525 return -EINVAL; 17526 17527 wdev->valid_links |= BIT(link_id); 17528 ether_addr_copy(wdev->links[link_id].addr, 17529 nla_data(info->attrs[NL80211_ATTR_MAC])); 17530 17531 ret = rdev_add_intf_link(rdev, wdev, link_id); 17532 if (ret) { 17533 wdev->valid_links &= ~BIT(link_id); 17534 eth_zero_addr(wdev->links[link_id].addr); 17535 } 17536 17537 return ret; 17538 } 17539 17540 static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info) 17541 { 17542 unsigned int link_id = nl80211_link_id(info->attrs); 17543 struct net_device *dev = info->user_ptr[1]; 17544 struct wireless_dev *wdev = dev->ieee80211_ptr; 17545 17546 /* cannot remove if there's no link */ 17547 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 17548 return -EINVAL; 17549 17550 switch (wdev->iftype) { 17551 case NL80211_IFTYPE_AP: 17552 break; 17553 default: 17554 return -EINVAL; 17555 } 17556 17557 cfg80211_remove_link(wdev, link_id); 17558 17559 return 0; 17560 } 17561 17562 static int 17563 nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info, 17564 bool add) 17565 { 17566 struct link_station_parameters params = {}; 17567 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17568 struct net_device *dev = info->user_ptr[1]; 17569 int err; 17570 17571 if ((add && !rdev->ops->add_link_station) || 17572 (!add && !rdev->ops->mod_link_station)) 17573 return -EOPNOTSUPP; 17574 17575 if (add && !info->attrs[NL80211_ATTR_MAC]) 17576 return -EINVAL; 17577 17578 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 17579 return -EINVAL; 17580 17581 if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 17582 return -EINVAL; 17583 17584 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 17585 17586 if (info->attrs[NL80211_ATTR_MAC]) { 17587 params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 17588 if (!is_valid_ether_addr(params.link_mac)) 17589 return -EINVAL; 17590 } 17591 17592 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 17593 return -EINVAL; 17594 17595 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 17596 17597 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 17598 params.supported_rates = 17599 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 17600 params.supported_rates_len = 17601 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 17602 } 17603 17604 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 17605 params.ht_capa = 17606 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 17607 17608 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 17609 params.vht_capa = 17610 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 17611 17612 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 17613 params.he_capa = 17614 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 17615 params.he_capa_len = 17616 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 17617 17618 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 17619 params.eht_capa = 17620 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 17621 params.eht_capa_len = 17622 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 17623 17624 if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa, 17625 (const u8 *)params.eht_capa, 17626 params.eht_capa_len, 17627 false)) 17628 return -EINVAL; 17629 } 17630 } 17631 17632 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 17633 params.he_6ghz_capa = 17634 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 17635 17636 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 17637 params.opmode_notif_used = true; 17638 params.opmode_notif = 17639 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 17640 } 17641 17642 err = nl80211_parse_sta_txpower_setting(info, ¶ms.txpwr, 17643 ¶ms.txpwr_set); 17644 if (err) 17645 return err; 17646 17647 if (add) 17648 return rdev_add_link_station(rdev, dev, ¶ms); 17649 17650 return rdev_mod_link_station(rdev, dev, ¶ms); 17651 } 17652 17653 static int 17654 nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info) 17655 { 17656 return nl80211_add_mod_link_station(skb, info, true); 17657 } 17658 17659 static int 17660 nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info) 17661 { 17662 return nl80211_add_mod_link_station(skb, info, false); 17663 } 17664 17665 static int 17666 nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info) 17667 { 17668 struct link_station_del_parameters params = {}; 17669 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17670 struct net_device *dev = info->user_ptr[1]; 17671 17672 if (!rdev->ops->del_link_station) 17673 return -EOPNOTSUPP; 17674 17675 if (!info->attrs[NL80211_ATTR_MLD_ADDR] || 17676 !info->attrs[NL80211_ATTR_MLO_LINK_ID]) 17677 return -EINVAL; 17678 17679 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 17680 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 17681 17682 return rdev_del_link_station(rdev, dev, ¶ms); 17683 } 17684 17685 static int nl80211_set_hw_timestamp(struct sk_buff *skb, 17686 struct genl_info *info) 17687 { 17688 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17689 struct net_device *dev = info->user_ptr[1]; 17690 struct cfg80211_set_hw_timestamp hwts = {}; 17691 17692 if (!rdev->wiphy.hw_timestamp_max_peers) 17693 return -EOPNOTSUPP; 17694 17695 if (!info->attrs[NL80211_ATTR_MAC] && 17696 rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS) 17697 return -EOPNOTSUPP; 17698 17699 if (info->attrs[NL80211_ATTR_MAC]) 17700 hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 17701 17702 hwts.enable = 17703 nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]); 17704 17705 return rdev_set_hw_timestamp(rdev, dev, &hwts); 17706 } 17707 17708 static int 17709 nl80211_set_ttlm(struct sk_buff *skb, struct genl_info *info) 17710 { 17711 struct cfg80211_ttlm_params params = {}; 17712 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17713 struct net_device *dev = info->user_ptr[1]; 17714 struct wireless_dev *wdev = dev->ieee80211_ptr; 17715 17716 if (wdev->iftype != NL80211_IFTYPE_STATION && 17717 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 17718 return -EOPNOTSUPP; 17719 17720 if (!wdev->connected) 17721 return -ENOLINK; 17722 17723 if (!info->attrs[NL80211_ATTR_MLO_TTLM_DLINK] || 17724 !info->attrs[NL80211_ATTR_MLO_TTLM_ULINK]) 17725 return -EINVAL; 17726 17727 nla_memcpy(params.dlink, 17728 info->attrs[NL80211_ATTR_MLO_TTLM_DLINK], 17729 sizeof(params.dlink)); 17730 nla_memcpy(params.ulink, 17731 info->attrs[NL80211_ATTR_MLO_TTLM_ULINK], 17732 sizeof(params.ulink)); 17733 17734 return rdev_set_ttlm(rdev, dev, ¶ms); 17735 } 17736 17737 static int nl80211_assoc_ml_reconf(struct sk_buff *skb, struct genl_info *info) 17738 { 17739 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17740 struct net_device *dev = info->user_ptr[1]; 17741 struct wireless_dev *wdev = dev->ieee80211_ptr; 17742 struct cfg80211_ml_reconf_req req = {}; 17743 unsigned int link_id; 17744 u16 add_links; 17745 int err; 17746 17747 if (!wdev->valid_links) 17748 return -EINVAL; 17749 17750 if (dev->ieee80211_ptr->conn_owner_nlportid && 17751 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 17752 return -EPERM; 17753 17754 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 17755 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 17756 return -EOPNOTSUPP; 17757 17758 add_links = 0; 17759 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 17760 err = nl80211_process_links(rdev, req.add_links, 17761 /* mark as MLO, but not assoc */ 17762 IEEE80211_MLD_MAX_NUM_LINKS, 17763 NULL, 0, info); 17764 if (err) 17765 return err; 17766 17767 for (link_id = 0; link_id < IEEE80211_MLD_MAX_NUM_LINKS; 17768 link_id++) { 17769 if (!req.add_links[link_id].bss) 17770 continue; 17771 add_links |= BIT(link_id); 17772 } 17773 } 17774 17775 if (info->attrs[NL80211_ATTR_MLO_RECONF_REM_LINKS]) 17776 req.rem_links = 17777 nla_get_u16(info->attrs[NL80211_ATTR_MLO_RECONF_REM_LINKS]); 17778 17779 /* Validate that existing links are not added, removed links are valid 17780 * and don't allow adding and removing the same links 17781 */ 17782 if ((add_links & req.rem_links) || !(add_links | req.rem_links) || 17783 (wdev->valid_links & add_links) || 17784 ((wdev->valid_links & req.rem_links) != req.rem_links)) { 17785 err = -EINVAL; 17786 goto out; 17787 } 17788 17789 if (info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]) 17790 req.ext_mld_capa_ops = 17791 nla_get_u16(info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]); 17792 17793 err = cfg80211_assoc_ml_reconf(rdev, dev, &req); 17794 17795 out: 17796 for (link_id = 0; link_id < ARRAY_SIZE(req.add_links); link_id++) 17797 cfg80211_put_bss(&rdev->wiphy, req.add_links[link_id].bss); 17798 17799 return err; 17800 } 17801 17802 static int 17803 nl80211_epcs_cfg(struct sk_buff *skb, struct genl_info *info) 17804 { 17805 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17806 struct net_device *dev = info->user_ptr[1]; 17807 struct wireless_dev *wdev = dev->ieee80211_ptr; 17808 bool val; 17809 17810 if (wdev->iftype != NL80211_IFTYPE_STATION && 17811 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 17812 return -EOPNOTSUPP; 17813 17814 if (!wdev->connected) 17815 return -ENOLINK; 17816 17817 val = nla_get_flag(info->attrs[NL80211_ATTR_EPCS]); 17818 17819 return rdev_set_epcs(rdev, dev, val); 17820 } 17821 17822 #define NL80211_FLAG_NEED_WIPHY 0x01 17823 #define NL80211_FLAG_NEED_NETDEV 0x02 17824 #define NL80211_FLAG_NEED_RTNL 0x04 17825 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08 17826 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\ 17827 NL80211_FLAG_CHECK_NETDEV_UP) 17828 #define NL80211_FLAG_NEED_WDEV 0x10 17829 /* If a netdev is associated, it must be UP, P2P must be started */ 17830 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\ 17831 NL80211_FLAG_CHECK_NETDEV_UP) 17832 #define NL80211_FLAG_CLEAR_SKB 0x20 17833 #define NL80211_FLAG_NO_WIPHY_MTX 0x40 17834 #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80 17835 #define NL80211_FLAG_MLO_UNSUPPORTED 0x100 17836 17837 #define INTERNAL_FLAG_SELECTORS(__sel) \ 17838 SELECTOR(__sel, NONE, 0) /* must be first */ \ 17839 SELECTOR(__sel, WIPHY, \ 17840 NL80211_FLAG_NEED_WIPHY) \ 17841 SELECTOR(__sel, WDEV, \ 17842 NL80211_FLAG_NEED_WDEV) \ 17843 SELECTOR(__sel, NETDEV, \ 17844 NL80211_FLAG_NEED_NETDEV) \ 17845 SELECTOR(__sel, NETDEV_LINK, \ 17846 NL80211_FLAG_NEED_NETDEV | \ 17847 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17848 SELECTOR(__sel, NETDEV_NO_MLO, \ 17849 NL80211_FLAG_NEED_NETDEV | \ 17850 NL80211_FLAG_MLO_UNSUPPORTED) \ 17851 SELECTOR(__sel, WIPHY_RTNL, \ 17852 NL80211_FLAG_NEED_WIPHY | \ 17853 NL80211_FLAG_NEED_RTNL) \ 17854 SELECTOR(__sel, WIPHY_RTNL_NOMTX, \ 17855 NL80211_FLAG_NEED_WIPHY | \ 17856 NL80211_FLAG_NEED_RTNL | \ 17857 NL80211_FLAG_NO_WIPHY_MTX) \ 17858 SELECTOR(__sel, WDEV_RTNL, \ 17859 NL80211_FLAG_NEED_WDEV | \ 17860 NL80211_FLAG_NEED_RTNL) \ 17861 SELECTOR(__sel, NETDEV_RTNL, \ 17862 NL80211_FLAG_NEED_NETDEV | \ 17863 NL80211_FLAG_NEED_RTNL) \ 17864 SELECTOR(__sel, NETDEV_UP, \ 17865 NL80211_FLAG_NEED_NETDEV_UP) \ 17866 SELECTOR(__sel, NETDEV_UP_LINK, \ 17867 NL80211_FLAG_NEED_NETDEV_UP | \ 17868 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17869 SELECTOR(__sel, NETDEV_UP_NO_MLO, \ 17870 NL80211_FLAG_NEED_NETDEV_UP | \ 17871 NL80211_FLAG_MLO_UNSUPPORTED) \ 17872 SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \ 17873 NL80211_FLAG_NEED_NETDEV_UP | \ 17874 NL80211_FLAG_CLEAR_SKB | \ 17875 NL80211_FLAG_MLO_UNSUPPORTED) \ 17876 SELECTOR(__sel, NETDEV_UP_NOTMX, \ 17877 NL80211_FLAG_NEED_NETDEV_UP | \ 17878 NL80211_FLAG_NO_WIPHY_MTX) \ 17879 SELECTOR(__sel, NETDEV_UP_NOTMX_MLO, \ 17880 NL80211_FLAG_NEED_NETDEV_UP | \ 17881 NL80211_FLAG_NO_WIPHY_MTX | \ 17882 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17883 SELECTOR(__sel, NETDEV_UP_CLEAR, \ 17884 NL80211_FLAG_NEED_NETDEV_UP | \ 17885 NL80211_FLAG_CLEAR_SKB) \ 17886 SELECTOR(__sel, WDEV_UP, \ 17887 NL80211_FLAG_NEED_WDEV_UP) \ 17888 SELECTOR(__sel, WDEV_UP_LINK, \ 17889 NL80211_FLAG_NEED_WDEV_UP | \ 17890 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17891 SELECTOR(__sel, WDEV_UP_RTNL, \ 17892 NL80211_FLAG_NEED_WDEV_UP | \ 17893 NL80211_FLAG_NEED_RTNL) \ 17894 SELECTOR(__sel, WIPHY_CLEAR, \ 17895 NL80211_FLAG_NEED_WIPHY | \ 17896 NL80211_FLAG_CLEAR_SKB) 17897 17898 enum nl80211_internal_flags_selector { 17899 #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name, 17900 INTERNAL_FLAG_SELECTORS(_) 17901 #undef SELECTOR 17902 }; 17903 17904 static u32 nl80211_internal_flags[] = { 17905 #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value, 17906 INTERNAL_FLAG_SELECTORS(_) 17907 #undef SELECTOR 17908 }; 17909 17910 static int nl80211_pre_doit(const struct genl_split_ops *ops, 17911 struct sk_buff *skb, 17912 struct genl_info *info) 17913 { 17914 struct cfg80211_registered_device *rdev = NULL; 17915 struct wireless_dev *wdev = NULL; 17916 struct net_device *dev = NULL; 17917 u32 internal_flags; 17918 int err; 17919 17920 if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags))) 17921 return -EINVAL; 17922 17923 internal_flags = nl80211_internal_flags[ops->internal_flags]; 17924 17925 rtnl_lock(); 17926 if (internal_flags & NL80211_FLAG_NEED_WIPHY) { 17927 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 17928 if (IS_ERR(rdev)) { 17929 err = PTR_ERR(rdev); 17930 goto out_unlock; 17931 } 17932 info->user_ptr[0] = rdev; 17933 } else if (internal_flags & NL80211_FLAG_NEED_NETDEV || 17934 internal_flags & NL80211_FLAG_NEED_WDEV) { 17935 wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info), 17936 info->attrs); 17937 if (IS_ERR(wdev)) { 17938 err = PTR_ERR(wdev); 17939 goto out_unlock; 17940 } 17941 17942 dev = wdev->netdev; 17943 dev_hold(dev); 17944 rdev = wiphy_to_rdev(wdev->wiphy); 17945 17946 if (internal_flags & NL80211_FLAG_NEED_NETDEV) { 17947 if (!dev) { 17948 err = -EINVAL; 17949 goto out_unlock; 17950 } 17951 17952 info->user_ptr[1] = dev; 17953 } else { 17954 info->user_ptr[1] = wdev; 17955 } 17956 17957 if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP && 17958 !wdev_running(wdev)) { 17959 err = -ENETDOWN; 17960 goto out_unlock; 17961 } 17962 17963 info->user_ptr[0] = rdev; 17964 } 17965 17966 if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) { 17967 struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID]; 17968 17969 if (!wdev) { 17970 err = -EINVAL; 17971 goto out_unlock; 17972 } 17973 17974 /* MLO -> require valid link ID */ 17975 if (wdev->valid_links && 17976 (!link_id || 17977 !(wdev->valid_links & BIT(nla_get_u8(link_id))))) { 17978 err = -EINVAL; 17979 goto out_unlock; 17980 } 17981 17982 /* non-MLO -> no link ID attribute accepted */ 17983 if (!wdev->valid_links && link_id) { 17984 err = -EINVAL; 17985 goto out_unlock; 17986 } 17987 } 17988 17989 if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) { 17990 if (info->attrs[NL80211_ATTR_MLO_LINK_ID] || 17991 (wdev && wdev->valid_links)) { 17992 err = -EINVAL; 17993 goto out_unlock; 17994 } 17995 } 17996 17997 if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 17998 wiphy_lock(&rdev->wiphy); 17999 /* we keep the mutex locked until post_doit */ 18000 __release(&rdev->wiphy.mtx); 18001 } 18002 if (!(internal_flags & NL80211_FLAG_NEED_RTNL)) 18003 rtnl_unlock(); 18004 18005 return 0; 18006 out_unlock: 18007 rtnl_unlock(); 18008 dev_put(dev); 18009 return err; 18010 } 18011 18012 static void nl80211_post_doit(const struct genl_split_ops *ops, 18013 struct sk_buff *skb, 18014 struct genl_info *info) 18015 { 18016 u32 internal_flags = nl80211_internal_flags[ops->internal_flags]; 18017 18018 if (info->user_ptr[1]) { 18019 if (internal_flags & NL80211_FLAG_NEED_WDEV) { 18020 struct wireless_dev *wdev = info->user_ptr[1]; 18021 18022 dev_put(wdev->netdev); 18023 } else { 18024 dev_put(info->user_ptr[1]); 18025 } 18026 } 18027 18028 if (info->user_ptr[0] && 18029 !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 18030 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 18031 18032 /* we kept the mutex locked since pre_doit */ 18033 __acquire(&rdev->wiphy.mtx); 18034 wiphy_unlock(&rdev->wiphy); 18035 } 18036 18037 if (internal_flags & NL80211_FLAG_NEED_RTNL) 18038 rtnl_unlock(); 18039 18040 /* If needed, clear the netlink message payload from the SKB 18041 * as it might contain key data that shouldn't stick around on 18042 * the heap after the SKB is freed. The netlink message header 18043 * is still needed for further processing, so leave it intact. 18044 */ 18045 if (internal_flags & NL80211_FLAG_CLEAR_SKB) { 18046 struct nlmsghdr *nlh = nlmsg_hdr(skb); 18047 18048 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh)); 18049 } 18050 } 18051 18052 static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev, 18053 struct cfg80211_sar_specs *sar_specs, 18054 struct nlattr *spec[], int index) 18055 { 18056 u32 range_index, i; 18057 18058 if (!sar_specs || !spec) 18059 return -EINVAL; 18060 18061 if (!spec[NL80211_SAR_ATTR_SPECS_POWER] || 18062 !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]) 18063 return -EINVAL; 18064 18065 range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]); 18066 18067 /* check if range_index exceeds num_freq_ranges */ 18068 if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges) 18069 return -EINVAL; 18070 18071 /* check if range_index duplicates */ 18072 for (i = 0; i < index; i++) { 18073 if (sar_specs->sub_specs[i].freq_range_index == range_index) 18074 return -EINVAL; 18075 } 18076 18077 sar_specs->sub_specs[index].power = 18078 nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]); 18079 18080 sar_specs->sub_specs[index].freq_range_index = range_index; 18081 18082 return 0; 18083 } 18084 18085 static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info) 18086 { 18087 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 18088 struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1]; 18089 struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1]; 18090 struct cfg80211_sar_specs *sar_spec; 18091 enum nl80211_sar_type type; 18092 struct nlattr *spec_list; 18093 u32 specs; 18094 int rem, err; 18095 18096 if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs) 18097 return -EOPNOTSUPP; 18098 18099 if (!info->attrs[NL80211_ATTR_SAR_SPEC]) 18100 return -EINVAL; 18101 18102 nla_parse_nested(tb, NL80211_SAR_ATTR_MAX, 18103 info->attrs[NL80211_ATTR_SAR_SPEC], 18104 NULL, NULL); 18105 18106 if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS]) 18107 return -EINVAL; 18108 18109 type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]); 18110 if (type != rdev->wiphy.sar_capa->type) 18111 return -EINVAL; 18112 18113 specs = 0; 18114 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) 18115 specs++; 18116 18117 if (specs > rdev->wiphy.sar_capa->num_freq_ranges) 18118 return -EINVAL; 18119 18120 sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL); 18121 if (!sar_spec) 18122 return -ENOMEM; 18123 18124 sar_spec->num_sub_specs = specs; 18125 sar_spec->type = type; 18126 specs = 0; 18127 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) { 18128 nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX, 18129 spec_list, NULL, NULL); 18130 18131 switch (type) { 18132 case NL80211_SAR_TYPE_POWER: 18133 if (nl80211_set_sar_sub_specs(rdev, sar_spec, 18134 spec, specs)) { 18135 err = -EINVAL; 18136 goto error; 18137 } 18138 break; 18139 default: 18140 err = -EINVAL; 18141 goto error; 18142 } 18143 specs++; 18144 } 18145 18146 sar_spec->num_sub_specs = specs; 18147 18148 rdev->cur_cmd_info = info; 18149 err = rdev_set_sar_specs(rdev, sar_spec); 18150 rdev->cur_cmd_info = NULL; 18151 error: 18152 kfree(sar_spec); 18153 return err; 18154 } 18155 18156 #define SELECTOR(__sel, name, value) \ 18157 ((__sel) == (value)) ? NL80211_IFL_SEL_##name : 18158 int __missing_selector(void); 18159 #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector() 18160 18161 static const struct genl_ops nl80211_ops[] = { 18162 { 18163 .cmd = NL80211_CMD_GET_WIPHY, 18164 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18165 .doit = nl80211_get_wiphy, 18166 .dumpit = nl80211_dump_wiphy, 18167 .done = nl80211_dump_wiphy_done, 18168 /* can be retrieved by unprivileged users */ 18169 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18170 }, 18171 }; 18172 18173 static const struct genl_small_ops nl80211_small_ops[] = { 18174 { 18175 .cmd = NL80211_CMD_SET_WIPHY, 18176 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18177 .doit = nl80211_set_wiphy, 18178 .flags = GENL_UNS_ADMIN_PERM, 18179 }, 18180 { 18181 .cmd = NL80211_CMD_GET_INTERFACE, 18182 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18183 .doit = nl80211_get_interface, 18184 .dumpit = nl80211_dump_interface, 18185 /* can be retrieved by unprivileged users */ 18186 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 18187 }, 18188 { 18189 .cmd = NL80211_CMD_SET_INTERFACE, 18190 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18191 .doit = nl80211_set_interface, 18192 .flags = GENL_UNS_ADMIN_PERM, 18193 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18194 NL80211_FLAG_NEED_RTNL), 18195 }, 18196 { 18197 .cmd = NL80211_CMD_NEW_INTERFACE, 18198 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18199 .doit = nl80211_new_interface, 18200 .flags = GENL_UNS_ADMIN_PERM, 18201 .internal_flags = 18202 IFLAGS(NL80211_FLAG_NEED_WIPHY | 18203 NL80211_FLAG_NEED_RTNL | 18204 /* we take the wiphy mutex later ourselves */ 18205 NL80211_FLAG_NO_WIPHY_MTX), 18206 }, 18207 { 18208 .cmd = NL80211_CMD_DEL_INTERFACE, 18209 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18210 .doit = nl80211_del_interface, 18211 .flags = GENL_UNS_ADMIN_PERM, 18212 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 18213 NL80211_FLAG_NEED_RTNL), 18214 }, 18215 { 18216 .cmd = NL80211_CMD_GET_KEY, 18217 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18218 .doit = nl80211_get_key, 18219 .flags = GENL_UNS_ADMIN_PERM, 18220 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18221 }, 18222 { 18223 .cmd = NL80211_CMD_SET_KEY, 18224 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18225 .doit = nl80211_set_key, 18226 .flags = GENL_UNS_ADMIN_PERM, 18227 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */ 18228 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18229 NL80211_FLAG_CLEAR_SKB), 18230 }, 18231 { 18232 .cmd = NL80211_CMD_NEW_KEY, 18233 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18234 .doit = nl80211_new_key, 18235 .flags = GENL_UNS_ADMIN_PERM, 18236 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18237 NL80211_FLAG_CLEAR_SKB), 18238 }, 18239 { 18240 .cmd = NL80211_CMD_DEL_KEY, 18241 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18242 .doit = nl80211_del_key, 18243 .flags = GENL_UNS_ADMIN_PERM, 18244 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18245 }, 18246 { 18247 .cmd = NL80211_CMD_SET_BEACON, 18248 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18249 .flags = GENL_UNS_ADMIN_PERM, 18250 .doit = nl80211_set_beacon, 18251 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18252 NL80211_FLAG_MLO_VALID_LINK_ID), 18253 }, 18254 { 18255 .cmd = NL80211_CMD_START_AP, 18256 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18257 .flags = GENL_UNS_ADMIN_PERM, 18258 .doit = nl80211_start_ap, 18259 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18260 NL80211_FLAG_MLO_VALID_LINK_ID), 18261 }, 18262 { 18263 .cmd = NL80211_CMD_STOP_AP, 18264 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18265 .flags = GENL_UNS_ADMIN_PERM, 18266 .doit = nl80211_stop_ap, 18267 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18268 NL80211_FLAG_MLO_VALID_LINK_ID), 18269 }, 18270 { 18271 .cmd = NL80211_CMD_GET_STATION, 18272 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18273 .doit = nl80211_get_station, 18274 .dumpit = nl80211_dump_station, 18275 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18276 }, 18277 { 18278 .cmd = NL80211_CMD_SET_STATION, 18279 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18280 .doit = nl80211_set_station, 18281 .flags = GENL_UNS_ADMIN_PERM, 18282 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18283 }, 18284 { 18285 .cmd = NL80211_CMD_NEW_STATION, 18286 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18287 .doit = nl80211_new_station, 18288 .flags = GENL_UNS_ADMIN_PERM, 18289 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18290 }, 18291 { 18292 .cmd = NL80211_CMD_DEL_STATION, 18293 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18294 .doit = nl80211_del_station, 18295 .flags = GENL_UNS_ADMIN_PERM, 18296 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on 18297 * whether MAC address is passed or not. If MAC address is 18298 * passed, then even during MLO, link ID is not required. 18299 */ 18300 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18301 }, 18302 { 18303 .cmd = NL80211_CMD_GET_MPATH, 18304 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18305 .doit = nl80211_get_mpath, 18306 .dumpit = nl80211_dump_mpath, 18307 .flags = GENL_UNS_ADMIN_PERM, 18308 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18309 }, 18310 { 18311 .cmd = NL80211_CMD_GET_MPP, 18312 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18313 .doit = nl80211_get_mpp, 18314 .dumpit = nl80211_dump_mpp, 18315 .flags = GENL_UNS_ADMIN_PERM, 18316 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18317 }, 18318 { 18319 .cmd = NL80211_CMD_SET_MPATH, 18320 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18321 .doit = nl80211_set_mpath, 18322 .flags = GENL_UNS_ADMIN_PERM, 18323 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18324 }, 18325 { 18326 .cmd = NL80211_CMD_NEW_MPATH, 18327 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18328 .doit = nl80211_new_mpath, 18329 .flags = GENL_UNS_ADMIN_PERM, 18330 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18331 }, 18332 { 18333 .cmd = NL80211_CMD_DEL_MPATH, 18334 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18335 .doit = nl80211_del_mpath, 18336 .flags = GENL_UNS_ADMIN_PERM, 18337 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18338 }, 18339 { 18340 .cmd = NL80211_CMD_SET_BSS, 18341 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18342 .doit = nl80211_set_bss, 18343 .flags = GENL_UNS_ADMIN_PERM, 18344 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18345 NL80211_FLAG_MLO_VALID_LINK_ID), 18346 }, 18347 { 18348 .cmd = NL80211_CMD_GET_REG, 18349 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18350 .doit = nl80211_get_reg_do, 18351 .dumpit = nl80211_get_reg_dump, 18352 /* can be retrieved by unprivileged users */ 18353 }, 18354 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 18355 { 18356 .cmd = NL80211_CMD_SET_REG, 18357 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18358 .doit = nl80211_set_reg, 18359 .flags = GENL_ADMIN_PERM, 18360 }, 18361 #endif 18362 { 18363 .cmd = NL80211_CMD_REQ_SET_REG, 18364 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18365 .doit = nl80211_req_set_reg, 18366 .flags = GENL_ADMIN_PERM, 18367 }, 18368 { 18369 .cmd = NL80211_CMD_RELOAD_REGDB, 18370 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18371 .doit = nl80211_reload_regdb, 18372 .flags = GENL_ADMIN_PERM, 18373 }, 18374 { 18375 .cmd = NL80211_CMD_GET_MESH_CONFIG, 18376 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18377 .doit = nl80211_get_mesh_config, 18378 /* can be retrieved by unprivileged users */ 18379 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18380 }, 18381 { 18382 .cmd = NL80211_CMD_SET_MESH_CONFIG, 18383 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18384 .doit = nl80211_update_mesh_config, 18385 .flags = GENL_UNS_ADMIN_PERM, 18386 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18387 }, 18388 { 18389 .cmd = NL80211_CMD_TRIGGER_SCAN, 18390 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18391 .doit = nl80211_trigger_scan, 18392 .flags = GENL_UNS_ADMIN_PERM, 18393 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18394 }, 18395 { 18396 .cmd = NL80211_CMD_ABORT_SCAN, 18397 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18398 .doit = nl80211_abort_scan, 18399 .flags = GENL_UNS_ADMIN_PERM, 18400 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18401 }, 18402 { 18403 .cmd = NL80211_CMD_GET_SCAN, 18404 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18405 .dumpit = nl80211_dump_scan, 18406 }, 18407 { 18408 .cmd = NL80211_CMD_START_SCHED_SCAN, 18409 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18410 .doit = nl80211_start_sched_scan, 18411 .flags = GENL_UNS_ADMIN_PERM, 18412 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18413 }, 18414 { 18415 .cmd = NL80211_CMD_STOP_SCHED_SCAN, 18416 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18417 .doit = nl80211_stop_sched_scan, 18418 .flags = GENL_UNS_ADMIN_PERM, 18419 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18420 }, 18421 { 18422 .cmd = NL80211_CMD_AUTHENTICATE, 18423 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18424 .doit = nl80211_authenticate, 18425 .flags = GENL_UNS_ADMIN_PERM, 18426 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18427 NL80211_FLAG_CLEAR_SKB), 18428 }, 18429 { 18430 .cmd = NL80211_CMD_ASSOCIATE, 18431 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18432 .doit = nl80211_associate, 18433 .flags = GENL_UNS_ADMIN_PERM, 18434 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18435 NL80211_FLAG_CLEAR_SKB), 18436 }, 18437 { 18438 .cmd = NL80211_CMD_DEAUTHENTICATE, 18439 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18440 .doit = nl80211_deauthenticate, 18441 .flags = GENL_UNS_ADMIN_PERM, 18442 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18443 }, 18444 { 18445 .cmd = NL80211_CMD_DISASSOCIATE, 18446 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18447 .doit = nl80211_disassociate, 18448 .flags = GENL_UNS_ADMIN_PERM, 18449 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18450 }, 18451 { 18452 .cmd = NL80211_CMD_JOIN_IBSS, 18453 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18454 .doit = nl80211_join_ibss, 18455 .flags = GENL_UNS_ADMIN_PERM, 18456 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18457 }, 18458 { 18459 .cmd = NL80211_CMD_LEAVE_IBSS, 18460 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18461 .doit = nl80211_leave_ibss, 18462 .flags = GENL_UNS_ADMIN_PERM, 18463 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18464 }, 18465 #ifdef CONFIG_NL80211_TESTMODE 18466 { 18467 .cmd = NL80211_CMD_TESTMODE, 18468 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18469 .doit = nl80211_testmode_do, 18470 .dumpit = nl80211_testmode_dump, 18471 .flags = GENL_UNS_ADMIN_PERM, 18472 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18473 }, 18474 #endif 18475 { 18476 .cmd = NL80211_CMD_CONNECT, 18477 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18478 .doit = nl80211_connect, 18479 .flags = GENL_UNS_ADMIN_PERM, 18480 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18481 NL80211_FLAG_CLEAR_SKB), 18482 }, 18483 { 18484 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS, 18485 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18486 .doit = nl80211_update_connect_params, 18487 .flags = GENL_ADMIN_PERM, 18488 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18489 NL80211_FLAG_CLEAR_SKB), 18490 }, 18491 { 18492 .cmd = NL80211_CMD_DISCONNECT, 18493 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18494 .doit = nl80211_disconnect, 18495 .flags = GENL_UNS_ADMIN_PERM, 18496 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18497 }, 18498 { 18499 .cmd = NL80211_CMD_SET_WIPHY_NETNS, 18500 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18501 .doit = nl80211_wiphy_netns, 18502 .flags = GENL_UNS_ADMIN_PERM, 18503 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 18504 NL80211_FLAG_NEED_RTNL | 18505 NL80211_FLAG_NO_WIPHY_MTX), 18506 }, 18507 { 18508 .cmd = NL80211_CMD_GET_SURVEY, 18509 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18510 .dumpit = nl80211_dump_survey, 18511 }, 18512 { 18513 .cmd = NL80211_CMD_SET_PMKSA, 18514 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18515 .doit = nl80211_set_pmksa, 18516 .flags = GENL_UNS_ADMIN_PERM, 18517 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18518 NL80211_FLAG_CLEAR_SKB), 18519 }, 18520 { 18521 .cmd = NL80211_CMD_DEL_PMKSA, 18522 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18523 .doit = nl80211_del_pmksa, 18524 .flags = GENL_UNS_ADMIN_PERM, 18525 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18526 }, 18527 { 18528 .cmd = NL80211_CMD_FLUSH_PMKSA, 18529 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18530 .doit = nl80211_flush_pmksa, 18531 .flags = GENL_UNS_ADMIN_PERM, 18532 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18533 }, 18534 { 18535 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL, 18536 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18537 .doit = nl80211_remain_on_channel, 18538 .flags = GENL_UNS_ADMIN_PERM, 18539 /* FIXME: requiring a link ID here is probably not good */ 18540 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 18541 NL80211_FLAG_MLO_VALID_LINK_ID), 18542 }, 18543 { 18544 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 18545 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18546 .doit = nl80211_cancel_remain_on_channel, 18547 .flags = GENL_UNS_ADMIN_PERM, 18548 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18549 }, 18550 { 18551 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK, 18552 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18553 .doit = nl80211_set_tx_bitrate_mask, 18554 .flags = GENL_UNS_ADMIN_PERM, 18555 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18556 NL80211_FLAG_MLO_VALID_LINK_ID), 18557 }, 18558 { 18559 .cmd = NL80211_CMD_REGISTER_FRAME, 18560 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18561 .doit = nl80211_register_mgmt, 18562 .flags = GENL_UNS_ADMIN_PERM, 18563 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 18564 }, 18565 { 18566 .cmd = NL80211_CMD_FRAME, 18567 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18568 .doit = nl80211_tx_mgmt, 18569 .flags = GENL_UNS_ADMIN_PERM, 18570 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18571 }, 18572 { 18573 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL, 18574 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18575 .doit = nl80211_tx_mgmt_cancel_wait, 18576 .flags = GENL_UNS_ADMIN_PERM, 18577 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18578 }, 18579 { 18580 .cmd = NL80211_CMD_SET_POWER_SAVE, 18581 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18582 .doit = nl80211_set_power_save, 18583 .flags = GENL_UNS_ADMIN_PERM, 18584 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18585 }, 18586 { 18587 .cmd = NL80211_CMD_GET_POWER_SAVE, 18588 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18589 .doit = nl80211_get_power_save, 18590 /* can be retrieved by unprivileged users */ 18591 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18592 }, 18593 { 18594 .cmd = NL80211_CMD_SET_CQM, 18595 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18596 .doit = nl80211_set_cqm, 18597 .flags = GENL_UNS_ADMIN_PERM, 18598 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18599 }, 18600 { 18601 .cmd = NL80211_CMD_SET_CHANNEL, 18602 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18603 .doit = nl80211_set_channel, 18604 .flags = GENL_UNS_ADMIN_PERM, 18605 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18606 NL80211_FLAG_MLO_VALID_LINK_ID), 18607 }, 18608 { 18609 .cmd = NL80211_CMD_JOIN_MESH, 18610 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18611 .doit = nl80211_join_mesh, 18612 .flags = GENL_UNS_ADMIN_PERM, 18613 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18614 }, 18615 { 18616 .cmd = NL80211_CMD_LEAVE_MESH, 18617 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18618 .doit = nl80211_leave_mesh, 18619 .flags = GENL_UNS_ADMIN_PERM, 18620 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18621 }, 18622 { 18623 .cmd = NL80211_CMD_JOIN_OCB, 18624 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18625 .doit = nl80211_join_ocb, 18626 .flags = GENL_UNS_ADMIN_PERM, 18627 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18628 }, 18629 { 18630 .cmd = NL80211_CMD_LEAVE_OCB, 18631 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18632 .doit = nl80211_leave_ocb, 18633 .flags = GENL_UNS_ADMIN_PERM, 18634 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18635 }, 18636 #ifdef CONFIG_PM 18637 { 18638 .cmd = NL80211_CMD_GET_WOWLAN, 18639 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18640 .doit = nl80211_get_wowlan, 18641 /* can be retrieved by unprivileged users */ 18642 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18643 }, 18644 { 18645 .cmd = NL80211_CMD_SET_WOWLAN, 18646 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18647 .doit = nl80211_set_wowlan, 18648 .flags = GENL_UNS_ADMIN_PERM, 18649 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18650 }, 18651 #endif 18652 { 18653 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD, 18654 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18655 .doit = nl80211_set_rekey_data, 18656 .flags = GENL_UNS_ADMIN_PERM, 18657 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18658 NL80211_FLAG_CLEAR_SKB), 18659 }, 18660 { 18661 .cmd = NL80211_CMD_TDLS_MGMT, 18662 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18663 .doit = nl80211_tdls_mgmt, 18664 .flags = GENL_UNS_ADMIN_PERM, 18665 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18666 NL80211_FLAG_MLO_VALID_LINK_ID), 18667 }, 18668 { 18669 .cmd = NL80211_CMD_TDLS_OPER, 18670 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18671 .doit = nl80211_tdls_oper, 18672 .flags = GENL_UNS_ADMIN_PERM, 18673 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18674 }, 18675 { 18676 .cmd = NL80211_CMD_UNEXPECTED_FRAME, 18677 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18678 .doit = nl80211_register_unexpected_frame, 18679 .flags = GENL_UNS_ADMIN_PERM, 18680 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18681 }, 18682 { 18683 .cmd = NL80211_CMD_PROBE_CLIENT, 18684 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18685 .doit = nl80211_probe_client, 18686 .flags = GENL_UNS_ADMIN_PERM, 18687 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18688 }, 18689 { 18690 .cmd = NL80211_CMD_REGISTER_BEACONS, 18691 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18692 .doit = nl80211_register_beacons, 18693 .flags = GENL_UNS_ADMIN_PERM, 18694 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18695 }, 18696 { 18697 .cmd = NL80211_CMD_SET_NOACK_MAP, 18698 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18699 .doit = nl80211_set_noack_map, 18700 .flags = GENL_UNS_ADMIN_PERM, 18701 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18702 }, 18703 { 18704 .cmd = NL80211_CMD_START_P2P_DEVICE, 18705 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18706 .doit = nl80211_start_p2p_device, 18707 .flags = GENL_UNS_ADMIN_PERM, 18708 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 18709 NL80211_FLAG_NEED_RTNL), 18710 }, 18711 { 18712 .cmd = NL80211_CMD_STOP_P2P_DEVICE, 18713 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18714 .doit = nl80211_stop_p2p_device, 18715 .flags = GENL_UNS_ADMIN_PERM, 18716 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 18717 NL80211_FLAG_NEED_RTNL), 18718 }, 18719 { 18720 .cmd = NL80211_CMD_START_NAN, 18721 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18722 .doit = nl80211_start_nan, 18723 .flags = GENL_ADMIN_PERM, 18724 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 18725 NL80211_FLAG_NEED_RTNL), 18726 }, 18727 { 18728 .cmd = NL80211_CMD_STOP_NAN, 18729 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18730 .doit = nl80211_stop_nan, 18731 .flags = GENL_ADMIN_PERM, 18732 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 18733 NL80211_FLAG_NEED_RTNL), 18734 }, 18735 { 18736 .cmd = NL80211_CMD_ADD_NAN_FUNCTION, 18737 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18738 .doit = nl80211_nan_add_func, 18739 .flags = GENL_ADMIN_PERM, 18740 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18741 }, 18742 { 18743 .cmd = NL80211_CMD_DEL_NAN_FUNCTION, 18744 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18745 .doit = nl80211_nan_del_func, 18746 .flags = GENL_ADMIN_PERM, 18747 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18748 }, 18749 { 18750 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG, 18751 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18752 .doit = nl80211_nan_change_config, 18753 .flags = GENL_ADMIN_PERM, 18754 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18755 }, 18756 { 18757 .cmd = NL80211_CMD_SET_MCAST_RATE, 18758 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18759 .doit = nl80211_set_mcast_rate, 18760 .flags = GENL_UNS_ADMIN_PERM, 18761 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18762 }, 18763 { 18764 .cmd = NL80211_CMD_SET_MAC_ACL, 18765 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18766 .doit = nl80211_set_mac_acl, 18767 .flags = GENL_UNS_ADMIN_PERM, 18768 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18769 NL80211_FLAG_MLO_UNSUPPORTED), 18770 }, 18771 { 18772 .cmd = NL80211_CMD_RADAR_DETECT, 18773 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18774 .doit = nl80211_start_radar_detection, 18775 .flags = GENL_UNS_ADMIN_PERM, 18776 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18777 NL80211_FLAG_NO_WIPHY_MTX | 18778 NL80211_FLAG_MLO_VALID_LINK_ID), 18779 }, 18780 { 18781 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES, 18782 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18783 .doit = nl80211_get_protocol_features, 18784 }, 18785 { 18786 .cmd = NL80211_CMD_UPDATE_FT_IES, 18787 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18788 .doit = nl80211_update_ft_ies, 18789 .flags = GENL_UNS_ADMIN_PERM, 18790 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18791 }, 18792 { 18793 .cmd = NL80211_CMD_CRIT_PROTOCOL_START, 18794 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18795 .doit = nl80211_crit_protocol_start, 18796 .flags = GENL_UNS_ADMIN_PERM, 18797 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18798 }, 18799 { 18800 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP, 18801 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18802 .doit = nl80211_crit_protocol_stop, 18803 .flags = GENL_UNS_ADMIN_PERM, 18804 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18805 }, 18806 { 18807 .cmd = NL80211_CMD_GET_COALESCE, 18808 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18809 .doit = nl80211_get_coalesce, 18810 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18811 }, 18812 { 18813 .cmd = NL80211_CMD_SET_COALESCE, 18814 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18815 .doit = nl80211_set_coalesce, 18816 .flags = GENL_UNS_ADMIN_PERM, 18817 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18818 }, 18819 { 18820 .cmd = NL80211_CMD_CHANNEL_SWITCH, 18821 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18822 .doit = nl80211_channel_switch, 18823 .flags = GENL_UNS_ADMIN_PERM, 18824 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18825 NL80211_FLAG_MLO_VALID_LINK_ID), 18826 }, 18827 { 18828 .cmd = NL80211_CMD_VENDOR, 18829 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18830 .doit = nl80211_vendor_cmd, 18831 .dumpit = nl80211_vendor_cmd_dump, 18832 .flags = GENL_UNS_ADMIN_PERM, 18833 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 18834 NL80211_FLAG_CLEAR_SKB), 18835 }, 18836 { 18837 .cmd = NL80211_CMD_SET_QOS_MAP, 18838 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18839 .doit = nl80211_set_qos_map, 18840 .flags = GENL_UNS_ADMIN_PERM, 18841 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18842 }, 18843 { 18844 .cmd = NL80211_CMD_ADD_TX_TS, 18845 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18846 .doit = nl80211_add_tx_ts, 18847 .flags = GENL_UNS_ADMIN_PERM, 18848 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18849 NL80211_FLAG_MLO_UNSUPPORTED), 18850 }, 18851 { 18852 .cmd = NL80211_CMD_DEL_TX_TS, 18853 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18854 .doit = nl80211_del_tx_ts, 18855 .flags = GENL_UNS_ADMIN_PERM, 18856 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18857 }, 18858 { 18859 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH, 18860 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18861 .doit = nl80211_tdls_channel_switch, 18862 .flags = GENL_UNS_ADMIN_PERM, 18863 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18864 }, 18865 { 18866 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH, 18867 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18868 .doit = nl80211_tdls_cancel_channel_switch, 18869 .flags = GENL_UNS_ADMIN_PERM, 18870 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18871 }, 18872 { 18873 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST, 18874 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18875 .doit = nl80211_set_multicast_to_unicast, 18876 .flags = GENL_UNS_ADMIN_PERM, 18877 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18878 }, 18879 { 18880 .cmd = NL80211_CMD_SET_PMK, 18881 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18882 .doit = nl80211_set_pmk, 18883 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18884 NL80211_FLAG_CLEAR_SKB), 18885 }, 18886 { 18887 .cmd = NL80211_CMD_DEL_PMK, 18888 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18889 .doit = nl80211_del_pmk, 18890 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18891 }, 18892 { 18893 .cmd = NL80211_CMD_EXTERNAL_AUTH, 18894 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18895 .doit = nl80211_external_auth, 18896 .flags = GENL_ADMIN_PERM, 18897 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18898 }, 18899 { 18900 .cmd = NL80211_CMD_CONTROL_PORT_FRAME, 18901 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18902 .doit = nl80211_tx_control_port, 18903 .flags = GENL_UNS_ADMIN_PERM, 18904 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18905 }, 18906 { 18907 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS, 18908 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18909 .doit = nl80211_get_ftm_responder_stats, 18910 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18911 NL80211_FLAG_MLO_VALID_LINK_ID), 18912 }, 18913 { 18914 .cmd = NL80211_CMD_PEER_MEASUREMENT_START, 18915 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18916 .doit = nl80211_pmsr_start, 18917 .flags = GENL_UNS_ADMIN_PERM, 18918 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18919 }, 18920 { 18921 .cmd = NL80211_CMD_NOTIFY_RADAR, 18922 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18923 .doit = nl80211_notify_radar_detection, 18924 .flags = GENL_UNS_ADMIN_PERM, 18925 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18926 }, 18927 { 18928 .cmd = NL80211_CMD_UPDATE_OWE_INFO, 18929 .doit = nl80211_update_owe_info, 18930 .flags = GENL_ADMIN_PERM, 18931 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18932 }, 18933 { 18934 .cmd = NL80211_CMD_PROBE_MESH_LINK, 18935 .doit = nl80211_probe_mesh_link, 18936 .flags = GENL_UNS_ADMIN_PERM, 18937 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18938 }, 18939 { 18940 .cmd = NL80211_CMD_SET_TID_CONFIG, 18941 .doit = nl80211_set_tid_config, 18942 .flags = GENL_UNS_ADMIN_PERM, 18943 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18944 NL80211_FLAG_MLO_VALID_LINK_ID), 18945 }, 18946 { 18947 .cmd = NL80211_CMD_SET_SAR_SPECS, 18948 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18949 .doit = nl80211_set_sar_specs, 18950 .flags = GENL_UNS_ADMIN_PERM, 18951 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 18952 NL80211_FLAG_NEED_RTNL), 18953 }, 18954 { 18955 .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST, 18956 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18957 .doit = nl80211_color_change, 18958 .flags = GENL_UNS_ADMIN_PERM, 18959 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18960 NL80211_FLAG_MLO_VALID_LINK_ID), 18961 }, 18962 { 18963 .cmd = NL80211_CMD_SET_FILS_AAD, 18964 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18965 .doit = nl80211_set_fils_aad, 18966 .flags = GENL_UNS_ADMIN_PERM, 18967 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18968 }, 18969 { 18970 .cmd = NL80211_CMD_ADD_LINK, 18971 .doit = nl80211_add_link, 18972 .flags = GENL_UNS_ADMIN_PERM, 18973 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18974 }, 18975 { 18976 .cmd = NL80211_CMD_REMOVE_LINK, 18977 .doit = nl80211_remove_link, 18978 .flags = GENL_UNS_ADMIN_PERM, 18979 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18980 NL80211_FLAG_MLO_VALID_LINK_ID), 18981 }, 18982 { 18983 .cmd = NL80211_CMD_ADD_LINK_STA, 18984 .doit = nl80211_add_link_station, 18985 .flags = GENL_UNS_ADMIN_PERM, 18986 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18987 NL80211_FLAG_MLO_VALID_LINK_ID), 18988 }, 18989 { 18990 .cmd = NL80211_CMD_MODIFY_LINK_STA, 18991 .doit = nl80211_modify_link_station, 18992 .flags = GENL_UNS_ADMIN_PERM, 18993 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18994 NL80211_FLAG_MLO_VALID_LINK_ID), 18995 }, 18996 { 18997 .cmd = NL80211_CMD_REMOVE_LINK_STA, 18998 .doit = nl80211_remove_link_station, 18999 .flags = GENL_UNS_ADMIN_PERM, 19000 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 19001 NL80211_FLAG_MLO_VALID_LINK_ID), 19002 }, 19003 { 19004 .cmd = NL80211_CMD_SET_HW_TIMESTAMP, 19005 .doit = nl80211_set_hw_timestamp, 19006 .flags = GENL_UNS_ADMIN_PERM, 19007 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 19008 }, 19009 { 19010 .cmd = NL80211_CMD_SET_TID_TO_LINK_MAPPING, 19011 .doit = nl80211_set_ttlm, 19012 .flags = GENL_UNS_ADMIN_PERM, 19013 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 19014 }, 19015 { 19016 .cmd = NL80211_CMD_ASSOC_MLO_RECONF, 19017 .doit = nl80211_assoc_ml_reconf, 19018 .flags = GENL_UNS_ADMIN_PERM, 19019 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 19020 }, 19021 { 19022 .cmd = NL80211_CMD_EPCS_CFG, 19023 .doit = nl80211_epcs_cfg, 19024 .flags = GENL_UNS_ADMIN_PERM, 19025 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 19026 }, 19027 }; 19028 19029 static struct genl_family nl80211_fam __ro_after_init = { 19030 .name = NL80211_GENL_NAME, /* have users key off the name instead */ 19031 .hdrsize = 0, /* no private header */ 19032 .version = 1, /* no particular meaning now */ 19033 .maxattr = NL80211_ATTR_MAX, 19034 .policy = nl80211_policy, 19035 .netnsok = true, 19036 .pre_doit = nl80211_pre_doit, 19037 .post_doit = nl80211_post_doit, 19038 .module = THIS_MODULE, 19039 .ops = nl80211_ops, 19040 .n_ops = ARRAY_SIZE(nl80211_ops), 19041 .small_ops = nl80211_small_ops, 19042 .n_small_ops = ARRAY_SIZE(nl80211_small_ops), 19043 .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1, 19044 .mcgrps = nl80211_mcgrps, 19045 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps), 19046 .parallel_ops = true, 19047 }; 19048 19049 /* notification functions */ 19050 19051 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev, 19052 enum nl80211_commands cmd) 19053 { 19054 struct sk_buff *msg; 19055 struct nl80211_dump_wiphy_state state = {}; 19056 19057 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY && 19058 cmd != NL80211_CMD_DEL_WIPHY); 19059 19060 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19061 if (!msg) 19062 return; 19063 19064 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) { 19065 nlmsg_free(msg); 19066 return; 19067 } 19068 19069 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19070 NL80211_MCGRP_CONFIG, GFP_KERNEL); 19071 } 19072 19073 void nl80211_notify_iface(struct cfg80211_registered_device *rdev, 19074 struct wireless_dev *wdev, 19075 enum nl80211_commands cmd) 19076 { 19077 struct sk_buff *msg; 19078 19079 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19080 if (!msg) 19081 return; 19082 19083 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) { 19084 nlmsg_free(msg); 19085 return; 19086 } 19087 19088 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19089 NL80211_MCGRP_CONFIG, GFP_KERNEL); 19090 } 19091 19092 static int nl80211_add_scan_req(struct sk_buff *msg, 19093 struct cfg80211_registered_device *rdev) 19094 { 19095 struct cfg80211_scan_request_int *req = rdev->scan_req; 19096 struct nlattr *nest; 19097 int i; 19098 struct cfg80211_scan_info *info; 19099 19100 if (WARN_ON(!req)) 19101 return 0; 19102 19103 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS); 19104 if (!nest) 19105 goto nla_put_failure; 19106 for (i = 0; i < req->req.n_ssids; i++) { 19107 if (nla_put(msg, i, req->req.ssids[i].ssid_len, 19108 req->req.ssids[i].ssid)) 19109 goto nla_put_failure; 19110 } 19111 nla_nest_end(msg, nest); 19112 19113 if (req->req.flags & NL80211_SCAN_FLAG_FREQ_KHZ) { 19114 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ); 19115 if (!nest) 19116 goto nla_put_failure; 19117 for (i = 0; i < req->req.n_channels; i++) { 19118 if (nla_put_u32(msg, i, 19119 ieee80211_channel_to_khz(req->req.channels[i]))) 19120 goto nla_put_failure; 19121 } 19122 nla_nest_end(msg, nest); 19123 } else { 19124 nest = nla_nest_start_noflag(msg, 19125 NL80211_ATTR_SCAN_FREQUENCIES); 19126 if (!nest) 19127 goto nla_put_failure; 19128 for (i = 0; i < req->req.n_channels; i++) { 19129 if (nla_put_u32(msg, i, 19130 req->req.channels[i]->center_freq)) 19131 goto nla_put_failure; 19132 } 19133 nla_nest_end(msg, nest); 19134 } 19135 19136 if (req->req.ie && 19137 nla_put(msg, NL80211_ATTR_IE, req->req.ie_len, req->req.ie)) 19138 goto nla_put_failure; 19139 19140 if (req->req.flags && 19141 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->req.flags)) 19142 goto nla_put_failure; 19143 19144 info = rdev->int_scan_req ? &rdev->int_scan_req->info : 19145 &rdev->scan_req->info; 19146 if (info->scan_start_tsf && 19147 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF, 19148 info->scan_start_tsf, NL80211_BSS_PAD) || 19149 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN, 19150 info->tsf_bssid))) 19151 goto nla_put_failure; 19152 19153 return 0; 19154 nla_put_failure: 19155 return -ENOBUFS; 19156 } 19157 19158 static int nl80211_prep_scan_msg(struct sk_buff *msg, 19159 struct cfg80211_registered_device *rdev, 19160 struct wireless_dev *wdev, 19161 u32 portid, u32 seq, int flags, 19162 u32 cmd) 19163 { 19164 void *hdr; 19165 19166 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 19167 if (!hdr) 19168 return -1; 19169 19170 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19171 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 19172 wdev->netdev->ifindex)) || 19173 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19174 NL80211_ATTR_PAD)) 19175 goto nla_put_failure; 19176 19177 /* ignore errors and send incomplete event anyway */ 19178 nl80211_add_scan_req(msg, rdev); 19179 19180 genlmsg_end(msg, hdr); 19181 return 0; 19182 19183 nla_put_failure: 19184 genlmsg_cancel(msg, hdr); 19185 return -EMSGSIZE; 19186 } 19187 19188 static int 19189 nl80211_prep_sched_scan_msg(struct sk_buff *msg, 19190 struct cfg80211_sched_scan_request *req, u32 cmd) 19191 { 19192 void *hdr; 19193 19194 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19195 if (!hdr) 19196 return -1; 19197 19198 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, 19199 wiphy_to_rdev(req->wiphy)->wiphy_idx) || 19200 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) || 19201 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid, 19202 NL80211_ATTR_PAD)) 19203 goto nla_put_failure; 19204 19205 genlmsg_end(msg, hdr); 19206 return 0; 19207 19208 nla_put_failure: 19209 genlmsg_cancel(msg, hdr); 19210 return -EMSGSIZE; 19211 } 19212 19213 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev, 19214 struct wireless_dev *wdev) 19215 { 19216 struct sk_buff *msg; 19217 19218 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19219 if (!msg) 19220 return; 19221 19222 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 19223 NL80211_CMD_TRIGGER_SCAN) < 0) { 19224 nlmsg_free(msg); 19225 return; 19226 } 19227 19228 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19229 NL80211_MCGRP_SCAN, GFP_KERNEL); 19230 } 19231 19232 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev, 19233 struct wireless_dev *wdev, bool aborted) 19234 { 19235 struct sk_buff *msg; 19236 19237 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19238 if (!msg) 19239 return NULL; 19240 19241 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 19242 aborted ? NL80211_CMD_SCAN_ABORTED : 19243 NL80211_CMD_NEW_SCAN_RESULTS) < 0) { 19244 nlmsg_free(msg); 19245 return NULL; 19246 } 19247 19248 return msg; 19249 } 19250 19251 /* send message created by nl80211_build_scan_msg() */ 19252 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev, 19253 struct sk_buff *msg) 19254 { 19255 if (!msg) 19256 return; 19257 19258 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19259 NL80211_MCGRP_SCAN, GFP_KERNEL); 19260 } 19261 19262 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd) 19263 { 19264 struct sk_buff *msg; 19265 19266 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19267 if (!msg) 19268 return; 19269 19270 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) { 19271 nlmsg_free(msg); 19272 return; 19273 } 19274 19275 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0, 19276 NL80211_MCGRP_SCAN, GFP_KERNEL); 19277 } 19278 19279 static bool nl80211_reg_change_event_fill(struct sk_buff *msg, 19280 struct regulatory_request *request) 19281 { 19282 /* Userspace can always count this one always being set */ 19283 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator)) 19284 goto nla_put_failure; 19285 19286 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') { 19287 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19288 NL80211_REGDOM_TYPE_WORLD)) 19289 goto nla_put_failure; 19290 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') { 19291 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19292 NL80211_REGDOM_TYPE_CUSTOM_WORLD)) 19293 goto nla_put_failure; 19294 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') || 19295 request->intersect) { 19296 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19297 NL80211_REGDOM_TYPE_INTERSECTION)) 19298 goto nla_put_failure; 19299 } else { 19300 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19301 NL80211_REGDOM_TYPE_COUNTRY) || 19302 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, 19303 request->alpha2)) 19304 goto nla_put_failure; 19305 } 19306 19307 if (request->wiphy_idx != WIPHY_IDX_INVALID) { 19308 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx); 19309 19310 if (wiphy && 19311 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx)) 19312 goto nla_put_failure; 19313 19314 if (wiphy && 19315 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 19316 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 19317 goto nla_put_failure; 19318 } 19319 19320 return true; 19321 19322 nla_put_failure: 19323 return false; 19324 } 19325 19326 /* 19327 * This can happen on global regulatory changes or device specific settings 19328 * based on custom regulatory domains. 19329 */ 19330 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id, 19331 struct regulatory_request *request) 19332 { 19333 struct sk_buff *msg; 19334 void *hdr; 19335 19336 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19337 if (!msg) 19338 return; 19339 19340 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id); 19341 if (!hdr) 19342 goto nla_put_failure; 19343 19344 if (!nl80211_reg_change_event_fill(msg, request)) 19345 goto nla_put_failure; 19346 19347 genlmsg_end(msg, hdr); 19348 19349 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 19350 NL80211_MCGRP_REGULATORY); 19351 19352 return; 19353 19354 nla_put_failure: 19355 nlmsg_free(msg); 19356 } 19357 19358 struct nl80211_mlme_event { 19359 enum nl80211_commands cmd; 19360 const u8 *buf; 19361 size_t buf_len; 19362 int uapsd_queues; 19363 const u8 *req_ies; 19364 size_t req_ies_len; 19365 bool reconnect; 19366 }; 19367 19368 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev, 19369 struct net_device *netdev, 19370 const struct nl80211_mlme_event *event, 19371 gfp_t gfp) 19372 { 19373 struct sk_buff *msg; 19374 void *hdr; 19375 19376 msg = nlmsg_new(100 + event->buf_len + event->req_ies_len, gfp); 19377 if (!msg) 19378 return; 19379 19380 hdr = nl80211hdr_put(msg, 0, 0, 0, event->cmd); 19381 if (!hdr) { 19382 nlmsg_free(msg); 19383 return; 19384 } 19385 19386 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19387 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19388 nla_put(msg, NL80211_ATTR_FRAME, event->buf_len, event->buf) || 19389 (event->req_ies && 19390 nla_put(msg, NL80211_ATTR_REQ_IE, event->req_ies_len, 19391 event->req_ies))) 19392 goto nla_put_failure; 19393 19394 if (event->reconnect && 19395 nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED)) 19396 goto nla_put_failure; 19397 19398 if (event->uapsd_queues >= 0) { 19399 struct nlattr *nla_wmm = 19400 nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME); 19401 if (!nla_wmm) 19402 goto nla_put_failure; 19403 19404 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES, 19405 event->uapsd_queues)) 19406 goto nla_put_failure; 19407 19408 nla_nest_end(msg, nla_wmm); 19409 } 19410 19411 genlmsg_end(msg, hdr); 19412 19413 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19414 NL80211_MCGRP_MLME, gfp); 19415 return; 19416 19417 nla_put_failure: 19418 nlmsg_free(msg); 19419 } 19420 19421 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev, 19422 struct net_device *netdev, const u8 *buf, 19423 size_t len, gfp_t gfp) 19424 { 19425 struct nl80211_mlme_event event = { 19426 .cmd = NL80211_CMD_AUTHENTICATE, 19427 .buf = buf, 19428 .buf_len = len, 19429 .uapsd_queues = -1, 19430 }; 19431 19432 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 19433 } 19434 19435 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev, 19436 struct net_device *netdev, 19437 const struct cfg80211_rx_assoc_resp_data *data) 19438 { 19439 struct nl80211_mlme_event event = { 19440 .cmd = NL80211_CMD_ASSOCIATE, 19441 .buf = data->buf, 19442 .buf_len = data->len, 19443 .uapsd_queues = data->uapsd_queues, 19444 .req_ies = data->req_ies, 19445 .req_ies_len = data->req_ies_len, 19446 }; 19447 19448 nl80211_send_mlme_event(rdev, netdev, &event, GFP_KERNEL); 19449 } 19450 19451 void nl80211_send_deauth(struct cfg80211_registered_device *rdev, 19452 struct net_device *netdev, const u8 *buf, 19453 size_t len, bool reconnect, gfp_t gfp) 19454 { 19455 struct nl80211_mlme_event event = { 19456 .cmd = NL80211_CMD_DEAUTHENTICATE, 19457 .buf = buf, 19458 .buf_len = len, 19459 .reconnect = reconnect, 19460 .uapsd_queues = -1, 19461 }; 19462 19463 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 19464 } 19465 19466 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev, 19467 struct net_device *netdev, const u8 *buf, 19468 size_t len, bool reconnect, gfp_t gfp) 19469 { 19470 struct nl80211_mlme_event event = { 19471 .cmd = NL80211_CMD_DISASSOCIATE, 19472 .buf = buf, 19473 .buf_len = len, 19474 .reconnect = reconnect, 19475 .uapsd_queues = -1, 19476 }; 19477 19478 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 19479 } 19480 19481 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf, 19482 size_t len) 19483 { 19484 struct wireless_dev *wdev = dev->ieee80211_ptr; 19485 struct wiphy *wiphy = wdev->wiphy; 19486 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19487 const struct ieee80211_mgmt *mgmt = (void *)buf; 19488 struct nl80211_mlme_event event = { 19489 .buf = buf, 19490 .buf_len = len, 19491 .uapsd_queues = -1, 19492 }; 19493 19494 if (WARN_ON(len < 2)) 19495 return; 19496 19497 if (ieee80211_is_deauth(mgmt->frame_control)) { 19498 event.cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE; 19499 } else if (ieee80211_is_disassoc(mgmt->frame_control)) { 19500 event.cmd = NL80211_CMD_UNPROT_DISASSOCIATE; 19501 } else if (ieee80211_is_beacon(mgmt->frame_control)) { 19502 if (wdev->unprot_beacon_reported && 19503 elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000) 19504 return; 19505 event.cmd = NL80211_CMD_UNPROT_BEACON; 19506 wdev->unprot_beacon_reported = jiffies; 19507 } else { 19508 return; 19509 } 19510 19511 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len); 19512 nl80211_send_mlme_event(rdev, dev, &event, GFP_ATOMIC); 19513 } 19514 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt); 19515 19516 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev, 19517 struct net_device *netdev, int cmd, 19518 const u8 *addr, gfp_t gfp) 19519 { 19520 struct sk_buff *msg; 19521 void *hdr; 19522 19523 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19524 if (!msg) 19525 return; 19526 19527 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19528 if (!hdr) { 19529 nlmsg_free(msg); 19530 return; 19531 } 19532 19533 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19534 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19535 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 19536 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 19537 goto nla_put_failure; 19538 19539 genlmsg_end(msg, hdr); 19540 19541 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19542 NL80211_MCGRP_MLME, gfp); 19543 return; 19544 19545 nla_put_failure: 19546 nlmsg_free(msg); 19547 } 19548 19549 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev, 19550 struct net_device *netdev, const u8 *addr, 19551 gfp_t gfp) 19552 { 19553 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE, 19554 addr, gfp); 19555 } 19556 19557 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev, 19558 struct net_device *netdev, const u8 *addr, 19559 gfp_t gfp) 19560 { 19561 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE, 19562 addr, gfp); 19563 } 19564 19565 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev, 19566 struct net_device *netdev, 19567 struct cfg80211_connect_resp_params *cr, 19568 gfp_t gfp) 19569 { 19570 struct sk_buff *msg; 19571 void *hdr; 19572 unsigned int link; 19573 size_t link_info_size = 0; 19574 const u8 *connected_addr = cr->valid_links ? 19575 cr->ap_mld_addr : cr->links[0].bssid; 19576 19577 if (cr->valid_links) { 19578 for_each_valid_link(cr, link) { 19579 /* Nested attribute header */ 19580 link_info_size += NLA_HDRLEN; 19581 /* Link ID */ 19582 link_info_size += nla_total_size(sizeof(u8)); 19583 link_info_size += cr->links[link].addr ? 19584 nla_total_size(ETH_ALEN) : 0; 19585 link_info_size += (cr->links[link].bssid || 19586 cr->links[link].bss) ? 19587 nla_total_size(ETH_ALEN) : 0; 19588 link_info_size += nla_total_size(sizeof(u16)); 19589 } 19590 } 19591 19592 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len + 19593 cr->fils.kek_len + cr->fils.pmk_len + 19594 (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size, 19595 gfp); 19596 if (!msg) 19597 return; 19598 19599 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT); 19600 if (!hdr) { 19601 nlmsg_free(msg); 19602 return; 19603 } 19604 19605 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19606 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19607 (connected_addr && 19608 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) || 19609 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 19610 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE : 19611 cr->status) || 19612 (cr->status < 0 && 19613 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 19614 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON, 19615 cr->timeout_reason))) || 19616 (cr->req_ie && 19617 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) || 19618 (cr->resp_ie && 19619 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len, 19620 cr->resp_ie)) || 19621 (cr->fils.update_erp_next_seq_num && 19622 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 19623 cr->fils.erp_next_seq_num)) || 19624 (cr->status == WLAN_STATUS_SUCCESS && 19625 ((cr->fils.kek && 19626 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len, 19627 cr->fils.kek)) || 19628 (cr->fils.pmk && 19629 nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) || 19630 (cr->fils.pmkid && 19631 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid))))) 19632 goto nla_put_failure; 19633 19634 if (cr->valid_links) { 19635 int i = 1; 19636 struct nlattr *nested; 19637 19638 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 19639 if (!nested) 19640 goto nla_put_failure; 19641 19642 for_each_valid_link(cr, link) { 19643 struct nlattr *nested_mlo_links; 19644 const u8 *bssid = cr->links[link].bss ? 19645 cr->links[link].bss->bssid : 19646 cr->links[link].bssid; 19647 19648 nested_mlo_links = nla_nest_start(msg, i); 19649 if (!nested_mlo_links) 19650 goto nla_put_failure; 19651 19652 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 19653 (bssid && 19654 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 19655 (cr->links[link].addr && 19656 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 19657 cr->links[link].addr)) || 19658 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 19659 cr->links[link].status)) 19660 goto nla_put_failure; 19661 19662 nla_nest_end(msg, nested_mlo_links); 19663 i++; 19664 } 19665 nla_nest_end(msg, nested); 19666 } 19667 19668 genlmsg_end(msg, hdr); 19669 19670 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19671 NL80211_MCGRP_MLME, gfp); 19672 return; 19673 19674 nla_put_failure: 19675 nlmsg_free(msg); 19676 } 19677 19678 void nl80211_send_roamed(struct cfg80211_registered_device *rdev, 19679 struct net_device *netdev, 19680 struct cfg80211_roam_info *info, gfp_t gfp) 19681 { 19682 struct sk_buff *msg; 19683 void *hdr; 19684 size_t link_info_size = 0; 19685 unsigned int link; 19686 const u8 *connected_addr = info->ap_mld_addr ? 19687 info->ap_mld_addr : 19688 (info->links[0].bss ? 19689 info->links[0].bss->bssid : 19690 info->links[0].bssid); 19691 19692 if (info->valid_links) { 19693 for_each_valid_link(info, link) { 19694 /* Nested attribute header */ 19695 link_info_size += NLA_HDRLEN; 19696 /* Link ID */ 19697 link_info_size += nla_total_size(sizeof(u8)); 19698 link_info_size += info->links[link].addr ? 19699 nla_total_size(ETH_ALEN) : 0; 19700 link_info_size += (info->links[link].bssid || 19701 info->links[link].bss) ? 19702 nla_total_size(ETH_ALEN) : 0; 19703 } 19704 } 19705 19706 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len + 19707 info->fils.kek_len + info->fils.pmk_len + 19708 (info->fils.pmkid ? WLAN_PMKID_LEN : 0) + 19709 link_info_size, gfp); 19710 if (!msg) 19711 return; 19712 19713 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM); 19714 if (!hdr) { 19715 nlmsg_free(msg); 19716 return; 19717 } 19718 19719 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19720 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19721 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) || 19722 (info->req_ie && 19723 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len, 19724 info->req_ie)) || 19725 (info->resp_ie && 19726 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len, 19727 info->resp_ie)) || 19728 (info->fils.update_erp_next_seq_num && 19729 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 19730 info->fils.erp_next_seq_num)) || 19731 (info->fils.kek && 19732 nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len, 19733 info->fils.kek)) || 19734 (info->fils.pmk && 19735 nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) || 19736 (info->fils.pmkid && 19737 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid))) 19738 goto nla_put_failure; 19739 19740 if (info->valid_links) { 19741 int i = 1; 19742 struct nlattr *nested; 19743 19744 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 19745 if (!nested) 19746 goto nla_put_failure; 19747 19748 for_each_valid_link(info, link) { 19749 struct nlattr *nested_mlo_links; 19750 const u8 *bssid = info->links[link].bss ? 19751 info->links[link].bss->bssid : 19752 info->links[link].bssid; 19753 19754 nested_mlo_links = nla_nest_start(msg, i); 19755 if (!nested_mlo_links) 19756 goto nla_put_failure; 19757 19758 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 19759 (bssid && 19760 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 19761 (info->links[link].addr && 19762 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 19763 info->links[link].addr))) 19764 goto nla_put_failure; 19765 19766 nla_nest_end(msg, nested_mlo_links); 19767 i++; 19768 } 19769 nla_nest_end(msg, nested); 19770 } 19771 19772 genlmsg_end(msg, hdr); 19773 19774 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19775 NL80211_MCGRP_MLME, gfp); 19776 return; 19777 19778 nla_put_failure: 19779 nlmsg_free(msg); 19780 } 19781 19782 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev, 19783 struct net_device *netdev, const u8 *peer_addr, 19784 const u8 *td_bitmap, u8 td_bitmap_len) 19785 { 19786 struct sk_buff *msg; 19787 void *hdr; 19788 19789 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19790 if (!msg) 19791 return; 19792 19793 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED); 19794 if (!hdr) { 19795 nlmsg_free(msg); 19796 return; 19797 } 19798 19799 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19800 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19801 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr)) 19802 goto nla_put_failure; 19803 19804 if (td_bitmap_len > 0 && td_bitmap && 19805 nla_put(msg, NL80211_ATTR_TD_BITMAP, td_bitmap_len, td_bitmap)) 19806 goto nla_put_failure; 19807 19808 genlmsg_end(msg, hdr); 19809 19810 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19811 NL80211_MCGRP_MLME, GFP_KERNEL); 19812 return; 19813 19814 nla_put_failure: 19815 nlmsg_free(msg); 19816 } 19817 19818 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev, 19819 struct net_device *netdev, u16 reason, 19820 const u8 *ie, size_t ie_len, bool from_ap) 19821 { 19822 struct sk_buff *msg; 19823 void *hdr; 19824 19825 msg = nlmsg_new(100 + ie_len, GFP_KERNEL); 19826 if (!msg) 19827 return; 19828 19829 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT); 19830 if (!hdr) { 19831 nlmsg_free(msg); 19832 return; 19833 } 19834 19835 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19836 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19837 (reason && 19838 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) || 19839 (from_ap && 19840 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) || 19841 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie))) 19842 goto nla_put_failure; 19843 19844 genlmsg_end(msg, hdr); 19845 19846 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19847 NL80211_MCGRP_MLME, GFP_KERNEL); 19848 return; 19849 19850 nla_put_failure: 19851 nlmsg_free(msg); 19852 } 19853 19854 void cfg80211_links_removed(struct net_device *dev, u16 link_mask) 19855 { 19856 struct wireless_dev *wdev = dev->ieee80211_ptr; 19857 struct wiphy *wiphy = wdev->wiphy; 19858 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19859 struct sk_buff *msg; 19860 struct nlattr *links; 19861 void *hdr; 19862 19863 lockdep_assert_wiphy(wdev->wiphy); 19864 trace_cfg80211_links_removed(dev, link_mask); 19865 19866 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION && 19867 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)) 19868 return; 19869 19870 if (WARN_ON(!wdev->valid_links || !link_mask || 19871 (wdev->valid_links & link_mask) != link_mask || 19872 wdev->valid_links == link_mask)) 19873 return; 19874 19875 cfg80211_wdev_release_link_bsses(wdev, link_mask); 19876 wdev->valid_links &= ~link_mask; 19877 19878 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19879 if (!msg) 19880 return; 19881 19882 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_LINKS_REMOVED); 19883 if (!hdr) { 19884 nlmsg_free(msg); 19885 return; 19886 } 19887 19888 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19889 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19890 goto nla_put_failure; 19891 19892 links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 19893 if (!links) 19894 goto nla_put_failure; 19895 19896 while (link_mask) { 19897 struct nlattr *link; 19898 int link_id = __ffs(link_mask); 19899 19900 link = nla_nest_start(msg, link_id + 1); 19901 if (!link) 19902 goto nla_put_failure; 19903 19904 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19905 goto nla_put_failure; 19906 19907 nla_nest_end(msg, link); 19908 link_mask &= ~(1 << link_id); 19909 } 19910 19911 nla_nest_end(msg, links); 19912 19913 genlmsg_end(msg, hdr); 19914 19915 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19916 NL80211_MCGRP_MLME, GFP_KERNEL); 19917 return; 19918 19919 nla_put_failure: 19920 nlmsg_free(msg); 19921 } 19922 EXPORT_SYMBOL(cfg80211_links_removed); 19923 19924 void nl80211_mlo_reconf_add_done(struct net_device *dev, 19925 struct cfg80211_mlo_reconf_done_data *data) 19926 { 19927 struct wireless_dev *wdev = dev->ieee80211_ptr; 19928 struct wiphy *wiphy = wdev->wiphy; 19929 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19930 struct nl80211_mlme_event event = { 19931 .cmd = NL80211_CMD_ASSOC_MLO_RECONF, 19932 .buf = data->buf, 19933 .buf_len = data->len, 19934 .uapsd_queues = -1, 19935 }; 19936 19937 nl80211_send_mlme_event(rdev, dev, &event, GFP_KERNEL); 19938 } 19939 EXPORT_SYMBOL(nl80211_mlo_reconf_add_done); 19940 19941 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev, 19942 struct net_device *netdev, const u8 *bssid, 19943 gfp_t gfp) 19944 { 19945 struct sk_buff *msg; 19946 void *hdr; 19947 19948 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19949 if (!msg) 19950 return; 19951 19952 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS); 19953 if (!hdr) { 19954 nlmsg_free(msg); 19955 return; 19956 } 19957 19958 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19959 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19960 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 19961 goto nla_put_failure; 19962 19963 genlmsg_end(msg, hdr); 19964 19965 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19966 NL80211_MCGRP_MLME, gfp); 19967 return; 19968 19969 nla_put_failure: 19970 nlmsg_free(msg); 19971 } 19972 19973 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr, 19974 const u8 *ie, u8 ie_len, 19975 int sig_dbm, gfp_t gfp) 19976 { 19977 struct wireless_dev *wdev = dev->ieee80211_ptr; 19978 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19979 struct sk_buff *msg; 19980 void *hdr; 19981 19982 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT)) 19983 return; 19984 19985 trace_cfg80211_notify_new_peer_candidate(dev, addr); 19986 19987 msg = nlmsg_new(100 + ie_len, gfp); 19988 if (!msg) 19989 return; 19990 19991 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE); 19992 if (!hdr) { 19993 nlmsg_free(msg); 19994 return; 19995 } 19996 19997 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19998 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19999 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 20000 (ie_len && ie && 20001 nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) || 20002 (sig_dbm && 20003 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm))) 20004 goto nla_put_failure; 20005 20006 genlmsg_end(msg, hdr); 20007 20008 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20009 NL80211_MCGRP_MLME, gfp); 20010 return; 20011 20012 nla_put_failure: 20013 nlmsg_free(msg); 20014 } 20015 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate); 20016 20017 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev, 20018 struct net_device *netdev, const u8 *addr, 20019 enum nl80211_key_type key_type, int key_id, 20020 const u8 *tsc, gfp_t gfp) 20021 { 20022 struct sk_buff *msg; 20023 void *hdr; 20024 20025 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20026 if (!msg) 20027 return; 20028 20029 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE); 20030 if (!hdr) { 20031 nlmsg_free(msg); 20032 return; 20033 } 20034 20035 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20036 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20037 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) || 20038 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) || 20039 (key_id != -1 && 20040 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) || 20041 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc))) 20042 goto nla_put_failure; 20043 20044 genlmsg_end(msg, hdr); 20045 20046 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20047 NL80211_MCGRP_MLME, gfp); 20048 return; 20049 20050 nla_put_failure: 20051 nlmsg_free(msg); 20052 } 20053 20054 void nl80211_send_beacon_hint_event(struct wiphy *wiphy, 20055 struct ieee80211_channel *channel_before, 20056 struct ieee80211_channel *channel_after) 20057 { 20058 struct sk_buff *msg; 20059 void *hdr; 20060 struct nlattr *nl_freq; 20061 20062 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC); 20063 if (!msg) 20064 return; 20065 20066 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT); 20067 if (!hdr) { 20068 nlmsg_free(msg); 20069 return; 20070 } 20071 20072 /* 20073 * Since we are applying the beacon hint to a wiphy we know its 20074 * wiphy_idx is valid 20075 */ 20076 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 20077 goto nla_put_failure; 20078 20079 /* Before */ 20080 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE); 20081 if (!nl_freq) 20082 goto nla_put_failure; 20083 20084 if (nl80211_msg_put_channel(msg, wiphy, channel_before, false)) 20085 goto nla_put_failure; 20086 nla_nest_end(msg, nl_freq); 20087 20088 /* After */ 20089 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER); 20090 if (!nl_freq) 20091 goto nla_put_failure; 20092 20093 if (nl80211_msg_put_channel(msg, wiphy, channel_after, false)) 20094 goto nla_put_failure; 20095 nla_nest_end(msg, nl_freq); 20096 20097 genlmsg_end(msg, hdr); 20098 20099 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 20100 NL80211_MCGRP_REGULATORY); 20101 20102 return; 20103 20104 nla_put_failure: 20105 nlmsg_free(msg); 20106 } 20107 20108 static void nl80211_send_remain_on_chan_event( 20109 int cmd, struct cfg80211_registered_device *rdev, 20110 struct wireless_dev *wdev, u64 cookie, 20111 struct ieee80211_channel *chan, 20112 unsigned int duration, gfp_t gfp) 20113 { 20114 struct sk_buff *msg; 20115 void *hdr; 20116 20117 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20118 if (!msg) 20119 return; 20120 20121 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 20122 if (!hdr) { 20123 nlmsg_free(msg); 20124 return; 20125 } 20126 20127 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20128 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 20129 wdev->netdev->ifindex)) || 20130 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20131 NL80211_ATTR_PAD) || 20132 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) || 20133 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 20134 NL80211_CHAN_NO_HT) || 20135 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 20136 NL80211_ATTR_PAD)) 20137 goto nla_put_failure; 20138 20139 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL && 20140 nla_put_u32(msg, NL80211_ATTR_DURATION, duration)) 20141 goto nla_put_failure; 20142 20143 genlmsg_end(msg, hdr); 20144 20145 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20146 NL80211_MCGRP_MLME, gfp); 20147 return; 20148 20149 nla_put_failure: 20150 nlmsg_free(msg); 20151 } 20152 20153 void cfg80211_assoc_comeback(struct net_device *netdev, 20154 const u8 *ap_addr, u32 timeout) 20155 { 20156 struct wireless_dev *wdev = netdev->ieee80211_ptr; 20157 struct wiphy *wiphy = wdev->wiphy; 20158 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20159 struct sk_buff *msg; 20160 void *hdr; 20161 20162 trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout); 20163 20164 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 20165 if (!msg) 20166 return; 20167 20168 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK); 20169 if (!hdr) { 20170 nlmsg_free(msg); 20171 return; 20172 } 20173 20174 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20175 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20176 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) || 20177 nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout)) 20178 goto nla_put_failure; 20179 20180 genlmsg_end(msg, hdr); 20181 20182 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20183 NL80211_MCGRP_MLME, GFP_KERNEL); 20184 return; 20185 20186 nla_put_failure: 20187 nlmsg_free(msg); 20188 } 20189 EXPORT_SYMBOL(cfg80211_assoc_comeback); 20190 20191 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie, 20192 struct ieee80211_channel *chan, 20193 unsigned int duration, gfp_t gfp) 20194 { 20195 struct wiphy *wiphy = wdev->wiphy; 20196 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20197 20198 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration); 20199 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL, 20200 rdev, wdev, cookie, chan, 20201 duration, gfp); 20202 } 20203 EXPORT_SYMBOL(cfg80211_ready_on_channel); 20204 20205 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie, 20206 struct ieee80211_channel *chan, 20207 gfp_t gfp) 20208 { 20209 struct wiphy *wiphy = wdev->wiphy; 20210 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20211 20212 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan); 20213 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 20214 rdev, wdev, cookie, chan, 0, gfp); 20215 } 20216 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired); 20217 20218 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie, 20219 struct ieee80211_channel *chan, 20220 gfp_t gfp) 20221 { 20222 struct wiphy *wiphy = wdev->wiphy; 20223 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20224 20225 trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan); 20226 nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL, 20227 rdev, wdev, cookie, chan, 0, gfp); 20228 } 20229 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired); 20230 20231 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr, 20232 struct station_info *sinfo, gfp_t gfp) 20233 { 20234 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 20235 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20236 struct sk_buff *msg; 20237 20238 trace_cfg80211_new_sta(dev, mac_addr, sinfo); 20239 20240 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20241 if (!msg) 20242 return; 20243 20244 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0, 20245 rdev, dev, mac_addr, sinfo, false) < 0) { 20246 nlmsg_free(msg); 20247 return; 20248 } 20249 20250 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20251 NL80211_MCGRP_MLME, gfp); 20252 } 20253 EXPORT_SYMBOL(cfg80211_new_sta); 20254 20255 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr, 20256 struct station_info *sinfo, gfp_t gfp) 20257 { 20258 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 20259 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20260 struct sk_buff *msg; 20261 struct station_info empty_sinfo = {}; 20262 20263 if (!sinfo) 20264 sinfo = &empty_sinfo; 20265 20266 trace_cfg80211_del_sta(dev, mac_addr); 20267 20268 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20269 if (!msg) { 20270 cfg80211_sinfo_release_content(sinfo); 20271 return; 20272 } 20273 20274 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0, 20275 rdev, dev, mac_addr, sinfo, false) < 0) { 20276 nlmsg_free(msg); 20277 return; 20278 } 20279 20280 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20281 NL80211_MCGRP_MLME, gfp); 20282 } 20283 EXPORT_SYMBOL(cfg80211_del_sta_sinfo); 20284 20285 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr, 20286 enum nl80211_connect_failed_reason reason, 20287 gfp_t gfp) 20288 { 20289 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 20290 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20291 struct sk_buff *msg; 20292 void *hdr; 20293 20294 msg = nlmsg_new(NLMSG_GOODSIZE, gfp); 20295 if (!msg) 20296 return; 20297 20298 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED); 20299 if (!hdr) { 20300 nlmsg_free(msg); 20301 return; 20302 } 20303 20304 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20305 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 20306 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason)) 20307 goto nla_put_failure; 20308 20309 genlmsg_end(msg, hdr); 20310 20311 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20312 NL80211_MCGRP_MLME, gfp); 20313 return; 20314 20315 nla_put_failure: 20316 nlmsg_free(msg); 20317 } 20318 EXPORT_SYMBOL(cfg80211_conn_failed); 20319 20320 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd, 20321 const u8 *addr, int link_id, gfp_t gfp) 20322 { 20323 struct wireless_dev *wdev = dev->ieee80211_ptr; 20324 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20325 struct sk_buff *msg; 20326 void *hdr; 20327 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid); 20328 20329 if (!nlportid) 20330 return false; 20331 20332 msg = nlmsg_new(100, gfp); 20333 if (!msg) 20334 return true; 20335 20336 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 20337 if (!hdr) { 20338 nlmsg_free(msg); 20339 return true; 20340 } 20341 20342 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20343 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20344 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 20345 (link_id >= 0 && 20346 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 20347 goto nla_put_failure; 20348 20349 genlmsg_end(msg, hdr); 20350 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20351 return true; 20352 20353 nla_put_failure: 20354 nlmsg_free(msg); 20355 return true; 20356 } 20357 20358 bool cfg80211_rx_spurious_frame(struct net_device *dev, const u8 *addr, 20359 int link_id, gfp_t gfp) 20360 { 20361 struct wireless_dev *wdev = dev->ieee80211_ptr; 20362 bool ret; 20363 20364 trace_cfg80211_rx_spurious_frame(dev, addr, link_id); 20365 20366 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 20367 wdev->iftype != NL80211_IFTYPE_P2P_GO)) { 20368 trace_cfg80211_return_bool(false); 20369 return false; 20370 } 20371 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME, 20372 addr, link_id, gfp); 20373 trace_cfg80211_return_bool(ret); 20374 return ret; 20375 } 20376 EXPORT_SYMBOL(cfg80211_rx_spurious_frame); 20377 20378 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev, const u8 *addr, 20379 int link_id, gfp_t gfp) 20380 { 20381 struct wireless_dev *wdev = dev->ieee80211_ptr; 20382 bool ret; 20383 20384 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr, link_id); 20385 20386 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 20387 wdev->iftype != NL80211_IFTYPE_P2P_GO && 20388 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) { 20389 trace_cfg80211_return_bool(false); 20390 return false; 20391 } 20392 ret = __nl80211_unexpected_frame(dev, 20393 NL80211_CMD_UNEXPECTED_4ADDR_FRAME, 20394 addr, link_id, gfp); 20395 trace_cfg80211_return_bool(ret); 20396 return ret; 20397 } 20398 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame); 20399 20400 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev, 20401 struct wireless_dev *wdev, u32 nlportid, 20402 struct cfg80211_rx_info *info, gfp_t gfp) 20403 { 20404 struct net_device *netdev = wdev->netdev; 20405 struct sk_buff *msg; 20406 void *hdr; 20407 20408 msg = nlmsg_new(100 + info->len, gfp); 20409 if (!msg) 20410 return -ENOMEM; 20411 20412 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 20413 if (!hdr) { 20414 nlmsg_free(msg); 20415 return -ENOMEM; 20416 } 20417 20418 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20419 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 20420 netdev->ifindex)) || 20421 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20422 NL80211_ATTR_PAD) || 20423 (info->have_link_id && 20424 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) || 20425 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) || 20426 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) || 20427 (info->sig_dbm && 20428 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) || 20429 nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) || 20430 (info->flags && 20431 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) || 20432 (info->rx_tstamp && nla_put_u64_64bit(msg, 20433 NL80211_ATTR_RX_HW_TIMESTAMP, 20434 info->rx_tstamp, 20435 NL80211_ATTR_PAD)) || 20436 (info->ack_tstamp && nla_put_u64_64bit(msg, 20437 NL80211_ATTR_TX_HW_TIMESTAMP, 20438 info->ack_tstamp, 20439 NL80211_ATTR_PAD))) 20440 goto nla_put_failure; 20441 20442 genlmsg_end(msg, hdr); 20443 20444 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20445 20446 nla_put_failure: 20447 nlmsg_free(msg); 20448 return -ENOBUFS; 20449 } 20450 20451 static void nl80211_frame_tx_status(struct wireless_dev *wdev, 20452 struct cfg80211_tx_status *status, 20453 gfp_t gfp, enum nl80211_commands command) 20454 { 20455 struct wiphy *wiphy = wdev->wiphy; 20456 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20457 struct net_device *netdev = wdev->netdev; 20458 struct sk_buff *msg; 20459 void *hdr; 20460 20461 if (command == NL80211_CMD_FRAME_TX_STATUS) 20462 trace_cfg80211_mgmt_tx_status(wdev, status->cookie, 20463 status->ack); 20464 else 20465 trace_cfg80211_control_port_tx_status(wdev, status->cookie, 20466 status->ack); 20467 20468 msg = nlmsg_new(100 + status->len, gfp); 20469 if (!msg) 20470 return; 20471 20472 hdr = nl80211hdr_put(msg, 0, 0, 0, command); 20473 if (!hdr) { 20474 nlmsg_free(msg); 20475 return; 20476 } 20477 20478 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20479 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 20480 netdev->ifindex)) || 20481 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20482 NL80211_ATTR_PAD) || 20483 nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) || 20484 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie, 20485 NL80211_ATTR_PAD) || 20486 (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) || 20487 (status->tx_tstamp && 20488 nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP, 20489 status->tx_tstamp, NL80211_ATTR_PAD)) || 20490 (status->ack_tstamp && 20491 nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP, 20492 status->ack_tstamp, NL80211_ATTR_PAD))) 20493 goto nla_put_failure; 20494 20495 genlmsg_end(msg, hdr); 20496 20497 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20498 NL80211_MCGRP_MLME, gfp); 20499 return; 20500 20501 nla_put_failure: 20502 nlmsg_free(msg); 20503 } 20504 20505 void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie, 20506 const u8 *buf, size_t len, bool ack, 20507 gfp_t gfp) 20508 { 20509 struct cfg80211_tx_status status = { 20510 .cookie = cookie, 20511 .buf = buf, 20512 .len = len, 20513 .ack = ack 20514 }; 20515 20516 nl80211_frame_tx_status(wdev, &status, gfp, 20517 NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS); 20518 } 20519 EXPORT_SYMBOL(cfg80211_control_port_tx_status); 20520 20521 void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev, 20522 struct cfg80211_tx_status *status, gfp_t gfp) 20523 { 20524 nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS); 20525 } 20526 EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext); 20527 20528 static int __nl80211_rx_control_port(struct net_device *dev, 20529 struct sk_buff *skb, 20530 bool unencrypted, 20531 int link_id, 20532 gfp_t gfp) 20533 { 20534 struct wireless_dev *wdev = dev->ieee80211_ptr; 20535 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20536 struct ethhdr *ehdr = eth_hdr(skb); 20537 const u8 *addr = ehdr->h_source; 20538 u16 proto = be16_to_cpu(skb->protocol); 20539 struct sk_buff *msg; 20540 void *hdr; 20541 struct nlattr *frame; 20542 20543 u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid); 20544 20545 if (!nlportid) 20546 return -ENOENT; 20547 20548 msg = nlmsg_new(100 + skb->len, gfp); 20549 if (!msg) 20550 return -ENOMEM; 20551 20552 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME); 20553 if (!hdr) { 20554 nlmsg_free(msg); 20555 return -ENOBUFS; 20556 } 20557 20558 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20559 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20560 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20561 NL80211_ATTR_PAD) || 20562 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 20563 nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) || 20564 (link_id >= 0 && 20565 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) || 20566 (unencrypted && nla_put_flag(msg, 20567 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT))) 20568 goto nla_put_failure; 20569 20570 frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len); 20571 if (!frame) 20572 goto nla_put_failure; 20573 20574 skb_copy_bits(skb, 0, nla_data(frame), skb->len); 20575 genlmsg_end(msg, hdr); 20576 20577 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20578 20579 nla_put_failure: 20580 nlmsg_free(msg); 20581 return -ENOBUFS; 20582 } 20583 20584 bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb, 20585 bool unencrypted, int link_id) 20586 { 20587 int ret; 20588 20589 trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id); 20590 ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id, 20591 GFP_ATOMIC); 20592 trace_cfg80211_return_bool(ret == 0); 20593 return ret == 0; 20594 } 20595 EXPORT_SYMBOL(cfg80211_rx_control_port); 20596 20597 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev, 20598 const char *mac, gfp_t gfp) 20599 { 20600 struct wireless_dev *wdev = dev->ieee80211_ptr; 20601 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20602 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20603 void **cb; 20604 20605 if (!msg) 20606 return NULL; 20607 20608 cb = (void **)msg->cb; 20609 20610 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM); 20611 if (!cb[0]) { 20612 nlmsg_free(msg); 20613 return NULL; 20614 } 20615 20616 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20617 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 20618 goto nla_put_failure; 20619 20620 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 20621 goto nla_put_failure; 20622 20623 cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM); 20624 if (!cb[1]) 20625 goto nla_put_failure; 20626 20627 cb[2] = rdev; 20628 20629 return msg; 20630 nla_put_failure: 20631 nlmsg_free(msg); 20632 return NULL; 20633 } 20634 20635 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp) 20636 { 20637 void **cb = (void **)msg->cb; 20638 struct cfg80211_registered_device *rdev = cb[2]; 20639 20640 nla_nest_end(msg, cb[1]); 20641 genlmsg_end(msg, cb[0]); 20642 20643 memset(msg->cb, 0, sizeof(msg->cb)); 20644 20645 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20646 NL80211_MCGRP_MLME, gfp); 20647 } 20648 20649 void cfg80211_cqm_rssi_notify(struct net_device *dev, 20650 enum nl80211_cqm_rssi_threshold_event rssi_event, 20651 s32 rssi_level, gfp_t gfp) 20652 { 20653 struct wireless_dev *wdev = dev->ieee80211_ptr; 20654 struct cfg80211_cqm_config *cqm_config; 20655 20656 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level); 20657 20658 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW && 20659 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH)) 20660 return; 20661 20662 rcu_read_lock(); 20663 cqm_config = rcu_dereference(wdev->cqm_config); 20664 if (cqm_config) { 20665 cqm_config->last_rssi_event_value = rssi_level; 20666 cqm_config->last_rssi_event_type = rssi_event; 20667 wiphy_work_queue(wdev->wiphy, &wdev->cqm_rssi_work); 20668 } 20669 rcu_read_unlock(); 20670 } 20671 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify); 20672 20673 void cfg80211_cqm_rssi_notify_work(struct wiphy *wiphy, struct wiphy_work *work) 20674 { 20675 struct wireless_dev *wdev = container_of(work, struct wireless_dev, 20676 cqm_rssi_work); 20677 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20678 enum nl80211_cqm_rssi_threshold_event rssi_event; 20679 struct cfg80211_cqm_config *cqm_config; 20680 struct sk_buff *msg; 20681 s32 rssi_level; 20682 20683 cqm_config = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 20684 if (!cqm_config) 20685 return; 20686 20687 if (cqm_config->use_range_api) 20688 cfg80211_cqm_rssi_update(rdev, wdev->netdev, cqm_config); 20689 20690 rssi_level = cqm_config->last_rssi_event_value; 20691 rssi_event = cqm_config->last_rssi_event_type; 20692 20693 msg = cfg80211_prepare_cqm(wdev->netdev, NULL, GFP_KERNEL); 20694 if (!msg) 20695 return; 20696 20697 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT, 20698 rssi_event)) 20699 goto nla_put_failure; 20700 20701 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL, 20702 rssi_level)) 20703 goto nla_put_failure; 20704 20705 cfg80211_send_cqm(msg, GFP_KERNEL); 20706 20707 return; 20708 20709 nla_put_failure: 20710 nlmsg_free(msg); 20711 } 20712 20713 void cfg80211_cqm_txe_notify(struct net_device *dev, 20714 const u8 *peer, u32 num_packets, 20715 u32 rate, u32 intvl, gfp_t gfp) 20716 { 20717 struct sk_buff *msg; 20718 20719 msg = cfg80211_prepare_cqm(dev, peer, gfp); 20720 if (!msg) 20721 return; 20722 20723 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets)) 20724 goto nla_put_failure; 20725 20726 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate)) 20727 goto nla_put_failure; 20728 20729 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl)) 20730 goto nla_put_failure; 20731 20732 cfg80211_send_cqm(msg, gfp); 20733 return; 20734 20735 nla_put_failure: 20736 nlmsg_free(msg); 20737 } 20738 EXPORT_SYMBOL(cfg80211_cqm_txe_notify); 20739 20740 void cfg80211_cqm_pktloss_notify(struct net_device *dev, 20741 const u8 *peer, u32 num_packets, gfp_t gfp) 20742 { 20743 struct sk_buff *msg; 20744 20745 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets); 20746 20747 msg = cfg80211_prepare_cqm(dev, peer, gfp); 20748 if (!msg) 20749 return; 20750 20751 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets)) 20752 goto nla_put_failure; 20753 20754 cfg80211_send_cqm(msg, gfp); 20755 return; 20756 20757 nla_put_failure: 20758 nlmsg_free(msg); 20759 } 20760 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify); 20761 20762 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp) 20763 { 20764 struct sk_buff *msg; 20765 20766 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 20767 if (!msg) 20768 return; 20769 20770 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT)) 20771 goto nla_put_failure; 20772 20773 cfg80211_send_cqm(msg, gfp); 20774 return; 20775 20776 nla_put_failure: 20777 nlmsg_free(msg); 20778 } 20779 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify); 20780 20781 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev, 20782 struct net_device *netdev, const u8 *bssid, 20783 const u8 *replay_ctr, gfp_t gfp) 20784 { 20785 struct sk_buff *msg; 20786 struct nlattr *rekey_attr; 20787 void *hdr; 20788 20789 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20790 if (!msg) 20791 return; 20792 20793 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD); 20794 if (!hdr) { 20795 nlmsg_free(msg); 20796 return; 20797 } 20798 20799 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20800 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20801 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 20802 goto nla_put_failure; 20803 20804 rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA); 20805 if (!rekey_attr) 20806 goto nla_put_failure; 20807 20808 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR, 20809 NL80211_REPLAY_CTR_LEN, replay_ctr)) 20810 goto nla_put_failure; 20811 20812 nla_nest_end(msg, rekey_attr); 20813 20814 genlmsg_end(msg, hdr); 20815 20816 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20817 NL80211_MCGRP_MLME, gfp); 20818 return; 20819 20820 nla_put_failure: 20821 nlmsg_free(msg); 20822 } 20823 20824 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid, 20825 const u8 *replay_ctr, gfp_t gfp) 20826 { 20827 struct wireless_dev *wdev = dev->ieee80211_ptr; 20828 struct wiphy *wiphy = wdev->wiphy; 20829 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20830 20831 trace_cfg80211_gtk_rekey_notify(dev, bssid); 20832 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp); 20833 } 20834 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify); 20835 20836 static void 20837 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev, 20838 struct net_device *netdev, int index, 20839 const u8 *bssid, bool preauth, gfp_t gfp) 20840 { 20841 struct sk_buff *msg; 20842 struct nlattr *attr; 20843 void *hdr; 20844 20845 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20846 if (!msg) 20847 return; 20848 20849 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE); 20850 if (!hdr) { 20851 nlmsg_free(msg); 20852 return; 20853 } 20854 20855 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20856 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 20857 goto nla_put_failure; 20858 20859 attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE); 20860 if (!attr) 20861 goto nla_put_failure; 20862 20863 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) || 20864 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) || 20865 (preauth && 20866 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH))) 20867 goto nla_put_failure; 20868 20869 nla_nest_end(msg, attr); 20870 20871 genlmsg_end(msg, hdr); 20872 20873 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20874 NL80211_MCGRP_MLME, gfp); 20875 return; 20876 20877 nla_put_failure: 20878 nlmsg_free(msg); 20879 } 20880 20881 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index, 20882 const u8 *bssid, bool preauth, gfp_t gfp) 20883 { 20884 struct wireless_dev *wdev = dev->ieee80211_ptr; 20885 struct wiphy *wiphy = wdev->wiphy; 20886 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20887 20888 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth); 20889 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp); 20890 } 20891 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify); 20892 20893 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev, 20894 struct net_device *netdev, 20895 unsigned int link_id, 20896 struct cfg80211_chan_def *chandef, 20897 gfp_t gfp, 20898 enum nl80211_commands notif, 20899 u8 count, bool quiet) 20900 { 20901 struct wireless_dev *wdev = netdev->ieee80211_ptr; 20902 struct sk_buff *msg; 20903 void *hdr; 20904 20905 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20906 if (!msg) 20907 return; 20908 20909 hdr = nl80211hdr_put(msg, 0, 0, 0, notif); 20910 if (!hdr) { 20911 nlmsg_free(msg); 20912 return; 20913 } 20914 20915 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 20916 goto nla_put_failure; 20917 20918 if (wdev->valid_links && 20919 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 20920 goto nla_put_failure; 20921 20922 if (nl80211_send_chandef(msg, chandef)) 20923 goto nla_put_failure; 20924 20925 if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) { 20926 if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)) 20927 goto nla_put_failure; 20928 if (quiet && 20929 nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX)) 20930 goto nla_put_failure; 20931 } 20932 20933 genlmsg_end(msg, hdr); 20934 20935 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20936 NL80211_MCGRP_MLME, gfp); 20937 return; 20938 20939 nla_put_failure: 20940 nlmsg_free(msg); 20941 } 20942 20943 void cfg80211_ch_switch_notify(struct net_device *dev, 20944 struct cfg80211_chan_def *chandef, 20945 unsigned int link_id) 20946 { 20947 struct wireless_dev *wdev = dev->ieee80211_ptr; 20948 struct wiphy *wiphy = wdev->wiphy; 20949 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20950 20951 lockdep_assert_wiphy(wdev->wiphy); 20952 WARN_INVALID_LINK_ID(wdev, link_id); 20953 20954 trace_cfg80211_ch_switch_notify(dev, chandef, link_id); 20955 20956 switch (wdev->iftype) { 20957 case NL80211_IFTYPE_STATION: 20958 case NL80211_IFTYPE_P2P_CLIENT: 20959 if (!WARN_ON(!wdev->links[link_id].client.current_bss)) 20960 cfg80211_update_assoc_bss_entry(wdev, link_id, 20961 chandef->chan); 20962 break; 20963 case NL80211_IFTYPE_MESH_POINT: 20964 wdev->u.mesh.chandef = *chandef; 20965 wdev->u.mesh.preset_chandef = *chandef; 20966 break; 20967 case NL80211_IFTYPE_AP: 20968 case NL80211_IFTYPE_P2P_GO: 20969 wdev->links[link_id].ap.chandef = *chandef; 20970 break; 20971 case NL80211_IFTYPE_ADHOC: 20972 wdev->u.ibss.chandef = *chandef; 20973 break; 20974 default: 20975 WARN_ON(1); 20976 break; 20977 } 20978 20979 cfg80211_schedule_channels_check(wdev); 20980 cfg80211_sched_dfs_chan_update(rdev); 20981 20982 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 20983 NL80211_CMD_CH_SWITCH_NOTIFY, 0, false); 20984 } 20985 EXPORT_SYMBOL(cfg80211_ch_switch_notify); 20986 20987 void cfg80211_ch_switch_started_notify(struct net_device *dev, 20988 struct cfg80211_chan_def *chandef, 20989 unsigned int link_id, u8 count, 20990 bool quiet) 20991 { 20992 struct wireless_dev *wdev = dev->ieee80211_ptr; 20993 struct wiphy *wiphy = wdev->wiphy; 20994 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20995 20996 lockdep_assert_wiphy(wdev->wiphy); 20997 WARN_INVALID_LINK_ID(wdev, link_id); 20998 20999 trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id); 21000 21001 21002 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 21003 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, 21004 count, quiet); 21005 } 21006 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify); 21007 21008 int cfg80211_bss_color_notify(struct net_device *dev, 21009 enum nl80211_commands cmd, u8 count, 21010 u64 color_bitmap, u8 link_id) 21011 { 21012 struct wireless_dev *wdev = dev->ieee80211_ptr; 21013 struct wiphy *wiphy = wdev->wiphy; 21014 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21015 struct sk_buff *msg; 21016 void *hdr; 21017 21018 lockdep_assert_wiphy(wdev->wiphy); 21019 21020 trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap); 21021 21022 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 21023 if (!msg) 21024 return -ENOMEM; 21025 21026 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 21027 if (!hdr) 21028 goto nla_put_failure; 21029 21030 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 21031 goto nla_put_failure; 21032 21033 if (wdev->valid_links && 21034 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 21035 goto nla_put_failure; 21036 21037 if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED && 21038 nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count)) 21039 goto nla_put_failure; 21040 21041 if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION && 21042 nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP, 21043 color_bitmap, NL80211_ATTR_PAD)) 21044 goto nla_put_failure; 21045 21046 genlmsg_end(msg, hdr); 21047 21048 return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 21049 msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL); 21050 21051 nla_put_failure: 21052 nlmsg_free(msg); 21053 return -EINVAL; 21054 } 21055 EXPORT_SYMBOL(cfg80211_bss_color_notify); 21056 21057 void 21058 nl80211_radar_notify(struct cfg80211_registered_device *rdev, 21059 const struct cfg80211_chan_def *chandef, 21060 enum nl80211_radar_event event, 21061 struct net_device *netdev, gfp_t gfp) 21062 { 21063 struct sk_buff *msg; 21064 void *hdr; 21065 21066 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21067 if (!msg) 21068 return; 21069 21070 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT); 21071 if (!hdr) { 21072 nlmsg_free(msg); 21073 return; 21074 } 21075 21076 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 21077 goto nla_put_failure; 21078 21079 /* NOP and radar events don't need a netdev parameter */ 21080 if (netdev) { 21081 struct wireless_dev *wdev = netdev->ieee80211_ptr; 21082 21083 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 21084 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21085 NL80211_ATTR_PAD)) 21086 goto nla_put_failure; 21087 } 21088 21089 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event)) 21090 goto nla_put_failure; 21091 21092 if (nl80211_send_chandef(msg, chandef)) 21093 goto nla_put_failure; 21094 21095 genlmsg_end(msg, hdr); 21096 21097 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21098 NL80211_MCGRP_MLME, gfp); 21099 return; 21100 21101 nla_put_failure: 21102 nlmsg_free(msg); 21103 } 21104 21105 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac, 21106 struct sta_opmode_info *sta_opmode, 21107 gfp_t gfp) 21108 { 21109 struct sk_buff *msg; 21110 struct wireless_dev *wdev = dev->ieee80211_ptr; 21111 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 21112 void *hdr; 21113 21114 if (WARN_ON(!mac)) 21115 return; 21116 21117 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21118 if (!msg) 21119 return; 21120 21121 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED); 21122 if (!hdr) { 21123 nlmsg_free(msg); 21124 return; 21125 } 21126 21127 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 21128 goto nla_put_failure; 21129 21130 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 21131 goto nla_put_failure; 21132 21133 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 21134 goto nla_put_failure; 21135 21136 if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) && 21137 nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode)) 21138 goto nla_put_failure; 21139 21140 if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) && 21141 nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw)) 21142 goto nla_put_failure; 21143 21144 if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) && 21145 nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss)) 21146 goto nla_put_failure; 21147 21148 genlmsg_end(msg, hdr); 21149 21150 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21151 NL80211_MCGRP_MLME, gfp); 21152 21153 return; 21154 21155 nla_put_failure: 21156 nlmsg_free(msg); 21157 } 21158 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify); 21159 21160 void cfg80211_probe_status(struct net_device *dev, const u8 *addr, 21161 u64 cookie, bool acked, s32 ack_signal, 21162 bool is_valid_ack_signal, gfp_t gfp) 21163 { 21164 struct wireless_dev *wdev = dev->ieee80211_ptr; 21165 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 21166 struct sk_buff *msg; 21167 void *hdr; 21168 21169 trace_cfg80211_probe_status(dev, addr, cookie, acked); 21170 21171 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21172 21173 if (!msg) 21174 return; 21175 21176 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT); 21177 if (!hdr) { 21178 nlmsg_free(msg); 21179 return; 21180 } 21181 21182 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21183 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 21184 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 21185 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 21186 NL80211_ATTR_PAD) || 21187 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) || 21188 (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL, 21189 ack_signal))) 21190 goto nla_put_failure; 21191 21192 genlmsg_end(msg, hdr); 21193 21194 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21195 NL80211_MCGRP_MLME, gfp); 21196 return; 21197 21198 nla_put_failure: 21199 nlmsg_free(msg); 21200 } 21201 EXPORT_SYMBOL(cfg80211_probe_status); 21202 21203 void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame, 21204 size_t len, int freq, int sig_dbm) 21205 { 21206 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21207 struct sk_buff *msg; 21208 void *hdr; 21209 struct cfg80211_beacon_registration *reg; 21210 21211 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm); 21212 21213 spin_lock_bh(&rdev->beacon_registrations_lock); 21214 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 21215 msg = nlmsg_new(len + 100, GFP_ATOMIC); 21216 if (!msg) { 21217 spin_unlock_bh(&rdev->beacon_registrations_lock); 21218 return; 21219 } 21220 21221 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 21222 if (!hdr) 21223 goto nla_put_failure; 21224 21225 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21226 (freq && 21227 (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 21228 KHZ_TO_MHZ(freq)) || 21229 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 21230 freq % 1000))) || 21231 (sig_dbm && 21232 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 21233 nla_put(msg, NL80211_ATTR_FRAME, len, frame)) 21234 goto nla_put_failure; 21235 21236 genlmsg_end(msg, hdr); 21237 21238 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid); 21239 } 21240 spin_unlock_bh(&rdev->beacon_registrations_lock); 21241 return; 21242 21243 nla_put_failure: 21244 spin_unlock_bh(&rdev->beacon_registrations_lock); 21245 nlmsg_free(msg); 21246 } 21247 EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz); 21248 21249 #ifdef CONFIG_PM 21250 static int cfg80211_net_detect_results(struct sk_buff *msg, 21251 struct cfg80211_wowlan_wakeup *wakeup) 21252 { 21253 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect; 21254 struct nlattr *nl_results, *nl_match, *nl_freqs; 21255 int i, j; 21256 21257 nl_results = nla_nest_start_noflag(msg, 21258 NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS); 21259 if (!nl_results) 21260 return -EMSGSIZE; 21261 21262 for (i = 0; i < nd->n_matches; i++) { 21263 struct cfg80211_wowlan_nd_match *match = nd->matches[i]; 21264 21265 nl_match = nla_nest_start_noflag(msg, i); 21266 if (!nl_match) 21267 break; 21268 21269 /* The SSID attribute is optional in nl80211, but for 21270 * simplicity reasons it's always present in the 21271 * cfg80211 structure. If a driver can't pass the 21272 * SSID, that needs to be changed. A zero length SSID 21273 * is still a valid SSID (wildcard), so it cannot be 21274 * used for this purpose. 21275 */ 21276 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len, 21277 match->ssid.ssid)) { 21278 nla_nest_cancel(msg, nl_match); 21279 goto out; 21280 } 21281 21282 if (match->n_channels) { 21283 nl_freqs = nla_nest_start_noflag(msg, 21284 NL80211_ATTR_SCAN_FREQUENCIES); 21285 if (!nl_freqs) { 21286 nla_nest_cancel(msg, nl_match); 21287 goto out; 21288 } 21289 21290 for (j = 0; j < match->n_channels; j++) { 21291 if (nla_put_u32(msg, j, match->channels[j])) { 21292 nla_nest_cancel(msg, nl_freqs); 21293 nla_nest_cancel(msg, nl_match); 21294 goto out; 21295 } 21296 } 21297 21298 nla_nest_end(msg, nl_freqs); 21299 } 21300 21301 nla_nest_end(msg, nl_match); 21302 } 21303 21304 out: 21305 nla_nest_end(msg, nl_results); 21306 return 0; 21307 } 21308 21309 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev, 21310 struct cfg80211_wowlan_wakeup *wakeup, 21311 gfp_t gfp) 21312 { 21313 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 21314 struct sk_buff *msg; 21315 void *hdr; 21316 int size = 200; 21317 21318 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup); 21319 21320 if (wakeup) 21321 size += wakeup->packet_present_len; 21322 21323 msg = nlmsg_new(size, gfp); 21324 if (!msg) 21325 return; 21326 21327 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN); 21328 if (!hdr) 21329 goto free_msg; 21330 21331 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21332 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21333 NL80211_ATTR_PAD)) 21334 goto free_msg; 21335 21336 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 21337 wdev->netdev->ifindex)) 21338 goto free_msg; 21339 21340 if (wakeup) { 21341 struct nlattr *reasons; 21342 21343 reasons = nla_nest_start_noflag(msg, 21344 NL80211_ATTR_WOWLAN_TRIGGERS); 21345 if (!reasons) 21346 goto free_msg; 21347 21348 if (wakeup->disconnect && 21349 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) 21350 goto free_msg; 21351 if (wakeup->magic_pkt && 21352 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) 21353 goto free_msg; 21354 if (wakeup->gtk_rekey_failure && 21355 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) 21356 goto free_msg; 21357 if (wakeup->eap_identity_req && 21358 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) 21359 goto free_msg; 21360 if (wakeup->four_way_handshake && 21361 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) 21362 goto free_msg; 21363 if (wakeup->rfkill_release && 21364 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)) 21365 goto free_msg; 21366 21367 if (wakeup->pattern_idx >= 0 && 21368 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 21369 wakeup->pattern_idx)) 21370 goto free_msg; 21371 21372 if (wakeup->tcp_match && 21373 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH)) 21374 goto free_msg; 21375 21376 if (wakeup->tcp_connlost && 21377 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST)) 21378 goto free_msg; 21379 21380 if (wakeup->tcp_nomoretokens && 21381 nla_put_flag(msg, 21382 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS)) 21383 goto free_msg; 21384 21385 if (wakeup->unprot_deauth_disassoc && 21386 nla_put_flag(msg, 21387 NL80211_WOWLAN_TRIG_UNPROTECTED_DEAUTH_DISASSOC)) 21388 goto free_msg; 21389 21390 if (wakeup->packet) { 21391 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211; 21392 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN; 21393 21394 if (!wakeup->packet_80211) { 21395 pkt_attr = 21396 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023; 21397 len_attr = 21398 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN; 21399 } 21400 21401 if (wakeup->packet_len && 21402 nla_put_u32(msg, len_attr, wakeup->packet_len)) 21403 goto free_msg; 21404 21405 if (nla_put(msg, pkt_attr, wakeup->packet_present_len, 21406 wakeup->packet)) 21407 goto free_msg; 21408 } 21409 21410 if (wakeup->net_detect && 21411 cfg80211_net_detect_results(msg, wakeup)) 21412 goto free_msg; 21413 21414 nla_nest_end(msg, reasons); 21415 } 21416 21417 genlmsg_end(msg, hdr); 21418 21419 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21420 NL80211_MCGRP_MLME, gfp); 21421 return; 21422 21423 free_msg: 21424 nlmsg_free(msg); 21425 } 21426 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup); 21427 #endif 21428 21429 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer, 21430 enum nl80211_tdls_operation oper, 21431 u16 reason_code, gfp_t gfp) 21432 { 21433 struct wireless_dev *wdev = dev->ieee80211_ptr; 21434 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 21435 struct sk_buff *msg; 21436 void *hdr; 21437 21438 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper, 21439 reason_code); 21440 21441 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21442 if (!msg) 21443 return; 21444 21445 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER); 21446 if (!hdr) { 21447 nlmsg_free(msg); 21448 return; 21449 } 21450 21451 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21452 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 21453 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) || 21454 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) || 21455 (reason_code > 0 && 21456 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code))) 21457 goto nla_put_failure; 21458 21459 genlmsg_end(msg, hdr); 21460 21461 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21462 NL80211_MCGRP_MLME, gfp); 21463 return; 21464 21465 nla_put_failure: 21466 nlmsg_free(msg); 21467 } 21468 EXPORT_SYMBOL(cfg80211_tdls_oper_request); 21469 21470 static int nl80211_netlink_notify(struct notifier_block * nb, 21471 unsigned long state, 21472 void *_notify) 21473 { 21474 struct netlink_notify *notify = _notify; 21475 struct cfg80211_registered_device *rdev; 21476 struct wireless_dev *wdev; 21477 struct cfg80211_beacon_registration *reg, *tmp; 21478 21479 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC) 21480 return NOTIFY_DONE; 21481 21482 rcu_read_lock(); 21483 21484 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 21485 struct cfg80211_sched_scan_request *sched_scan_req; 21486 21487 list_for_each_entry_rcu(sched_scan_req, 21488 &rdev->sched_scan_req_list, 21489 list) { 21490 if (sched_scan_req->owner_nlportid == notify->portid) { 21491 sched_scan_req->nl_owner_dead = true; 21492 wiphy_work_queue(&rdev->wiphy, 21493 &rdev->sched_scan_stop_wk); 21494 } 21495 } 21496 21497 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) { 21498 cfg80211_mlme_unregister_socket(wdev, notify->portid); 21499 21500 if (wdev->owner_nlportid == notify->portid) { 21501 wdev->nl_owner_dead = true; 21502 schedule_work(&rdev->destroy_work); 21503 } else if (wdev->conn_owner_nlportid == notify->portid) { 21504 schedule_work(&wdev->disconnect_wk); 21505 } 21506 21507 cfg80211_release_pmsr(wdev, notify->portid); 21508 } 21509 21510 spin_lock_bh(&rdev->beacon_registrations_lock); 21511 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations, 21512 list) { 21513 if (reg->nlportid == notify->portid) { 21514 list_del(®->list); 21515 kfree(reg); 21516 break; 21517 } 21518 } 21519 spin_unlock_bh(&rdev->beacon_registrations_lock); 21520 } 21521 21522 rcu_read_unlock(); 21523 21524 /* 21525 * It is possible that the user space process that is controlling the 21526 * indoor setting disappeared, so notify the regulatory core. 21527 */ 21528 regulatory_netlink_notify(notify->portid); 21529 return NOTIFY_OK; 21530 } 21531 21532 static struct notifier_block nl80211_netlink_notifier = { 21533 .notifier_call = nl80211_netlink_notify, 21534 }; 21535 21536 void cfg80211_ft_event(struct net_device *netdev, 21537 struct cfg80211_ft_event_params *ft_event) 21538 { 21539 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 21540 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21541 struct sk_buff *msg; 21542 void *hdr; 21543 21544 trace_cfg80211_ft_event(wiphy, netdev, ft_event); 21545 21546 if (!ft_event->target_ap) 21547 return; 21548 21549 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len, 21550 GFP_KERNEL); 21551 if (!msg) 21552 return; 21553 21554 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT); 21555 if (!hdr) 21556 goto out; 21557 21558 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21559 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 21560 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap)) 21561 goto out; 21562 21563 if (ft_event->ies && 21564 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies)) 21565 goto out; 21566 if (ft_event->ric_ies && 21567 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len, 21568 ft_event->ric_ies)) 21569 goto out; 21570 21571 genlmsg_end(msg, hdr); 21572 21573 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21574 NL80211_MCGRP_MLME, GFP_KERNEL); 21575 return; 21576 out: 21577 nlmsg_free(msg); 21578 } 21579 EXPORT_SYMBOL(cfg80211_ft_event); 21580 21581 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp) 21582 { 21583 struct cfg80211_registered_device *rdev; 21584 struct sk_buff *msg; 21585 void *hdr; 21586 u32 nlportid; 21587 21588 rdev = wiphy_to_rdev(wdev->wiphy); 21589 if (!rdev->crit_proto_nlportid) 21590 return; 21591 21592 nlportid = rdev->crit_proto_nlportid; 21593 rdev->crit_proto_nlportid = 0; 21594 21595 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21596 if (!msg) 21597 return; 21598 21599 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP); 21600 if (!hdr) 21601 goto nla_put_failure; 21602 21603 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21604 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21605 NL80211_ATTR_PAD)) 21606 goto nla_put_failure; 21607 21608 genlmsg_end(msg, hdr); 21609 21610 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 21611 return; 21612 21613 nla_put_failure: 21614 nlmsg_free(msg); 21615 } 21616 EXPORT_SYMBOL(cfg80211_crit_proto_stopped); 21617 21618 void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id) 21619 { 21620 struct wiphy *wiphy = wdev->wiphy; 21621 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21622 struct sk_buff *msg; 21623 void *hdr; 21624 21625 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 21626 if (!msg) 21627 return; 21628 21629 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP); 21630 if (!hdr) 21631 goto out; 21632 21633 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21634 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 21635 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21636 NL80211_ATTR_PAD) || 21637 (wdev->valid_links && 21638 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 21639 goto out; 21640 21641 genlmsg_end(msg, hdr); 21642 21643 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 21644 NL80211_MCGRP_MLME, GFP_KERNEL); 21645 return; 21646 out: 21647 nlmsg_free(msg); 21648 } 21649 21650 int cfg80211_external_auth_request(struct net_device *dev, 21651 struct cfg80211_external_auth_params *params, 21652 gfp_t gfp) 21653 { 21654 struct wireless_dev *wdev = dev->ieee80211_ptr; 21655 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 21656 struct sk_buff *msg; 21657 void *hdr; 21658 21659 if (!wdev->conn_owner_nlportid) 21660 return -EINVAL; 21661 21662 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21663 if (!msg) 21664 return -ENOMEM; 21665 21666 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH); 21667 if (!hdr) 21668 goto nla_put_failure; 21669 21670 /* Some historical mistakes in drivers <-> userspace interface (notably 21671 * between drivers and wpa_supplicant) led to a big-endian conversion 21672 * being needed on NL80211_ATTR_AKM_SUITES _only_ when its value is 21673 * WLAN_AKM_SUITE_SAE. This is now fixed on userspace side, but for the 21674 * benefit of older wpa_supplicant versions, send this particular value 21675 * in big-endian. Note that newer wpa_supplicant will also detect this 21676 * particular value in big endian still, so it all continues to work. 21677 */ 21678 if (params->key_mgmt_suite == WLAN_AKM_SUITE_SAE) { 21679 if (nla_put_be32(msg, NL80211_ATTR_AKM_SUITES, 21680 cpu_to_be32(WLAN_AKM_SUITE_SAE))) 21681 goto nla_put_failure; 21682 } else { 21683 if (nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, 21684 params->key_mgmt_suite)) 21685 goto nla_put_failure; 21686 } 21687 21688 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21689 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 21690 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION, 21691 params->action) || 21692 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) || 21693 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len, 21694 params->ssid.ssid) || 21695 (!is_zero_ether_addr(params->mld_addr) && 21696 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr))) 21697 goto nla_put_failure; 21698 21699 genlmsg_end(msg, hdr); 21700 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 21701 wdev->conn_owner_nlportid); 21702 return 0; 21703 21704 nla_put_failure: 21705 nlmsg_free(msg); 21706 return -ENOBUFS; 21707 } 21708 EXPORT_SYMBOL(cfg80211_external_auth_request); 21709 21710 void cfg80211_update_owe_info_event(struct net_device *netdev, 21711 struct cfg80211_update_owe_info *owe_info, 21712 gfp_t gfp) 21713 { 21714 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 21715 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21716 struct sk_buff *msg; 21717 void *hdr; 21718 21719 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info); 21720 21721 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21722 if (!msg) 21723 return; 21724 21725 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO); 21726 if (!hdr) 21727 goto nla_put_failure; 21728 21729 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21730 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 21731 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer)) 21732 goto nla_put_failure; 21733 21734 if (!owe_info->ie_len || 21735 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie)) 21736 goto nla_put_failure; 21737 21738 if (owe_info->assoc_link_id != -1) { 21739 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 21740 owe_info->assoc_link_id)) 21741 goto nla_put_failure; 21742 21743 if (!is_zero_ether_addr(owe_info->peer_mld_addr) && 21744 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 21745 owe_info->peer_mld_addr)) 21746 goto nla_put_failure; 21747 } 21748 21749 genlmsg_end(msg, hdr); 21750 21751 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21752 NL80211_MCGRP_MLME, gfp); 21753 return; 21754 21755 nla_put_failure: 21756 genlmsg_cancel(msg, hdr); 21757 nlmsg_free(msg); 21758 } 21759 EXPORT_SYMBOL(cfg80211_update_owe_info_event); 21760 21761 void cfg80211_schedule_channels_check(struct wireless_dev *wdev) 21762 { 21763 struct wiphy *wiphy = wdev->wiphy; 21764 21765 /* Schedule channels check if NO_IR or DFS relaxations are supported */ 21766 if (wdev->iftype == NL80211_IFTYPE_STATION && 21767 (wiphy_ext_feature_isset(wiphy, 21768 NL80211_EXT_FEATURE_DFS_CONCURRENT) || 21769 (IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) && 21770 wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR))) 21771 reg_check_channels(); 21772 } 21773 EXPORT_SYMBOL(cfg80211_schedule_channels_check); 21774 21775 void cfg80211_epcs_changed(struct net_device *netdev, bool enabled) 21776 { 21777 struct wireless_dev *wdev = netdev->ieee80211_ptr; 21778 struct wiphy *wiphy = wdev->wiphy; 21779 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21780 struct sk_buff *msg; 21781 void *hdr; 21782 21783 trace_cfg80211_epcs_changed(wdev, enabled); 21784 21785 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 21786 if (!msg) 21787 return; 21788 21789 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EPCS_CFG); 21790 if (!hdr) { 21791 nlmsg_free(msg); 21792 return; 21793 } 21794 21795 if (enabled && nla_put_flag(msg, NL80211_ATTR_EPCS)) 21796 goto nla_put_failure; 21797 21798 genlmsg_end(msg, hdr); 21799 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21800 NL80211_MCGRP_MLME, GFP_KERNEL); 21801 return; 21802 21803 nla_put_failure: 21804 nlmsg_free(msg); 21805 } 21806 EXPORT_SYMBOL(cfg80211_epcs_changed); 21807 21808 void cfg80211_next_nan_dw_notif(struct wireless_dev *wdev, 21809 struct ieee80211_channel *chan, gfp_t gfp) 21810 { 21811 struct wiphy *wiphy = wdev->wiphy; 21812 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21813 struct sk_buff *msg; 21814 void *hdr; 21815 21816 trace_cfg80211_next_nan_dw_notif(wdev, chan); 21817 21818 if (!wdev->owner_nlportid) 21819 return; 21820 21821 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21822 if (!msg) 21823 return; 21824 21825 hdr = nl80211hdr_put(msg, 0, 0, 0, 21826 NL80211_CMD_NAN_NEXT_DW_NOTIFICATION); 21827 if (!hdr) 21828 goto nla_put_failure; 21829 21830 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21831 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21832 NL80211_ATTR_PAD) || 21833 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq)) 21834 goto nla_put_failure; 21835 21836 genlmsg_end(msg, hdr); 21837 21838 genlmsg_unicast(wiphy_net(wiphy), msg, wdev->owner_nlportid); 21839 21840 return; 21841 21842 nla_put_failure: 21843 nlmsg_free(msg); 21844 } 21845 EXPORT_SYMBOL(cfg80211_next_nan_dw_notif); 21846 21847 void cfg80211_nan_cluster_joined(struct wireless_dev *wdev, 21848 const u8 *cluster_id, bool new_cluster, 21849 gfp_t gfp) 21850 { 21851 struct wiphy *wiphy = wdev->wiphy; 21852 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21853 struct sk_buff *msg; 21854 void *hdr; 21855 21856 trace_cfg80211_nan_cluster_joined(wdev, cluster_id, new_cluster); 21857 21858 memcpy(wdev->u.nan.cluster_id, cluster_id, ETH_ALEN); 21859 21860 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21861 if (!msg) 21862 return; 21863 21864 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_CLUSTER_JOINED); 21865 if (!hdr) 21866 goto nla_put_failure; 21867 21868 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21869 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21870 NL80211_ATTR_PAD) || 21871 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cluster_id) || 21872 (new_cluster && nla_put_flag(msg, NL80211_ATTR_NAN_NEW_CLUSTER))) 21873 goto nla_put_failure; 21874 21875 genlmsg_end(msg, hdr); 21876 21877 if (!wdev->owner_nlportid) 21878 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), 21879 msg, 0, NL80211_MCGRP_NAN, gfp); 21880 else 21881 genlmsg_unicast(wiphy_net(wiphy), msg, 21882 wdev->owner_nlportid); 21883 return; 21884 21885 nla_put_failure: 21886 nlmsg_free(msg); 21887 } 21888 EXPORT_SYMBOL(cfg80211_nan_cluster_joined); 21889 21890 /* initialisation/exit functions */ 21891 21892 int __init nl80211_init(void) 21893 { 21894 int err; 21895 21896 err = genl_register_family(&nl80211_fam); 21897 if (err) 21898 return err; 21899 21900 err = netlink_register_notifier(&nl80211_netlink_notifier); 21901 if (err) 21902 goto err_out; 21903 21904 return 0; 21905 err_out: 21906 genl_unregister_family(&nl80211_fam); 21907 return err; 21908 } 21909 21910 void nl80211_exit(void) 21911 { 21912 netlink_unregister_notifier(&nl80211_netlink_notifier); 21913 genl_unregister_family(&nl80211_fam); 21914 } 21915