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 /* policy for the attributes */ 316 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR]; 317 318 static const struct nla_policy 319 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = { 320 [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, }, 321 [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY, 322 .len = U8_MAX }, 323 [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY, 324 .len = U8_MAX }, 325 }; 326 327 static const struct nla_policy 328 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = { 329 [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG }, 330 [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 }, 331 [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] = 332 NLA_POLICY_MAX(NLA_U8, 15), 333 [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 }, 334 [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] = 335 NLA_POLICY_MAX(NLA_U8, 15), 336 [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] = { .type = NLA_U8 }, 337 [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 }, 338 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG }, 339 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG }, 340 [NL80211_PMSR_FTM_REQ_ATTR_TRIGGER_BASED] = { .type = NLA_FLAG }, 341 [NL80211_PMSR_FTM_REQ_ATTR_NON_TRIGGER_BASED] = { .type = NLA_FLAG }, 342 [NL80211_PMSR_FTM_REQ_ATTR_LMR_FEEDBACK] = { .type = NLA_FLAG }, 343 [NL80211_PMSR_FTM_REQ_ATTR_BSS_COLOR] = { .type = NLA_U8 }, 344 }; 345 346 static const struct nla_policy 347 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = { 348 [NL80211_PMSR_TYPE_FTM] = 349 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy), 350 }; 351 352 static const struct nla_policy 353 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = { 354 [NL80211_PMSR_REQ_ATTR_DATA] = 355 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy), 356 [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG }, 357 }; 358 359 static const struct nla_policy 360 nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = { 361 [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR, 362 [NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy), 363 [NL80211_PMSR_PEER_ATTR_REQ] = 364 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy), 365 [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT }, 366 }; 367 368 static const struct nla_policy 369 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = { 370 [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT }, 371 [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT }, 372 [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT }, 373 [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT }, 374 [NL80211_PMSR_ATTR_PEERS] = 375 NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy), 376 }; 377 378 static const struct nla_policy 379 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = { 380 [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] = 381 NLA_POLICY_RANGE(NLA_U8, 1, 20), 382 [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] = 383 NLA_POLICY_RANGE(NLA_U8, 1, 20), 384 [NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] = 385 NLA_POLICY_RANGE(NLA_U8, 1, 20), 386 [NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] = 387 NLA_POLICY_EXACT_LEN(8), 388 [NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] = 389 NLA_POLICY_EXACT_LEN(8), 390 [NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 }, 391 }; 392 393 static const struct nla_policy 394 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = { 395 [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63), 396 [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG }, 397 [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG }, 398 }; 399 400 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = { 401 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY, 402 .len = NL80211_MAX_SUPP_RATES }, 403 [NL80211_TXRATE_HT] = { .type = NLA_BINARY, 404 .len = NL80211_MAX_SUPP_HT_RATES }, 405 [NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)), 406 [NL80211_TXRATE_GI] = { .type = NLA_U8 }, 407 [NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)), 408 [NL80211_TXRATE_HE_GI] = NLA_POLICY_RANGE(NLA_U8, 409 NL80211_RATE_INFO_HE_GI_0_8, 410 NL80211_RATE_INFO_HE_GI_3_2), 411 [NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8, 412 NL80211_RATE_INFO_HE_1XLTF, 413 NL80211_RATE_INFO_HE_4XLTF), 414 [NL80211_TXRATE_EHT] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_eht)), 415 [NL80211_TXRATE_EHT_GI] = NLA_POLICY_RANGE(NLA_U8, 416 NL80211_RATE_INFO_EHT_GI_0_8, 417 NL80211_RATE_INFO_EHT_GI_3_2), 418 [NL80211_TXRATE_EHT_LTF] = NLA_POLICY_RANGE(NLA_U8, 419 NL80211_RATE_INFO_EHT_1XLTF, 420 NL80211_RATE_INFO_EHT_8XLTF), 421 422 }; 423 424 static const struct nla_policy 425 nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = { 426 [NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 }, 427 [NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 }, 428 [NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG }, 429 [NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff), 430 [NL80211_TID_CONFIG_ATTR_NOACK] = 431 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 432 [NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 433 [NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 434 [NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] = 435 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 436 [NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] = 437 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 438 [NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] = 439 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 440 [NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] = 441 NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED), 442 [NL80211_TID_CONFIG_ATTR_TX_RATE] = 443 NLA_POLICY_NESTED(nl80211_txattr_policy), 444 }; 445 446 static const struct nla_policy 447 nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = { 448 [NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000), 449 [NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000), 450 [NL80211_FILS_DISCOVERY_ATTR_TMPL] = 451 NLA_POLICY_RANGE(NLA_BINARY, 452 NL80211_FILS_DISCOVERY_TMPL_MIN_LEN, 453 IEEE80211_MAX_DATA_LEN), 454 }; 455 456 static const struct nla_policy 457 nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = { 458 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20), 459 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY, 460 .len = IEEE80211_MAX_DATA_LEN } 461 }; 462 463 static const struct nla_policy 464 sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = { 465 [NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 }, 466 [NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 }, 467 }; 468 469 static const struct nla_policy 470 sar_policy[NL80211_SAR_ATTR_MAX + 1] = { 471 [NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE), 472 [NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy), 473 }; 474 475 static const struct nla_policy 476 nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = { 477 [NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2), 478 [NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] = 479 NLA_POLICY_MIN(NLA_U8, 1), 480 [NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 }, 481 [NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 }, 482 [NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG }, 483 [NL80211_MBSSID_CONFIG_ATTR_TX_LINK_ID] = 484 NLA_POLICY_MAX(NLA_U8, IEEE80211_MLD_MAX_NUM_LINKS), 485 }; 486 487 static const struct nla_policy 488 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = { 489 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 }, 490 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 }, 491 }; 492 493 static const struct nla_policy 494 nl80211_s1g_short_beacon[NL80211_S1G_SHORT_BEACON_ATTR_MAX + 1] = { 495 [NL80211_S1G_SHORT_BEACON_ATTR_HEAD] = 496 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 497 IEEE80211_MAX_DATA_LEN), 498 [NL80211_S1G_SHORT_BEACON_ATTR_TAIL] = 499 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 500 IEEE80211_MAX_DATA_LEN), 501 }; 502 503 static const struct netlink_range_validation nl80211_punct_bitmap_range = { 504 .min = 0, 505 .max = 0xffff, 506 }; 507 508 static const struct netlink_range_validation q_range = { 509 .max = INT_MAX, 510 }; 511 512 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = { 513 [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD }, 514 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 }, 515 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING, 516 .len = 20-1 }, 517 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED }, 518 519 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 }, 520 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 }, 521 [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8, 522 NL80211_EDMG_CHANNELS_MIN, 523 NL80211_EDMG_CHANNELS_MAX), 524 [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8, 525 NL80211_EDMG_BW_CONFIG_MIN, 526 NL80211_EDMG_BW_CONFIG_MAX), 527 528 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 }, 529 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 }, 530 [NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 531 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 }, 532 533 [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 534 [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 535 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 }, 536 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 }, 537 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 }, 538 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG }, 539 540 [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX), 541 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 }, 542 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 }, 543 544 [NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 545 [NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 546 547 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, }, 548 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY, 549 .len = WLAN_MAX_KEY_LEN }, 550 [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7), 551 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 }, 552 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG }, 553 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 554 [NL80211_ATTR_KEY_TYPE] = 555 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES), 556 557 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 }, 558 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 }, 559 [NL80211_ATTR_BEACON_HEAD] = 560 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 561 IEEE80211_MAX_DATA_LEN), 562 [NL80211_ATTR_BEACON_TAIL] = 563 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 564 IEEE80211_MAX_DATA_LEN), 565 [NL80211_ATTR_STA_AID] = 566 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 567 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED }, 568 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 }, 569 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY, 570 .len = NL80211_MAX_SUPP_RATES }, 571 [NL80211_ATTR_STA_PLINK_ACTION] = 572 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1), 573 [NL80211_ATTR_STA_TX_POWER_SETTING] = 574 NLA_POLICY_RANGE(NLA_U8, 575 NL80211_TX_POWER_AUTOMATIC, 576 NL80211_TX_POWER_FIXED), 577 [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 }, 578 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 }, 579 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ }, 580 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY, 581 .len = IEEE80211_MAX_MESH_ID_LEN }, 582 [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT, 583 584 /* allow 3 for NUL-termination, we used to declare this NLA_STRING */ 585 [NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3), 586 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED }, 587 588 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 }, 589 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 }, 590 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 }, 591 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY, 592 .len = NL80211_MAX_SUPP_RATES }, 593 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 }, 594 595 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED }, 596 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG }, 597 598 [NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN), 599 600 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 }, 601 [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY, 602 validate_ie_attr, 603 IEEE80211_MAX_DATA_LEN), 604 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED }, 605 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED }, 606 607 [NL80211_ATTR_SSID] = { .type = NLA_BINARY, 608 .len = IEEE80211_MAX_SSID_LEN }, 609 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 }, 610 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 }, 611 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG }, 612 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG }, 613 [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32, 614 NL80211_MFP_NO, 615 NL80211_MFP_OPTIONAL), 616 [NL80211_ATTR_STA_FLAGS2] = 617 NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)), 618 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG }, 619 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 }, 620 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG }, 621 [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG }, 622 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG }, 623 [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 }, 624 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 }, 625 [NL80211_ATTR_WPA_VERSIONS] = 626 NLA_POLICY_RANGE(NLA_U32, 0, 627 NL80211_WPA_VERSION_1 | 628 NL80211_WPA_VERSION_2 | 629 NL80211_WPA_VERSION_3), 630 [NL80211_ATTR_PID] = { .type = NLA_U32 }, 631 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 }, 632 [NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN), 633 [NL80211_ATTR_DURATION] = { .type = NLA_U32 }, 634 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 }, 635 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED }, 636 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY, 637 .len = IEEE80211_MAX_DATA_LEN }, 638 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, }, 639 [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32, 640 NL80211_PS_DISABLED, 641 NL80211_PS_ENABLED), 642 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, }, 643 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG }, 644 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 }, 645 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 }, 646 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 }, 647 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 }, 648 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 }, 649 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 }, 650 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 }, 651 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG }, 652 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 653 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED }, 654 [NL80211_ATTR_STA_PLINK_STATE] = 655 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1), 656 [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 }, 657 [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG }, 658 [NL80211_ATTR_MESH_PEER_AID] = 659 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 660 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 }, 661 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED }, 662 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED }, 663 [NL80211_ATTR_HIDDEN_SSID] = 664 NLA_POLICY_RANGE(NLA_U32, 665 NL80211_HIDDEN_SSID_NOT_IN_USE, 666 NL80211_HIDDEN_SSID_ZERO_CONTENTS), 667 [NL80211_ATTR_IE_PROBE_RESP] = 668 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 669 IEEE80211_MAX_DATA_LEN), 670 [NL80211_ATTR_IE_ASSOC_RESP] = 671 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 672 IEEE80211_MAX_DATA_LEN), 673 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG }, 674 [NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy), 675 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED }, 676 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG }, 677 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 }, 678 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 }, 679 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 }, 680 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG }, 681 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG }, 682 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG }, 683 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG }, 684 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY, 685 .len = IEEE80211_MAX_DATA_LEN }, 686 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 }, 687 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG }, 688 [NL80211_ATTR_HT_CAPABILITY_MASK] = { 689 .len = NL80211_HT_CAPABILITY_LEN 690 }, 691 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 }, 692 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 }, 693 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 }, 694 [NL80211_ATTR_WDEV] = { .type = NLA_U64 }, 695 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 }, 696 697 /* need to include at least Auth Transaction and Status Code */ 698 [NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4), 699 700 [NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN), 701 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 }, 702 [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127), 703 [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1), 704 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = 705 NLA_POLICY_RANGE(NLA_U32, 706 NL80211_MESH_POWER_UNKNOWN + 1, 707 NL80211_MESH_POWER_MAX), 708 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 }, 709 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED }, 710 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 }, 711 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, }, 712 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, }, 713 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG }, 714 [NL80211_ATTR_VHT_CAPABILITY_MASK] = { 715 .len = NL80211_VHT_CAPABILITY_LEN, 716 }, 717 [NL80211_ATTR_MDID] = { .type = NLA_U16 }, 718 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY, 719 .len = IEEE80211_MAX_DATA_LEN }, 720 [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 }, 721 [NL80211_ATTR_MAX_CRIT_PROT_DURATION] = 722 NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION), 723 [NL80211_ATTR_PEER_AID] = 724 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 725 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 }, 726 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG }, 727 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED }, 728 [NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY }, 729 [NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY }, 730 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2), 731 /* 732 * The value of the Length field of the Supported Operating 733 * Classes element is between 2 and 253. 734 */ 735 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = 736 NLA_POLICY_RANGE(NLA_BINARY, 2, 253), 737 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG }, 738 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 }, 739 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 }, 740 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 }, 741 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY }, 742 [NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY, 743 IEEE80211_QOS_MAP_LEN_MIN, 744 IEEE80211_QOS_MAP_LEN_MAX), 745 [NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 746 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 }, 747 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 }, 748 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG }, 749 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY }, 750 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG }, 751 [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1), 752 [NL80211_ATTR_USER_PRIO] = 753 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1), 754 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 }, 755 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 }, 756 [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 }, 757 [NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 758 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG }, 759 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 }, 760 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 }, 761 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG }, 762 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG }, 763 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED }, 764 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = 765 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1), 766 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = { 767 .len = VHT_MUMIMO_GROUPS_DATA_LEN 768 }, 769 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 770 [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1), 771 [NL80211_ATTR_BANDS] = { .type = NLA_U32 }, 772 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED }, 773 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY, 774 .len = FILS_MAX_KEK_LEN }, 775 [NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN), 776 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, }, 777 [NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 778 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 }, 779 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = { 780 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 781 }, 782 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 }, 783 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY, 784 .len = FILS_ERP_MAX_USERNAME_LEN }, 785 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY, 786 .len = FILS_ERP_MAX_REALM_LEN }, 787 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 }, 788 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY, 789 .len = FILS_ERP_MAX_RRK_LEN }, 790 [NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2), 791 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN }, 792 [NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN), 793 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG }, 794 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG }, 795 796 [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 }, 797 [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 }, 798 [NL80211_ATTR_TXQ_QUANTUM] = NLA_POLICY_FULL_RANGE(NLA_U32, &q_range), 799 [NL80211_ATTR_HE_CAPABILITY] = 800 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa, 801 NL80211_HE_MAX_CAPABILITY_LEN), 802 [NL80211_ATTR_FTM_RESPONDER] = 803 NLA_POLICY_NESTED(nl80211_ftm_responder_policy), 804 [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1), 805 [NL80211_ATTR_PEER_MEASUREMENTS] = 806 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy), 807 [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1), 808 [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY, 809 .len = SAE_PASSWORD_MAX_LEN }, 810 [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG }, 811 [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy), 812 [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2), 813 [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy), 814 [NL80211_ATTR_TID_CONFIG] = 815 NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy), 816 [NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG }, 817 [NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1), 818 [NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100), 819 [NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG }, 820 [NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 821 [NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED }, 822 [NL80211_ATTR_HE_6GHZ_CAPABILITY] = 823 NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)), 824 [NL80211_ATTR_FILS_DISCOVERY] = 825 NLA_POLICY_NESTED(nl80211_fils_discovery_policy), 826 [NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] = 827 NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy), 828 [NL80211_ATTR_S1G_CAPABILITY] = 829 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 830 [NL80211_ATTR_S1G_CAPABILITY_MASK] = 831 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 832 [NL80211_ATTR_SAE_PWE] = 833 NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK, 834 NL80211_SAE_PWE_BOTH), 835 [NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT }, 836 [NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy), 837 [NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG }, 838 [NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 }, 839 [NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 }, 840 [NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 }, 841 [NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy), 842 [NL80211_ATTR_MBSSID_CONFIG] = 843 NLA_POLICY_NESTED(nl80211_mbssid_config_policy), 844 [NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED }, 845 [NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG }, 846 [NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 }, 847 [NL80211_ATTR_EHT_CAPABILITY] = 848 NLA_POLICY_RANGE(NLA_BINARY, 849 NL80211_EHT_MIN_CAPABILITY_LEN, 850 NL80211_EHT_MAX_CAPABILITY_LEN), 851 [NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG }, 852 [NL80211_ATTR_MLO_LINKS] = 853 NLA_POLICY_NESTED_ARRAY(nl80211_policy), 854 [NL80211_ATTR_MLO_LINK_ID] = 855 NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS - 1), 856 [NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN), 857 [NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG }, 858 [NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT }, 859 [NL80211_ATTR_EML_CAPABILITY] = { .type = NLA_U16 }, 860 [NL80211_ATTR_PUNCT_BITMAP] = 861 NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range), 862 863 [NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS] = { .type = NLA_U16 }, 864 [NL80211_ATTR_HW_TIMESTAMP_ENABLED] = { .type = NLA_FLAG }, 865 [NL80211_ATTR_EMA_RNR_ELEMS] = { .type = NLA_NESTED }, 866 [NL80211_ATTR_MLO_LINK_DISABLED] = { .type = NLA_FLAG }, 867 [NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA] = { .type = NLA_FLAG }, 868 [NL80211_ATTR_MLO_TTLM_DLINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 869 [NL80211_ATTR_MLO_TTLM_ULINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 870 [NL80211_ATTR_ASSOC_SPP_AMSDU] = { .type = NLA_FLAG }, 871 [NL80211_ATTR_VIF_RADIO_MASK] = { .type = NLA_U32 }, 872 [NL80211_ATTR_SUPPORTED_SELECTORS] = 873 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_supported_selectors, 874 NL80211_MAX_SUPP_SELECTORS), 875 [NL80211_ATTR_MLO_RECONF_REM_LINKS] = { .type = NLA_U16 }, 876 [NL80211_ATTR_EPCS] = { .type = NLA_FLAG }, 877 [NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS] = { .type = NLA_U16 }, 878 [NL80211_ATTR_WIPHY_RADIO_INDEX] = { .type = NLA_U8 }, 879 [NL80211_ATTR_S1G_LONG_BEACON_PERIOD] = NLA_POLICY_MIN(NLA_U8, 2), 880 [NL80211_ATTR_S1G_SHORT_BEACON] = 881 NLA_POLICY_NESTED(nl80211_s1g_short_beacon), 882 [NL80211_ATTR_BSS_PARAM] = { .type = NLA_FLAG }, 883 }; 884 885 /* policy for the key attributes */ 886 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = { 887 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN }, 888 [NL80211_KEY_IDX] = { .type = NLA_U8 }, 889 [NL80211_KEY_CIPHER] = { .type = NLA_U32 }, 890 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 891 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG }, 892 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG }, 893 [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1), 894 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 895 [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX), 896 }; 897 898 /* policy for the key default flags */ 899 static const struct nla_policy 900 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = { 901 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG }, 902 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG }, 903 }; 904 905 #ifdef CONFIG_PM 906 /* policy for WoWLAN attributes */ 907 static const struct nla_policy 908 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = { 909 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG }, 910 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG }, 911 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG }, 912 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED }, 913 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG }, 914 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG }, 915 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG }, 916 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG }, 917 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED }, 918 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED }, 919 }; 920 921 static const struct nla_policy 922 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = { 923 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 }, 924 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 }, 925 [NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 926 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 }, 927 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 }, 928 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 929 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = { 930 .len = sizeof(struct nl80211_wowlan_tcp_data_seq) 931 }, 932 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = { 933 .len = sizeof(struct nl80211_wowlan_tcp_data_token) 934 }, 935 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 }, 936 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 937 [NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1), 938 }; 939 #endif /* CONFIG_PM */ 940 941 /* policy for coalesce rule attributes */ 942 static const struct nla_policy 943 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = { 944 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 }, 945 [NL80211_ATTR_COALESCE_RULE_CONDITION] = 946 NLA_POLICY_RANGE(NLA_U32, 947 NL80211_COALESCE_CONDITION_MATCH, 948 NL80211_COALESCE_CONDITION_NO_MATCH), 949 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED }, 950 }; 951 952 /* policy for GTK rekey offload attributes */ 953 static const struct nla_policy 954 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = { 955 [NL80211_REKEY_DATA_KEK] = { 956 .type = NLA_BINARY, 957 .len = NL80211_KEK_EXT_LEN 958 }, 959 [NL80211_REKEY_DATA_KCK] = { 960 .type = NLA_BINARY, 961 .len = NL80211_KCK_EXT_LEN_32 962 }, 963 [NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN), 964 [NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 }, 965 }; 966 967 static const struct nla_policy 968 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = { 969 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY, 970 .len = IEEE80211_MAX_SSID_LEN }, 971 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 972 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 }, 973 }; 974 975 static const struct nla_policy 976 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = { 977 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 }, 978 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 }, 979 }; 980 981 static const struct nla_policy 982 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = { 983 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG }, 984 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 }, 985 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = { 986 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 987 }, 988 }; 989 990 /* policy for NAN function attributes */ 991 static const struct nla_policy 992 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = { 993 [NL80211_NAN_FUNC_TYPE] = 994 NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE), 995 [NL80211_NAN_FUNC_SERVICE_ID] = { 996 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN }, 997 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 }, 998 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG }, 999 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG }, 1000 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 }, 1001 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 }, 1002 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 1003 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG }, 1004 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 }, 1005 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY, 1006 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN }, 1007 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED }, 1008 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED }, 1009 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED }, 1010 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 }, 1011 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 }, 1012 }; 1013 1014 /* policy for Service Response Filter attributes */ 1015 static const struct nla_policy 1016 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = { 1017 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG }, 1018 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY, 1019 .len = NL80211_NAN_FUNC_SRF_MAX_LEN }, 1020 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 }, 1021 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED }, 1022 }; 1023 1024 /* policy for packet pattern attributes */ 1025 static const struct nla_policy 1026 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = { 1027 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, }, 1028 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, }, 1029 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 }, 1030 }; 1031 1032 static int nl80211_prepare_wdev_dump(struct netlink_callback *cb, 1033 struct cfg80211_registered_device **rdev, 1034 struct wireless_dev **wdev, 1035 struct nlattr **attrbuf) 1036 { 1037 int err; 1038 1039 if (!cb->args[0]) { 1040 struct nlattr **attrbuf_free = NULL; 1041 1042 if (!attrbuf) { 1043 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 1044 GFP_KERNEL); 1045 if (!attrbuf) 1046 return -ENOMEM; 1047 attrbuf_free = attrbuf; 1048 } 1049 1050 err = nlmsg_parse_deprecated(cb->nlh, 1051 GENL_HDRLEN + nl80211_fam.hdrsize, 1052 attrbuf, nl80211_fam.maxattr, 1053 nl80211_policy, NULL); 1054 if (err) { 1055 kfree(attrbuf_free); 1056 return err; 1057 } 1058 1059 rtnl_lock(); 1060 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk), 1061 attrbuf); 1062 kfree(attrbuf_free); 1063 if (IS_ERR(*wdev)) { 1064 rtnl_unlock(); 1065 return PTR_ERR(*wdev); 1066 } 1067 *rdev = wiphy_to_rdev((*wdev)->wiphy); 1068 mutex_lock(&(*rdev)->wiphy.mtx); 1069 rtnl_unlock(); 1070 /* 0 is the first index - add 1 to parse only once */ 1071 cb->args[0] = (*rdev)->wiphy_idx + 1; 1072 cb->args[1] = (*wdev)->identifier; 1073 } else { 1074 /* subtract the 1 again here */ 1075 struct wiphy *wiphy; 1076 struct wireless_dev *tmp; 1077 1078 rtnl_lock(); 1079 wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 1080 if (!wiphy) { 1081 rtnl_unlock(); 1082 return -ENODEV; 1083 } 1084 *rdev = wiphy_to_rdev(wiphy); 1085 *wdev = NULL; 1086 1087 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) { 1088 if (tmp->identifier == cb->args[1]) { 1089 *wdev = tmp; 1090 break; 1091 } 1092 } 1093 1094 if (!*wdev) { 1095 rtnl_unlock(); 1096 return -ENODEV; 1097 } 1098 mutex_lock(&(*rdev)->wiphy.mtx); 1099 rtnl_unlock(); 1100 } 1101 1102 return 0; 1103 } 1104 1105 /* message building helper */ 1106 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq, 1107 int flags, u8 cmd) 1108 { 1109 /* since there is no private header just add the generic one */ 1110 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd); 1111 } 1112 1113 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg, 1114 const struct ieee80211_reg_rule *rule) 1115 { 1116 int j; 1117 struct nlattr *nl_wmm_rules = 1118 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM); 1119 1120 if (!nl_wmm_rules) 1121 goto nla_put_failure; 1122 1123 for (j = 0; j < IEEE80211_NUM_ACS; j++) { 1124 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j); 1125 1126 if (!nl_wmm_rule) 1127 goto nla_put_failure; 1128 1129 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN, 1130 rule->wmm_rule.client[j].cw_min) || 1131 nla_put_u16(msg, NL80211_WMMR_CW_MAX, 1132 rule->wmm_rule.client[j].cw_max) || 1133 nla_put_u8(msg, NL80211_WMMR_AIFSN, 1134 rule->wmm_rule.client[j].aifsn) || 1135 nla_put_u16(msg, NL80211_WMMR_TXOP, 1136 rule->wmm_rule.client[j].cot)) 1137 goto nla_put_failure; 1138 1139 nla_nest_end(msg, nl_wmm_rule); 1140 } 1141 nla_nest_end(msg, nl_wmm_rules); 1142 1143 return 0; 1144 1145 nla_put_failure: 1146 return -ENOBUFS; 1147 } 1148 1149 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy, 1150 struct ieee80211_channel *chan, 1151 bool large) 1152 { 1153 /* Some channels must be completely excluded from the 1154 * list to protect old user-space tools from breaking 1155 */ 1156 if (!large && chan->flags & 1157 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ)) 1158 return 0; 1159 if (!large && chan->freq_offset) 1160 return 0; 1161 1162 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ, 1163 chan->center_freq)) 1164 goto nla_put_failure; 1165 1166 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset)) 1167 goto nla_put_failure; 1168 1169 if ((chan->flags & IEEE80211_CHAN_PSD) && 1170 nla_put_s8(msg, NL80211_FREQUENCY_ATTR_PSD, chan->psd)) 1171 goto nla_put_failure; 1172 1173 if ((chan->flags & IEEE80211_CHAN_DISABLED) && 1174 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED)) 1175 goto nla_put_failure; 1176 if (chan->flags & IEEE80211_CHAN_NO_IR) { 1177 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR)) 1178 goto nla_put_failure; 1179 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS)) 1180 goto nla_put_failure; 1181 } 1182 if (chan->flags & IEEE80211_CHAN_RADAR) { 1183 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR)) 1184 goto nla_put_failure; 1185 if (large) { 1186 u32 time; 1187 1188 time = elapsed_jiffies_msecs(chan->dfs_state_entered); 1189 1190 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE, 1191 chan->dfs_state)) 1192 goto nla_put_failure; 1193 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME, 1194 time)) 1195 goto nla_put_failure; 1196 if (nla_put_u32(msg, 1197 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME, 1198 chan->dfs_cac_ms)) 1199 goto nla_put_failure; 1200 } 1201 } 1202 1203 if (large) { 1204 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) && 1205 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS)) 1206 goto nla_put_failure; 1207 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) && 1208 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS)) 1209 goto nla_put_failure; 1210 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) && 1211 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ)) 1212 goto nla_put_failure; 1213 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) && 1214 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ)) 1215 goto nla_put_failure; 1216 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) && 1217 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY)) 1218 goto nla_put_failure; 1219 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) && 1220 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT)) 1221 goto nla_put_failure; 1222 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) && 1223 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ)) 1224 goto nla_put_failure; 1225 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) && 1226 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ)) 1227 goto nla_put_failure; 1228 if ((chan->flags & IEEE80211_CHAN_NO_HE) && 1229 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE)) 1230 goto nla_put_failure; 1231 if ((chan->flags & IEEE80211_CHAN_1MHZ) && 1232 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_1MHZ)) 1233 goto nla_put_failure; 1234 if ((chan->flags & IEEE80211_CHAN_2MHZ) && 1235 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_2MHZ)) 1236 goto nla_put_failure; 1237 if ((chan->flags & IEEE80211_CHAN_4MHZ) && 1238 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_4MHZ)) 1239 goto nla_put_failure; 1240 if ((chan->flags & IEEE80211_CHAN_8MHZ) && 1241 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_8MHZ)) 1242 goto nla_put_failure; 1243 if ((chan->flags & IEEE80211_CHAN_16MHZ) && 1244 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_16MHZ)) 1245 goto nla_put_failure; 1246 if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) && 1247 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ)) 1248 goto nla_put_failure; 1249 if ((chan->flags & IEEE80211_CHAN_NO_EHT) && 1250 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT)) 1251 goto nla_put_failure; 1252 if ((chan->flags & IEEE80211_CHAN_DFS_CONCURRENT) && 1253 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DFS_CONCURRENT)) 1254 goto nla_put_failure; 1255 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_VLP_CLIENT) && 1256 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_VLP_CLIENT)) 1257 goto nla_put_failure; 1258 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_AFC_CLIENT) && 1259 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_AFC_CLIENT)) 1260 goto nla_put_failure; 1261 if ((chan->flags & IEEE80211_CHAN_CAN_MONITOR) && 1262 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_CAN_MONITOR)) 1263 goto nla_put_failure; 1264 if ((chan->flags & IEEE80211_CHAN_ALLOW_6GHZ_VLP_AP) && 1265 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_ALLOW_6GHZ_VLP_AP)) 1266 goto nla_put_failure; 1267 if ((chan->flags & IEEE80211_CHAN_ALLOW_20MHZ_ACTIVITY) && 1268 nla_put_flag(msg, 1269 NL80211_FREQUENCY_ATTR_ALLOW_20MHZ_ACTIVITY)) 1270 goto nla_put_failure; 1271 } 1272 1273 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER, 1274 DBM_TO_MBM(chan->max_power))) 1275 goto nla_put_failure; 1276 1277 if (large) { 1278 const struct ieee80211_reg_rule *rule = 1279 freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq)); 1280 1281 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) { 1282 if (nl80211_msg_put_wmm_rules(msg, rule)) 1283 goto nla_put_failure; 1284 } 1285 } 1286 1287 return 0; 1288 1289 nla_put_failure: 1290 return -ENOBUFS; 1291 } 1292 1293 static bool nl80211_put_txq_stats(struct sk_buff *msg, 1294 struct cfg80211_txq_stats *txqstats, 1295 int attrtype) 1296 { 1297 struct nlattr *txqattr; 1298 1299 #define PUT_TXQVAL_U32(attr, memb) do { \ 1300 if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \ 1301 nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \ 1302 return false; \ 1303 } while (0) 1304 1305 txqattr = nla_nest_start_noflag(msg, attrtype); 1306 if (!txqattr) 1307 return false; 1308 1309 PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes); 1310 PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets); 1311 PUT_TXQVAL_U32(FLOWS, flows); 1312 PUT_TXQVAL_U32(DROPS, drops); 1313 PUT_TXQVAL_U32(ECN_MARKS, ecn_marks); 1314 PUT_TXQVAL_U32(OVERLIMIT, overlimit); 1315 PUT_TXQVAL_U32(OVERMEMORY, overmemory); 1316 PUT_TXQVAL_U32(COLLISIONS, collisions); 1317 PUT_TXQVAL_U32(TX_BYTES, tx_bytes); 1318 PUT_TXQVAL_U32(TX_PACKETS, tx_packets); 1319 PUT_TXQVAL_U32(MAX_FLOWS, max_flows); 1320 nla_nest_end(msg, txqattr); 1321 1322 #undef PUT_TXQVAL_U32 1323 return true; 1324 } 1325 1326 /* netlink command implementations */ 1327 1328 /** 1329 * nl80211_link_id - return link ID 1330 * @attrs: attributes to look at 1331 * 1332 * Returns: the link ID or 0 if not given 1333 * 1334 * Note this function doesn't do any validation of the link 1335 * ID validity wrt. links that were actually added, so it must 1336 * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID 1337 * or if additional validation is done. 1338 */ 1339 static unsigned int nl80211_link_id(struct nlattr **attrs) 1340 { 1341 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1342 1343 return nla_get_u8_default(linkid, 0); 1344 } 1345 1346 static int nl80211_link_id_or_invalid(struct nlattr **attrs) 1347 { 1348 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1349 1350 if (!linkid) 1351 return -1; 1352 1353 return nla_get_u8(linkid); 1354 } 1355 1356 struct key_parse { 1357 struct key_params p; 1358 int idx; 1359 int type; 1360 bool def, defmgmt, defbeacon; 1361 bool def_uni, def_multi; 1362 }; 1363 1364 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key, 1365 struct key_parse *k) 1366 { 1367 struct nlattr *tb[NL80211_KEY_MAX + 1]; 1368 int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key, 1369 nl80211_key_policy, 1370 info->extack); 1371 if (err) 1372 return err; 1373 1374 k->def = !!tb[NL80211_KEY_DEFAULT]; 1375 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT]; 1376 k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON]; 1377 1378 if (k->def) { 1379 k->def_uni = true; 1380 k->def_multi = true; 1381 } 1382 if (k->defmgmt || k->defbeacon) 1383 k->def_multi = true; 1384 1385 if (tb[NL80211_KEY_IDX]) 1386 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]); 1387 1388 if (tb[NL80211_KEY_DATA]) { 1389 k->p.key = nla_data(tb[NL80211_KEY_DATA]); 1390 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]); 1391 } 1392 1393 if (tb[NL80211_KEY_SEQ]) { 1394 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]); 1395 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]); 1396 } 1397 1398 if (tb[NL80211_KEY_CIPHER]) 1399 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]); 1400 1401 if (tb[NL80211_KEY_TYPE]) 1402 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]); 1403 1404 if (tb[NL80211_KEY_DEFAULT_TYPES]) { 1405 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1406 1407 err = nla_parse_nested_deprecated(kdt, 1408 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1409 tb[NL80211_KEY_DEFAULT_TYPES], 1410 nl80211_key_default_policy, 1411 info->extack); 1412 if (err) 1413 return err; 1414 1415 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1416 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1417 } 1418 1419 if (tb[NL80211_KEY_MODE]) 1420 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]); 1421 1422 return 0; 1423 } 1424 1425 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k) 1426 { 1427 if (info->attrs[NL80211_ATTR_KEY_DATA]) { 1428 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]); 1429 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]); 1430 } 1431 1432 if (info->attrs[NL80211_ATTR_KEY_SEQ]) { 1433 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]); 1434 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]); 1435 } 1436 1437 if (info->attrs[NL80211_ATTR_KEY_IDX]) 1438 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 1439 1440 if (info->attrs[NL80211_ATTR_KEY_CIPHER]) 1441 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]); 1442 1443 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT]; 1444 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT]; 1445 1446 if (k->def) { 1447 k->def_uni = true; 1448 k->def_multi = true; 1449 } 1450 if (k->defmgmt) 1451 k->def_multi = true; 1452 1453 if (info->attrs[NL80211_ATTR_KEY_TYPE]) 1454 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 1455 1456 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) { 1457 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1458 int err = nla_parse_nested_deprecated(kdt, 1459 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1460 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES], 1461 nl80211_key_default_policy, 1462 info->extack); 1463 if (err) 1464 return err; 1465 1466 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1467 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1468 } 1469 1470 return 0; 1471 } 1472 1473 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k) 1474 { 1475 int err; 1476 1477 memset(k, 0, sizeof(*k)); 1478 k->idx = -1; 1479 k->type = -1; 1480 1481 if (info->attrs[NL80211_ATTR_KEY]) 1482 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k); 1483 else 1484 err = nl80211_parse_key_old(info, k); 1485 1486 if (err) 1487 return err; 1488 1489 if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) + 1490 (k->defbeacon ? 1 : 0) > 1) { 1491 GENL_SET_ERR_MSG(info, 1492 "key with multiple default flags is invalid"); 1493 return -EINVAL; 1494 } 1495 1496 if (k->defmgmt || k->defbeacon) { 1497 if (k->def_uni || !k->def_multi) { 1498 GENL_SET_ERR_MSG(info, 1499 "defmgmt/defbeacon key must be mcast"); 1500 return -EINVAL; 1501 } 1502 } 1503 1504 if (k->idx != -1) { 1505 if (k->defmgmt) { 1506 if (k->idx < 4 || k->idx > 5) { 1507 GENL_SET_ERR_MSG(info, 1508 "defmgmt key idx not 4 or 5"); 1509 return -EINVAL; 1510 } 1511 } else if (k->defbeacon) { 1512 if (k->idx < 6 || k->idx > 7) { 1513 GENL_SET_ERR_MSG(info, 1514 "defbeacon key idx not 6 or 7"); 1515 return -EINVAL; 1516 } 1517 } else if (k->def) { 1518 if (k->idx < 0 || k->idx > 3) { 1519 GENL_SET_ERR_MSG(info, "def key idx not 0-3"); 1520 return -EINVAL; 1521 } 1522 } else { 1523 if (k->idx < 0 || k->idx > 7) { 1524 GENL_SET_ERR_MSG(info, "key idx not 0-7"); 1525 return -EINVAL; 1526 } 1527 } 1528 } 1529 1530 return 0; 1531 } 1532 1533 static struct cfg80211_cached_keys * 1534 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev, 1535 struct genl_info *info, bool *no_ht) 1536 { 1537 struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS]; 1538 struct key_parse parse; 1539 struct nlattr *key; 1540 struct cfg80211_cached_keys *result; 1541 int rem, err, def = 0; 1542 bool have_key = false; 1543 1544 nla_for_each_nested(key, keys, rem) { 1545 have_key = true; 1546 break; 1547 } 1548 1549 if (!have_key) 1550 return NULL; 1551 1552 result = kzalloc(sizeof(*result), GFP_KERNEL); 1553 if (!result) 1554 return ERR_PTR(-ENOMEM); 1555 1556 result->def = -1; 1557 1558 nla_for_each_nested(key, keys, rem) { 1559 memset(&parse, 0, sizeof(parse)); 1560 parse.idx = -1; 1561 1562 err = nl80211_parse_key_new(info, key, &parse); 1563 if (err) 1564 goto error; 1565 err = -EINVAL; 1566 if (!parse.p.key) 1567 goto error; 1568 if (parse.idx < 0 || parse.idx > 3) { 1569 GENL_SET_ERR_MSG(info, "key index out of range [0-3]"); 1570 goto error; 1571 } 1572 if (parse.def) { 1573 if (def) { 1574 GENL_SET_ERR_MSG(info, 1575 "only one key can be default"); 1576 goto error; 1577 } 1578 def = 1; 1579 result->def = parse.idx; 1580 if (!parse.def_uni || !parse.def_multi) 1581 goto error; 1582 } else if (parse.defmgmt) 1583 goto error; 1584 err = cfg80211_validate_key_settings(rdev, &parse.p, 1585 parse.idx, false, NULL); 1586 if (err) 1587 goto error; 1588 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 && 1589 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) { 1590 GENL_SET_ERR_MSG(info, "connect key must be WEP"); 1591 err = -EINVAL; 1592 goto error; 1593 } 1594 result->params[parse.idx].cipher = parse.p.cipher; 1595 result->params[parse.idx].key_len = parse.p.key_len; 1596 result->params[parse.idx].key = result->data[parse.idx]; 1597 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len); 1598 1599 /* must be WEP key if we got here */ 1600 if (no_ht) 1601 *no_ht = true; 1602 } 1603 1604 if (result->def < 0) { 1605 err = -EINVAL; 1606 GENL_SET_ERR_MSG(info, "need a default/TX key"); 1607 goto error; 1608 } 1609 1610 return result; 1611 error: 1612 kfree_sensitive(result); 1613 return ERR_PTR(err); 1614 } 1615 1616 static int nl80211_key_allowed(struct wireless_dev *wdev) 1617 { 1618 lockdep_assert_wiphy(wdev->wiphy); 1619 1620 switch (wdev->iftype) { 1621 case NL80211_IFTYPE_AP: 1622 case NL80211_IFTYPE_AP_VLAN: 1623 case NL80211_IFTYPE_P2P_GO: 1624 case NL80211_IFTYPE_MESH_POINT: 1625 break; 1626 case NL80211_IFTYPE_ADHOC: 1627 if (wdev->u.ibss.current_bss) 1628 return 0; 1629 return -ENOLINK; 1630 case NL80211_IFTYPE_STATION: 1631 case NL80211_IFTYPE_P2P_CLIENT: 1632 if (wdev->connected) 1633 return 0; 1634 return -ENOLINK; 1635 case NL80211_IFTYPE_NAN: 1636 if (wiphy_ext_feature_isset(wdev->wiphy, 1637 NL80211_EXT_FEATURE_SECURE_NAN)) 1638 return 0; 1639 return -EINVAL; 1640 case NL80211_IFTYPE_UNSPECIFIED: 1641 case NL80211_IFTYPE_OCB: 1642 case NL80211_IFTYPE_MONITOR: 1643 case NL80211_IFTYPE_P2P_DEVICE: 1644 case NL80211_IFTYPE_WDS: 1645 case NUM_NL80211_IFTYPES: 1646 return -EINVAL; 1647 } 1648 1649 return 0; 1650 } 1651 1652 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy, 1653 u32 freq) 1654 { 1655 struct ieee80211_channel *chan; 1656 1657 chan = ieee80211_get_channel_khz(wiphy, freq); 1658 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) 1659 return NULL; 1660 return chan; 1661 } 1662 1663 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes) 1664 { 1665 struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr); 1666 int i; 1667 1668 if (!nl_modes) 1669 goto nla_put_failure; 1670 1671 i = 0; 1672 while (ifmodes) { 1673 if ((ifmodes & 1) && nla_put_flag(msg, i)) 1674 goto nla_put_failure; 1675 ifmodes >>= 1; 1676 i++; 1677 } 1678 1679 nla_nest_end(msg, nl_modes); 1680 return 0; 1681 1682 nla_put_failure: 1683 return -ENOBUFS; 1684 } 1685 1686 static int nl80211_put_ifcomb_data(struct sk_buff *msg, bool large, int idx, 1687 const struct ieee80211_iface_combination *c, 1688 u16 nested) 1689 { 1690 struct nlattr *nl_combi, *nl_limits; 1691 int i; 1692 1693 nl_combi = nla_nest_start_noflag(msg, idx | nested); 1694 if (!nl_combi) 1695 goto nla_put_failure; 1696 1697 nl_limits = nla_nest_start_noflag(msg, NL80211_IFACE_COMB_LIMITS | 1698 nested); 1699 if (!nl_limits) 1700 goto nla_put_failure; 1701 1702 for (i = 0; i < c->n_limits; i++) { 1703 struct nlattr *nl_limit; 1704 1705 nl_limit = nla_nest_start_noflag(msg, i + 1); 1706 if (!nl_limit) 1707 goto nla_put_failure; 1708 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, c->limits[i].max)) 1709 goto nla_put_failure; 1710 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES, 1711 c->limits[i].types)) 1712 goto nla_put_failure; 1713 nla_nest_end(msg, nl_limit); 1714 } 1715 1716 nla_nest_end(msg, nl_limits); 1717 1718 if (c->beacon_int_infra_match && 1719 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH)) 1720 goto nla_put_failure; 1721 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS, 1722 c->num_different_channels) || 1723 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM, 1724 c->max_interfaces)) 1725 goto nla_put_failure; 1726 if (large && 1727 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS, 1728 c->radar_detect_widths) || 1729 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS, 1730 c->radar_detect_regions))) 1731 goto nla_put_failure; 1732 if (c->beacon_int_min_gcd && 1733 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD, 1734 c->beacon_int_min_gcd)) 1735 goto nla_put_failure; 1736 1737 nla_nest_end(msg, nl_combi); 1738 1739 return 0; 1740 nla_put_failure: 1741 return -ENOBUFS; 1742 } 1743 1744 static int nl80211_put_iface_combinations(struct wiphy *wiphy, 1745 struct sk_buff *msg, 1746 int attr, int radio, 1747 bool large, u16 nested) 1748 { 1749 const struct ieee80211_iface_combination *c; 1750 struct nlattr *nl_combis; 1751 int i, n; 1752 1753 nl_combis = nla_nest_start_noflag(msg, attr | nested); 1754 if (!nl_combis) 1755 goto nla_put_failure; 1756 1757 if (radio >= 0) { 1758 c = wiphy->radio[0].iface_combinations; 1759 n = wiphy->radio[0].n_iface_combinations; 1760 } else { 1761 c = wiphy->iface_combinations; 1762 n = wiphy->n_iface_combinations; 1763 } 1764 for (i = 0; i < n; i++) 1765 if (nl80211_put_ifcomb_data(msg, large, i + 1, &c[i], nested)) 1766 goto nla_put_failure; 1767 1768 nla_nest_end(msg, nl_combis); 1769 1770 return 0; 1771 nla_put_failure: 1772 return -ENOBUFS; 1773 } 1774 1775 #ifdef CONFIG_PM 1776 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev, 1777 struct sk_buff *msg) 1778 { 1779 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp; 1780 struct nlattr *nl_tcp; 1781 1782 if (!tcp) 1783 return 0; 1784 1785 nl_tcp = nla_nest_start_noflag(msg, 1786 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 1787 if (!nl_tcp) 1788 return -ENOBUFS; 1789 1790 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1791 tcp->data_payload_max)) 1792 return -ENOBUFS; 1793 1794 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1795 tcp->data_payload_max)) 1796 return -ENOBUFS; 1797 1798 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ)) 1799 return -ENOBUFS; 1800 1801 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 1802 sizeof(*tcp->tok), tcp->tok)) 1803 return -ENOBUFS; 1804 1805 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 1806 tcp->data_interval_max)) 1807 return -ENOBUFS; 1808 1809 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 1810 tcp->wake_payload_max)) 1811 return -ENOBUFS; 1812 1813 nla_nest_end(msg, nl_tcp); 1814 return 0; 1815 } 1816 1817 static int nl80211_send_wowlan(struct sk_buff *msg, 1818 struct cfg80211_registered_device *rdev, 1819 bool large) 1820 { 1821 struct nlattr *nl_wowlan; 1822 1823 if (!rdev->wiphy.wowlan) 1824 return 0; 1825 1826 nl_wowlan = nla_nest_start_noflag(msg, 1827 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED); 1828 if (!nl_wowlan) 1829 return -ENOBUFS; 1830 1831 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) && 1832 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 1833 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) && 1834 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 1835 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) && 1836 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 1837 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) && 1838 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) || 1839 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) && 1840 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 1841 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) && 1842 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 1843 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) && 1844 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 1845 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) && 1846 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 1847 return -ENOBUFS; 1848 1849 if (rdev->wiphy.wowlan->n_patterns) { 1850 struct nl80211_pattern_support pat = { 1851 .max_patterns = rdev->wiphy.wowlan->n_patterns, 1852 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len, 1853 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len, 1854 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset, 1855 }; 1856 1857 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 1858 sizeof(pat), &pat)) 1859 return -ENOBUFS; 1860 } 1861 1862 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) && 1863 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT, 1864 rdev->wiphy.wowlan->max_nd_match_sets)) 1865 return -ENOBUFS; 1866 1867 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg)) 1868 return -ENOBUFS; 1869 1870 nla_nest_end(msg, nl_wowlan); 1871 1872 return 0; 1873 } 1874 #endif 1875 1876 static int nl80211_send_coalesce(struct sk_buff *msg, 1877 struct cfg80211_registered_device *rdev) 1878 { 1879 struct nl80211_coalesce_rule_support rule; 1880 1881 if (!rdev->wiphy.coalesce) 1882 return 0; 1883 1884 rule.max_rules = rdev->wiphy.coalesce->n_rules; 1885 rule.max_delay = rdev->wiphy.coalesce->max_delay; 1886 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns; 1887 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len; 1888 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len; 1889 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset; 1890 1891 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule)) 1892 return -ENOBUFS; 1893 1894 return 0; 1895 } 1896 1897 static int 1898 nl80211_send_iftype_data(struct sk_buff *msg, 1899 const struct ieee80211_supported_band *sband, 1900 const struct ieee80211_sband_iftype_data *iftdata) 1901 { 1902 const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap; 1903 const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap; 1904 1905 if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES, 1906 iftdata->types_mask)) 1907 return -ENOBUFS; 1908 1909 if (he_cap->has_he) { 1910 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC, 1911 sizeof(he_cap->he_cap_elem.mac_cap_info), 1912 he_cap->he_cap_elem.mac_cap_info) || 1913 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY, 1914 sizeof(he_cap->he_cap_elem.phy_cap_info), 1915 he_cap->he_cap_elem.phy_cap_info) || 1916 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET, 1917 sizeof(he_cap->he_mcs_nss_supp), 1918 &he_cap->he_mcs_nss_supp) || 1919 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE, 1920 sizeof(he_cap->ppe_thres), he_cap->ppe_thres)) 1921 return -ENOBUFS; 1922 } 1923 1924 if (eht_cap->has_eht && he_cap->has_he) { 1925 u8 mcs_nss_size, ppe_thresh_size; 1926 u16 ppe_thres_hdr; 1927 bool is_ap; 1928 1929 is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) || 1930 iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO); 1931 1932 mcs_nss_size = 1933 ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 1934 &eht_cap->eht_cap_elem, 1935 is_ap); 1936 1937 ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]); 1938 ppe_thresh_size = 1939 ieee80211_eht_ppe_size(ppe_thres_hdr, 1940 eht_cap->eht_cap_elem.phy_cap_info); 1941 1942 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC, 1943 sizeof(eht_cap->eht_cap_elem.mac_cap_info), 1944 eht_cap->eht_cap_elem.mac_cap_info) || 1945 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY, 1946 sizeof(eht_cap->eht_cap_elem.phy_cap_info), 1947 eht_cap->eht_cap_elem.phy_cap_info) || 1948 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET, 1949 mcs_nss_size, &eht_cap->eht_mcs_nss_supp) || 1950 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE, 1951 ppe_thresh_size, eht_cap->eht_ppe_thres)) 1952 return -ENOBUFS; 1953 } 1954 1955 if (sband->band == NL80211_BAND_6GHZ && 1956 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA, 1957 sizeof(iftdata->he_6ghz_capa), 1958 &iftdata->he_6ghz_capa)) 1959 return -ENOBUFS; 1960 1961 if (iftdata->vendor_elems.data && iftdata->vendor_elems.len && 1962 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS, 1963 iftdata->vendor_elems.len, iftdata->vendor_elems.data)) 1964 return -ENOBUFS; 1965 1966 return 0; 1967 } 1968 1969 static int nl80211_send_band_rateinfo(struct sk_buff *msg, 1970 struct ieee80211_supported_band *sband, 1971 bool large) 1972 { 1973 struct nlattr *nl_rates, *nl_rate; 1974 struct ieee80211_rate *rate; 1975 int i; 1976 1977 /* add HT info */ 1978 if (sband->ht_cap.ht_supported && 1979 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET, 1980 sizeof(sband->ht_cap.mcs), 1981 &sband->ht_cap.mcs) || 1982 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA, 1983 sband->ht_cap.cap) || 1984 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR, 1985 sband->ht_cap.ampdu_factor) || 1986 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY, 1987 sband->ht_cap.ampdu_density))) 1988 return -ENOBUFS; 1989 1990 /* add VHT info */ 1991 if (sband->vht_cap.vht_supported && 1992 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET, 1993 sizeof(sband->vht_cap.vht_mcs), 1994 &sband->vht_cap.vht_mcs) || 1995 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA, 1996 sband->vht_cap.cap))) 1997 return -ENOBUFS; 1998 1999 if (large && sband->n_iftype_data) { 2000 struct nlattr *nl_iftype_data = 2001 nla_nest_start_noflag(msg, 2002 NL80211_BAND_ATTR_IFTYPE_DATA); 2003 const struct ieee80211_sband_iftype_data *iftd; 2004 int err; 2005 2006 if (!nl_iftype_data) 2007 return -ENOBUFS; 2008 2009 for_each_sband_iftype_data(sband, i, iftd) { 2010 struct nlattr *iftdata; 2011 2012 iftdata = nla_nest_start_noflag(msg, i + 1); 2013 if (!iftdata) 2014 return -ENOBUFS; 2015 2016 err = nl80211_send_iftype_data(msg, sband, iftd); 2017 if (err) 2018 return err; 2019 2020 nla_nest_end(msg, iftdata); 2021 } 2022 2023 nla_nest_end(msg, nl_iftype_data); 2024 } 2025 2026 /* add EDMG info */ 2027 if (large && sband->edmg_cap.channels && 2028 (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS, 2029 sband->edmg_cap.channels) || 2030 nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG, 2031 sband->edmg_cap.bw_config))) 2032 2033 return -ENOBUFS; 2034 2035 /* add bitrates */ 2036 nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES); 2037 if (!nl_rates) 2038 return -ENOBUFS; 2039 2040 for (i = 0; i < sband->n_bitrates; i++) { 2041 nl_rate = nla_nest_start_noflag(msg, i); 2042 if (!nl_rate) 2043 return -ENOBUFS; 2044 2045 rate = &sband->bitrates[i]; 2046 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE, 2047 rate->bitrate)) 2048 return -ENOBUFS; 2049 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) && 2050 nla_put_flag(msg, 2051 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE)) 2052 return -ENOBUFS; 2053 2054 nla_nest_end(msg, nl_rate); 2055 } 2056 2057 nla_nest_end(msg, nl_rates); 2058 2059 /* S1G capabilities */ 2060 if (sband->band == NL80211_BAND_S1GHZ && sband->s1g_cap.s1g && 2061 (nla_put(msg, NL80211_BAND_ATTR_S1G_CAPA, 2062 sizeof(sband->s1g_cap.cap), 2063 sband->s1g_cap.cap) || 2064 nla_put(msg, NL80211_BAND_ATTR_S1G_MCS_NSS_SET, 2065 sizeof(sband->s1g_cap.nss_mcs), 2066 sband->s1g_cap.nss_mcs))) 2067 return -ENOBUFS; 2068 2069 return 0; 2070 } 2071 2072 static int 2073 nl80211_send_mgmt_stypes(struct sk_buff *msg, 2074 const struct ieee80211_txrx_stypes *mgmt_stypes) 2075 { 2076 u16 stypes; 2077 struct nlattr *nl_ftypes, *nl_ifs; 2078 enum nl80211_iftype ift; 2079 int i; 2080 2081 if (!mgmt_stypes) 2082 return 0; 2083 2084 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES); 2085 if (!nl_ifs) 2086 return -ENOBUFS; 2087 2088 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2089 nl_ftypes = nla_nest_start_noflag(msg, ift); 2090 if (!nl_ftypes) 2091 return -ENOBUFS; 2092 i = 0; 2093 stypes = mgmt_stypes[ift].tx; 2094 while (stypes) { 2095 if ((stypes & 1) && 2096 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2097 (i << 4) | IEEE80211_FTYPE_MGMT)) 2098 return -ENOBUFS; 2099 stypes >>= 1; 2100 i++; 2101 } 2102 nla_nest_end(msg, nl_ftypes); 2103 } 2104 2105 nla_nest_end(msg, nl_ifs); 2106 2107 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES); 2108 if (!nl_ifs) 2109 return -ENOBUFS; 2110 2111 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2112 nl_ftypes = nla_nest_start_noflag(msg, ift); 2113 if (!nl_ftypes) 2114 return -ENOBUFS; 2115 i = 0; 2116 stypes = mgmt_stypes[ift].rx; 2117 while (stypes) { 2118 if ((stypes & 1) && 2119 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2120 (i << 4) | IEEE80211_FTYPE_MGMT)) 2121 return -ENOBUFS; 2122 stypes >>= 1; 2123 i++; 2124 } 2125 nla_nest_end(msg, nl_ftypes); 2126 } 2127 nla_nest_end(msg, nl_ifs); 2128 2129 return 0; 2130 } 2131 2132 #define CMD(op, n) \ 2133 do { \ 2134 if (rdev->ops->op) { \ 2135 i++; \ 2136 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \ 2137 goto nla_put_failure; \ 2138 } \ 2139 } while (0) 2140 2141 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev, 2142 struct sk_buff *msg) 2143 { 2144 int i = 0; 2145 2146 /* 2147 * do *NOT* add anything into this function, new things need to be 2148 * advertised only to new versions of userspace that can deal with 2149 * the split (and they can't possibly care about new features... 2150 */ 2151 CMD(add_virtual_intf, NEW_INTERFACE); 2152 CMD(change_virtual_intf, SET_INTERFACE); 2153 CMD(add_key, NEW_KEY); 2154 CMD(start_ap, START_AP); 2155 CMD(add_station, NEW_STATION); 2156 CMD(add_mpath, NEW_MPATH); 2157 CMD(update_mesh_config, SET_MESH_CONFIG); 2158 CMD(change_bss, SET_BSS); 2159 CMD(auth, AUTHENTICATE); 2160 CMD(assoc, ASSOCIATE); 2161 CMD(deauth, DEAUTHENTICATE); 2162 CMD(disassoc, DISASSOCIATE); 2163 CMD(join_ibss, JOIN_IBSS); 2164 CMD(join_mesh, JOIN_MESH); 2165 CMD(set_pmksa, SET_PMKSA); 2166 CMD(del_pmksa, DEL_PMKSA); 2167 CMD(flush_pmksa, FLUSH_PMKSA); 2168 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) 2169 CMD(remain_on_channel, REMAIN_ON_CHANNEL); 2170 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK); 2171 CMD(mgmt_tx, FRAME); 2172 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL); 2173 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) { 2174 i++; 2175 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS)) 2176 goto nla_put_failure; 2177 } 2178 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap || 2179 rdev->ops->join_mesh) { 2180 i++; 2181 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL)) 2182 goto nla_put_failure; 2183 } 2184 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) { 2185 CMD(tdls_mgmt, TDLS_MGMT); 2186 CMD(tdls_oper, TDLS_OPER); 2187 } 2188 if (rdev->wiphy.max_sched_scan_reqs) 2189 CMD(sched_scan_start, START_SCHED_SCAN); 2190 CMD(probe_client, PROBE_CLIENT); 2191 CMD(set_noack_map, SET_NOACK_MAP); 2192 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) { 2193 i++; 2194 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS)) 2195 goto nla_put_failure; 2196 } 2197 CMD(start_p2p_device, START_P2P_DEVICE); 2198 CMD(set_mcast_rate, SET_MCAST_RATE); 2199 #ifdef CONFIG_NL80211_TESTMODE 2200 CMD(testmode_cmd, TESTMODE); 2201 #endif 2202 2203 if (rdev->ops->connect || rdev->ops->auth) { 2204 i++; 2205 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT)) 2206 goto nla_put_failure; 2207 } 2208 2209 if (rdev->ops->disconnect || rdev->ops->deauth) { 2210 i++; 2211 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT)) 2212 goto nla_put_failure; 2213 } 2214 2215 return i; 2216 nla_put_failure: 2217 return -ENOBUFS; 2218 } 2219 2220 static int 2221 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap, 2222 struct sk_buff *msg) 2223 { 2224 struct nlattr *ftm; 2225 2226 if (!cap->ftm.supported) 2227 return 0; 2228 2229 ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM); 2230 if (!ftm) 2231 return -ENOBUFS; 2232 2233 if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP)) 2234 return -ENOBUFS; 2235 if (cap->ftm.non_asap && 2236 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP)) 2237 return -ENOBUFS; 2238 if (cap->ftm.request_lci && 2239 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI)) 2240 return -ENOBUFS; 2241 if (cap->ftm.request_civicloc && 2242 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC)) 2243 return -ENOBUFS; 2244 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES, 2245 cap->ftm.preambles)) 2246 return -ENOBUFS; 2247 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS, 2248 cap->ftm.bandwidths)) 2249 return -ENOBUFS; 2250 if (cap->ftm.max_bursts_exponent >= 0 && 2251 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT, 2252 cap->ftm.max_bursts_exponent)) 2253 return -ENOBUFS; 2254 if (cap->ftm.max_ftms_per_burst && 2255 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST, 2256 cap->ftm.max_ftms_per_burst)) 2257 return -ENOBUFS; 2258 if (cap->ftm.trigger_based && 2259 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED)) 2260 return -ENOBUFS; 2261 if (cap->ftm.non_trigger_based && 2262 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED)) 2263 return -ENOBUFS; 2264 2265 nla_nest_end(msg, ftm); 2266 return 0; 2267 } 2268 2269 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev, 2270 struct sk_buff *msg) 2271 { 2272 const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa; 2273 struct nlattr *pmsr, *caps; 2274 2275 if (!cap) 2276 return 0; 2277 2278 /* 2279 * we don't need to clean up anything here since the caller 2280 * will genlmsg_cancel() if we fail 2281 */ 2282 2283 pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS); 2284 if (!pmsr) 2285 return -ENOBUFS; 2286 2287 if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers)) 2288 return -ENOBUFS; 2289 2290 if (cap->report_ap_tsf && 2291 nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF)) 2292 return -ENOBUFS; 2293 2294 if (cap->randomize_mac_addr && 2295 nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR)) 2296 return -ENOBUFS; 2297 2298 caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA); 2299 if (!caps) 2300 return -ENOBUFS; 2301 2302 if (nl80211_send_pmsr_ftm_capa(cap, msg)) 2303 return -ENOBUFS; 2304 2305 nla_nest_end(msg, caps); 2306 nla_nest_end(msg, pmsr); 2307 2308 return 0; 2309 } 2310 2311 static int 2312 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev, 2313 struct sk_buff *msg) 2314 { 2315 int i; 2316 struct nlattr *nested, *nested_akms; 2317 const struct wiphy_iftype_akm_suites *iftype_akms; 2318 2319 if (!rdev->wiphy.num_iftype_akm_suites || 2320 !rdev->wiphy.iftype_akm_suites) 2321 return 0; 2322 2323 nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES); 2324 if (!nested) 2325 return -ENOBUFS; 2326 2327 for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) { 2328 nested_akms = nla_nest_start(msg, i + 1); 2329 if (!nested_akms) 2330 return -ENOBUFS; 2331 2332 iftype_akms = &rdev->wiphy.iftype_akm_suites[i]; 2333 2334 if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES, 2335 iftype_akms->iftypes_mask)) 2336 return -ENOBUFS; 2337 2338 if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES, 2339 sizeof(u32) * iftype_akms->n_akm_suites, 2340 iftype_akms->akm_suites)) { 2341 return -ENOBUFS; 2342 } 2343 nla_nest_end(msg, nested_akms); 2344 } 2345 2346 nla_nest_end(msg, nested); 2347 2348 return 0; 2349 } 2350 2351 static int 2352 nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev, 2353 struct sk_buff *msg) 2354 { 2355 struct nlattr *supp; 2356 2357 if (!rdev->wiphy.tid_config_support.vif && 2358 !rdev->wiphy.tid_config_support.peer) 2359 return 0; 2360 2361 supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG); 2362 if (!supp) 2363 return -ENOSPC; 2364 2365 if (rdev->wiphy.tid_config_support.vif && 2366 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP, 2367 rdev->wiphy.tid_config_support.vif, 2368 NL80211_TID_CONFIG_ATTR_PAD)) 2369 goto fail; 2370 2371 if (rdev->wiphy.tid_config_support.peer && 2372 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP, 2373 rdev->wiphy.tid_config_support.peer, 2374 NL80211_TID_CONFIG_ATTR_PAD)) 2375 goto fail; 2376 2377 /* for now we just use the same value ... makes more sense */ 2378 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT, 2379 rdev->wiphy.tid_config_support.max_retry)) 2380 goto fail; 2381 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG, 2382 rdev->wiphy.tid_config_support.max_retry)) 2383 goto fail; 2384 2385 nla_nest_end(msg, supp); 2386 2387 return 0; 2388 fail: 2389 nla_nest_cancel(msg, supp); 2390 return -ENOBUFS; 2391 } 2392 2393 static int 2394 nl80211_put_sar_specs(struct cfg80211_registered_device *rdev, 2395 struct sk_buff *msg) 2396 { 2397 struct nlattr *sar_capa, *specs, *sub_freq_range; 2398 u8 num_freq_ranges; 2399 int i; 2400 2401 if (!rdev->wiphy.sar_capa) 2402 return 0; 2403 2404 num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges; 2405 2406 sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC); 2407 if (!sar_capa) 2408 return -ENOSPC; 2409 2410 if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type)) 2411 goto fail; 2412 2413 specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS); 2414 if (!specs) 2415 goto fail; 2416 2417 /* report supported freq_ranges */ 2418 for (i = 0; i < num_freq_ranges; i++) { 2419 sub_freq_range = nla_nest_start(msg, i + 1); 2420 if (!sub_freq_range) 2421 goto fail; 2422 2423 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ, 2424 rdev->wiphy.sar_capa->freq_ranges[i].start_freq)) 2425 goto fail; 2426 2427 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ, 2428 rdev->wiphy.sar_capa->freq_ranges[i].end_freq)) 2429 goto fail; 2430 2431 nla_nest_end(msg, sub_freq_range); 2432 } 2433 2434 nla_nest_end(msg, specs); 2435 nla_nest_end(msg, sar_capa); 2436 2437 return 0; 2438 fail: 2439 nla_nest_cancel(msg, sar_capa); 2440 return -ENOBUFS; 2441 } 2442 2443 static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg) 2444 { 2445 struct nlattr *config; 2446 2447 if (!wiphy->mbssid_max_interfaces) 2448 return 0; 2449 2450 config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG); 2451 if (!config) 2452 return -ENOBUFS; 2453 2454 if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES, 2455 wiphy->mbssid_max_interfaces)) 2456 goto fail; 2457 2458 if (wiphy->ema_max_profile_periodicity && 2459 nla_put_u8(msg, 2460 NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY, 2461 wiphy->ema_max_profile_periodicity)) 2462 goto fail; 2463 2464 nla_nest_end(msg, config); 2465 return 0; 2466 2467 fail: 2468 nla_nest_cancel(msg, config); 2469 return -ENOBUFS; 2470 } 2471 2472 static int nl80211_put_radio(struct wiphy *wiphy, struct sk_buff *msg, int idx) 2473 { 2474 const struct wiphy_radio *r = &wiphy->radio[idx]; 2475 const struct wiphy_radio_cfg *rcfg = &wiphy->radio_cfg[idx]; 2476 struct nlattr *radio, *freq; 2477 int i; 2478 2479 radio = nla_nest_start(msg, idx); 2480 if (!radio) 2481 return -ENOBUFS; 2482 2483 if (nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_INDEX, idx)) 2484 goto nla_put_failure; 2485 2486 if (rcfg->rts_threshold && 2487 nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_RTS_THRESHOLD, 2488 rcfg->rts_threshold)) 2489 goto nla_put_failure; 2490 2491 if (r->antenna_mask && 2492 nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_ANTENNA_MASK, 2493 r->antenna_mask)) 2494 goto nla_put_failure; 2495 2496 for (i = 0; i < r->n_freq_range; i++) { 2497 const struct wiphy_radio_freq_range *range = &r->freq_range[i]; 2498 2499 freq = nla_nest_start(msg, NL80211_WIPHY_RADIO_ATTR_FREQ_RANGE); 2500 if (!freq) 2501 goto nla_put_failure; 2502 2503 if (nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_START, 2504 range->start_freq) || 2505 nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_END, 2506 range->end_freq)) 2507 goto nla_put_failure; 2508 2509 nla_nest_end(msg, freq); 2510 } 2511 2512 for (i = 0; i < r->n_iface_combinations; i++) 2513 if (nl80211_put_ifcomb_data(msg, true, 2514 NL80211_WIPHY_RADIO_ATTR_INTERFACE_COMBINATION, 2515 &r->iface_combinations[i], 2516 NLA_F_NESTED)) 2517 goto nla_put_failure; 2518 2519 nla_nest_end(msg, radio); 2520 2521 return 0; 2522 2523 nla_put_failure: 2524 return -ENOBUFS; 2525 } 2526 2527 static int nl80211_put_radios(struct wiphy *wiphy, struct sk_buff *msg) 2528 { 2529 struct nlattr *radios; 2530 int i; 2531 2532 if (!wiphy->n_radio) 2533 return 0; 2534 2535 radios = nla_nest_start(msg, NL80211_ATTR_WIPHY_RADIOS); 2536 if (!radios) 2537 return -ENOBUFS; 2538 2539 for (i = 0; i < wiphy->n_radio; i++) 2540 if (nl80211_put_radio(wiphy, msg, i)) 2541 goto fail; 2542 2543 nla_nest_end(msg, radios); 2544 2545 if (nl80211_put_iface_combinations(wiphy, msg, 2546 NL80211_ATTR_WIPHY_INTERFACE_COMBINATIONS, 2547 -1, true, NLA_F_NESTED)) 2548 return -ENOBUFS; 2549 2550 return 0; 2551 2552 fail: 2553 nla_nest_cancel(msg, radios); 2554 return -ENOBUFS; 2555 } 2556 2557 struct nl80211_dump_wiphy_state { 2558 s64 filter_wiphy; 2559 long start; 2560 long split_start, band_start, chan_start, capa_start; 2561 bool split; 2562 }; 2563 2564 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev, 2565 enum nl80211_commands cmd, 2566 struct sk_buff *msg, u32 portid, u32 seq, 2567 int flags, struct nl80211_dump_wiphy_state *state) 2568 { 2569 void *hdr; 2570 struct nlattr *nl_bands, *nl_band; 2571 struct nlattr *nl_freqs, *nl_freq; 2572 struct nlattr *nl_cmds; 2573 enum nl80211_band band; 2574 struct ieee80211_channel *chan; 2575 int i; 2576 const struct ieee80211_txrx_stypes *mgmt_stypes = 2577 rdev->wiphy.mgmt_stypes; 2578 u32 features; 2579 2580 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 2581 if (!hdr) 2582 return -ENOBUFS; 2583 2584 if (WARN_ON(!state)) 2585 return -EINVAL; 2586 2587 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 2588 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, 2589 wiphy_name(&rdev->wiphy)) || 2590 nla_put_u32(msg, NL80211_ATTR_GENERATION, 2591 cfg80211_rdev_list_generation)) 2592 goto nla_put_failure; 2593 2594 if (cmd != NL80211_CMD_NEW_WIPHY) 2595 goto finish; 2596 2597 switch (state->split_start) { 2598 case 0: 2599 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT, 2600 rdev->wiphy.retry_short) || 2601 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG, 2602 rdev->wiphy.retry_long) || 2603 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD, 2604 rdev->wiphy.frag_threshold) || 2605 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD, 2606 rdev->wiphy.rts_threshold) || 2607 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS, 2608 rdev->wiphy.coverage_class) || 2609 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS, 2610 rdev->wiphy.max_scan_ssids) || 2611 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS, 2612 rdev->wiphy.max_sched_scan_ssids) || 2613 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN, 2614 rdev->wiphy.max_scan_ie_len) || 2615 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN, 2616 rdev->wiphy.max_sched_scan_ie_len) || 2617 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS, 2618 rdev->wiphy.max_match_sets)) 2619 goto nla_put_failure; 2620 2621 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) && 2622 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN)) 2623 goto nla_put_failure; 2624 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) && 2625 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH)) 2626 goto nla_put_failure; 2627 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) && 2628 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD)) 2629 goto nla_put_failure; 2630 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) && 2631 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT)) 2632 goto nla_put_failure; 2633 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) && 2634 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT)) 2635 goto nla_put_failure; 2636 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) && 2637 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP)) 2638 goto nla_put_failure; 2639 state->split_start++; 2640 if (state->split) 2641 break; 2642 fallthrough; 2643 case 1: 2644 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES, 2645 sizeof(u32) * rdev->wiphy.n_cipher_suites, 2646 rdev->wiphy.cipher_suites)) 2647 goto nla_put_failure; 2648 2649 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS, 2650 rdev->wiphy.max_num_pmkids)) 2651 goto nla_put_failure; 2652 2653 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 2654 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE)) 2655 goto nla_put_failure; 2656 2657 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX, 2658 rdev->wiphy.available_antennas_tx) || 2659 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX, 2660 rdev->wiphy.available_antennas_rx)) 2661 goto nla_put_failure; 2662 2663 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) && 2664 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD, 2665 rdev->wiphy.probe_resp_offload)) 2666 goto nla_put_failure; 2667 2668 if ((rdev->wiphy.available_antennas_tx || 2669 rdev->wiphy.available_antennas_rx) && 2670 rdev->ops->get_antenna) { 2671 u32 tx_ant = 0, rx_ant = 0; 2672 int res; 2673 2674 res = rdev_get_antenna(rdev, -1, &tx_ant, &rx_ant); 2675 if (!res) { 2676 if (nla_put_u32(msg, 2677 NL80211_ATTR_WIPHY_ANTENNA_TX, 2678 tx_ant) || 2679 nla_put_u32(msg, 2680 NL80211_ATTR_WIPHY_ANTENNA_RX, 2681 rx_ant)) 2682 goto nla_put_failure; 2683 } 2684 } 2685 2686 state->split_start++; 2687 if (state->split) 2688 break; 2689 fallthrough; 2690 case 2: 2691 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES, 2692 rdev->wiphy.interface_modes)) 2693 goto nla_put_failure; 2694 state->split_start++; 2695 if (state->split) 2696 break; 2697 fallthrough; 2698 case 3: 2699 nl_bands = nla_nest_start_noflag(msg, 2700 NL80211_ATTR_WIPHY_BANDS); 2701 if (!nl_bands) 2702 goto nla_put_failure; 2703 2704 for (band = state->band_start; 2705 band < (state->split ? 2706 NUM_NL80211_BANDS : 2707 NL80211_BAND_60GHZ + 1); 2708 band++) { 2709 struct ieee80211_supported_band *sband; 2710 2711 /* omit higher bands for ancient software */ 2712 if (band > NL80211_BAND_5GHZ && !state->split) 2713 break; 2714 2715 sband = rdev->wiphy.bands[band]; 2716 2717 if (!sband) 2718 continue; 2719 2720 nl_band = nla_nest_start_noflag(msg, band); 2721 if (!nl_band) 2722 goto nla_put_failure; 2723 2724 switch (state->chan_start) { 2725 case 0: 2726 if (nl80211_send_band_rateinfo(msg, sband, 2727 state->split)) 2728 goto nla_put_failure; 2729 state->chan_start++; 2730 if (state->split) 2731 break; 2732 fallthrough; 2733 default: 2734 /* add frequencies */ 2735 nl_freqs = nla_nest_start_noflag(msg, 2736 NL80211_BAND_ATTR_FREQS); 2737 if (!nl_freqs) 2738 goto nla_put_failure; 2739 2740 for (i = state->chan_start - 1; 2741 i < sband->n_channels; 2742 i++) { 2743 nl_freq = nla_nest_start_noflag(msg, 2744 i); 2745 if (!nl_freq) 2746 goto nla_put_failure; 2747 2748 chan = &sband->channels[i]; 2749 2750 if (nl80211_msg_put_channel( 2751 msg, &rdev->wiphy, chan, 2752 state->split)) 2753 goto nla_put_failure; 2754 2755 nla_nest_end(msg, nl_freq); 2756 if (state->split) 2757 break; 2758 } 2759 if (i < sband->n_channels) 2760 state->chan_start = i + 2; 2761 else 2762 state->chan_start = 0; 2763 nla_nest_end(msg, nl_freqs); 2764 } 2765 2766 nla_nest_end(msg, nl_band); 2767 2768 if (state->split) { 2769 /* start again here */ 2770 if (state->chan_start) 2771 band--; 2772 break; 2773 } 2774 } 2775 nla_nest_end(msg, nl_bands); 2776 2777 if (band < NUM_NL80211_BANDS) 2778 state->band_start = band + 1; 2779 else 2780 state->band_start = 0; 2781 2782 /* if bands & channels are done, continue outside */ 2783 if (state->band_start == 0 && state->chan_start == 0) 2784 state->split_start++; 2785 if (state->split) 2786 break; 2787 fallthrough; 2788 case 4: 2789 nl_cmds = nla_nest_start_noflag(msg, 2790 NL80211_ATTR_SUPPORTED_COMMANDS); 2791 if (!nl_cmds) 2792 goto nla_put_failure; 2793 2794 i = nl80211_add_commands_unsplit(rdev, msg); 2795 if (i < 0) 2796 goto nla_put_failure; 2797 if (state->split) { 2798 CMD(crit_proto_start, CRIT_PROTOCOL_START); 2799 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP); 2800 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH) 2801 CMD(channel_switch, CHANNEL_SWITCH); 2802 CMD(set_qos_map, SET_QOS_MAP); 2803 if (rdev->wiphy.features & 2804 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION) 2805 CMD(add_tx_ts, ADD_TX_TS); 2806 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST); 2807 CMD(update_connect_params, UPDATE_CONNECT_PARAMS); 2808 CMD(update_ft_ies, UPDATE_FT_IES); 2809 if (rdev->wiphy.sar_capa) 2810 CMD(set_sar_specs, SET_SAR_SPECS); 2811 CMD(assoc_ml_reconf, ASSOC_MLO_RECONF); 2812 } 2813 #undef CMD 2814 2815 nla_nest_end(msg, nl_cmds); 2816 state->split_start++; 2817 if (state->split) 2818 break; 2819 fallthrough; 2820 case 5: 2821 if (rdev->ops->remain_on_channel && 2822 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) && 2823 nla_put_u32(msg, 2824 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION, 2825 rdev->wiphy.max_remain_on_channel_duration)) 2826 goto nla_put_failure; 2827 2828 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) && 2829 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK)) 2830 goto nla_put_failure; 2831 2832 state->split_start++; 2833 if (state->split) 2834 break; 2835 fallthrough; 2836 case 6: 2837 #ifdef CONFIG_PM 2838 if (nl80211_send_wowlan(msg, rdev, state->split)) 2839 goto nla_put_failure; 2840 state->split_start++; 2841 if (state->split) 2842 break; 2843 #else 2844 state->split_start++; 2845 #endif 2846 fallthrough; 2847 case 7: 2848 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES, 2849 rdev->wiphy.software_iftypes)) 2850 goto nla_put_failure; 2851 2852 if (nl80211_put_iface_combinations(&rdev->wiphy, msg, 2853 NL80211_ATTR_INTERFACE_COMBINATIONS, 2854 rdev->wiphy.n_radio ? 0 : -1, 2855 state->split, 0)) 2856 goto nla_put_failure; 2857 2858 state->split_start++; 2859 if (state->split) 2860 break; 2861 fallthrough; 2862 case 8: 2863 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) && 2864 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME, 2865 rdev->wiphy.ap_sme_capa)) 2866 goto nla_put_failure; 2867 2868 features = rdev->wiphy.features; 2869 /* 2870 * We can only add the per-channel limit information if the 2871 * dump is split, otherwise it makes it too big. Therefore 2872 * only advertise it in that case. 2873 */ 2874 if (state->split) 2875 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS; 2876 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features)) 2877 goto nla_put_failure; 2878 2879 if (rdev->wiphy.ht_capa_mod_mask && 2880 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK, 2881 sizeof(*rdev->wiphy.ht_capa_mod_mask), 2882 rdev->wiphy.ht_capa_mod_mask)) 2883 goto nla_put_failure; 2884 2885 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME && 2886 rdev->wiphy.max_acl_mac_addrs && 2887 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX, 2888 rdev->wiphy.max_acl_mac_addrs)) 2889 goto nla_put_failure; 2890 2891 /* 2892 * Any information below this point is only available to 2893 * applications that can deal with it being split. This 2894 * helps ensure that newly added capabilities don't break 2895 * older tools by overrunning their buffers. 2896 * 2897 * We still increment split_start so that in the split 2898 * case we'll continue with more data in the next round, 2899 * but break unconditionally so unsplit data stops here. 2900 */ 2901 if (state->split) 2902 state->split_start++; 2903 else 2904 state->split_start = 0; 2905 break; 2906 case 9: 2907 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes)) 2908 goto nla_put_failure; 2909 2910 if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS, 2911 rdev->wiphy.max_sched_scan_plans) || 2912 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL, 2913 rdev->wiphy.max_sched_scan_plan_interval) || 2914 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS, 2915 rdev->wiphy.max_sched_scan_plan_iterations)) 2916 goto nla_put_failure; 2917 2918 if (rdev->wiphy.extended_capabilities && 2919 (nla_put(msg, NL80211_ATTR_EXT_CAPA, 2920 rdev->wiphy.extended_capabilities_len, 2921 rdev->wiphy.extended_capabilities) || 2922 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2923 rdev->wiphy.extended_capabilities_len, 2924 rdev->wiphy.extended_capabilities_mask))) 2925 goto nla_put_failure; 2926 2927 if (rdev->wiphy.vht_capa_mod_mask && 2928 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK, 2929 sizeof(*rdev->wiphy.vht_capa_mod_mask), 2930 rdev->wiphy.vht_capa_mod_mask)) 2931 goto nla_put_failure; 2932 2933 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 2934 rdev->wiphy.perm_addr)) 2935 goto nla_put_failure; 2936 2937 if (!is_zero_ether_addr(rdev->wiphy.addr_mask) && 2938 nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN, 2939 rdev->wiphy.addr_mask)) 2940 goto nla_put_failure; 2941 2942 if (rdev->wiphy.n_addresses > 1) { 2943 void *attr; 2944 2945 attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS); 2946 if (!attr) 2947 goto nla_put_failure; 2948 2949 for (i = 0; i < rdev->wiphy.n_addresses; i++) 2950 if (nla_put(msg, i + 1, ETH_ALEN, 2951 rdev->wiphy.addresses[i].addr)) 2952 goto nla_put_failure; 2953 2954 nla_nest_end(msg, attr); 2955 } 2956 2957 state->split_start++; 2958 break; 2959 case 10: 2960 if (nl80211_send_coalesce(msg, rdev)) 2961 goto nla_put_failure; 2962 2963 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) && 2964 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) || 2965 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ))) 2966 goto nla_put_failure; 2967 2968 if (rdev->wiphy.max_ap_assoc_sta && 2969 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA, 2970 rdev->wiphy.max_ap_assoc_sta)) 2971 goto nla_put_failure; 2972 2973 state->split_start++; 2974 break; 2975 case 11: 2976 if (rdev->wiphy.n_vendor_commands) { 2977 const struct nl80211_vendor_cmd_info *info; 2978 struct nlattr *nested; 2979 2980 nested = nla_nest_start_noflag(msg, 2981 NL80211_ATTR_VENDOR_DATA); 2982 if (!nested) 2983 goto nla_put_failure; 2984 2985 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 2986 info = &rdev->wiphy.vendor_commands[i].info; 2987 if (nla_put(msg, i + 1, sizeof(*info), info)) 2988 goto nla_put_failure; 2989 } 2990 nla_nest_end(msg, nested); 2991 } 2992 2993 if (rdev->wiphy.n_vendor_events) { 2994 const struct nl80211_vendor_cmd_info *info; 2995 struct nlattr *nested; 2996 2997 nested = nla_nest_start_noflag(msg, 2998 NL80211_ATTR_VENDOR_EVENTS); 2999 if (!nested) 3000 goto nla_put_failure; 3001 3002 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) { 3003 info = &rdev->wiphy.vendor_events[i]; 3004 if (nla_put(msg, i + 1, sizeof(*info), info)) 3005 goto nla_put_failure; 3006 } 3007 nla_nest_end(msg, nested); 3008 } 3009 state->split_start++; 3010 break; 3011 case 12: 3012 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH && 3013 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS, 3014 rdev->wiphy.max_num_csa_counters)) 3015 goto nla_put_failure; 3016 3017 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 3018 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 3019 goto nla_put_failure; 3020 3021 if (rdev->wiphy.max_sched_scan_reqs && 3022 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS, 3023 rdev->wiphy.max_sched_scan_reqs)) 3024 goto nla_put_failure; 3025 3026 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES, 3027 sizeof(rdev->wiphy.ext_features), 3028 rdev->wiphy.ext_features)) 3029 goto nla_put_failure; 3030 3031 if (rdev->wiphy.bss_param_support) { 3032 struct nlattr *nested; 3033 u32 parsup = rdev->wiphy.bss_param_support; 3034 3035 nested = nla_nest_start(msg, NL80211_ATTR_BSS_PARAM); 3036 if (!nested) 3037 goto nla_put_failure; 3038 3039 if ((parsup & WIPHY_BSS_PARAM_CTS_PROT) && 3040 nla_put_flag(msg, NL80211_ATTR_BSS_CTS_PROT)) 3041 goto nla_put_failure; 3042 if ((parsup & WIPHY_BSS_PARAM_SHORT_PREAMBLE) && 3043 nla_put_flag(msg, NL80211_ATTR_BSS_SHORT_PREAMBLE)) 3044 goto nla_put_failure; 3045 if ((parsup & WIPHY_BSS_PARAM_SHORT_SLOT_TIME) && 3046 nla_put_flag(msg, NL80211_ATTR_BSS_SHORT_SLOT_TIME)) 3047 goto nla_put_failure; 3048 if ((parsup & WIPHY_BSS_PARAM_BASIC_RATES) && 3049 nla_put_flag(msg, NL80211_ATTR_BSS_BASIC_RATES)) 3050 goto nla_put_failure; 3051 if ((parsup & WIPHY_BSS_PARAM_AP_ISOLATE) && 3052 nla_put_flag(msg, NL80211_ATTR_AP_ISOLATE)) 3053 goto nla_put_failure; 3054 if ((parsup & WIPHY_BSS_PARAM_HT_OPMODE) && 3055 nla_put_flag(msg, NL80211_ATTR_BSS_HT_OPMODE)) 3056 goto nla_put_failure; 3057 if ((parsup & WIPHY_BSS_PARAM_P2P_CTWINDOW) && 3058 nla_put_flag(msg, NL80211_ATTR_P2P_CTWINDOW)) 3059 goto nla_put_failure; 3060 if ((parsup & WIPHY_BSS_PARAM_P2P_OPPPS) && 3061 nla_put_flag(msg, NL80211_ATTR_P2P_OPPPS)) 3062 goto nla_put_failure; 3063 nla_nest_end(msg, nested); 3064 } 3065 if (rdev->wiphy.bss_select_support) { 3066 struct nlattr *nested; 3067 u32 bss_select_support = rdev->wiphy.bss_select_support; 3068 3069 nested = nla_nest_start_noflag(msg, 3070 NL80211_ATTR_BSS_SELECT); 3071 if (!nested) 3072 goto nla_put_failure; 3073 3074 i = 0; 3075 while (bss_select_support) { 3076 if ((bss_select_support & 1) && 3077 nla_put_flag(msg, i)) 3078 goto nla_put_failure; 3079 i++; 3080 bss_select_support >>= 1; 3081 } 3082 nla_nest_end(msg, nested); 3083 } 3084 3085 state->split_start++; 3086 break; 3087 case 13: 3088 if (rdev->wiphy.num_iftype_ext_capab && 3089 rdev->wiphy.iftype_ext_capab) { 3090 struct nlattr *nested_ext_capab, *nested; 3091 3092 nested = nla_nest_start_noflag(msg, 3093 NL80211_ATTR_IFTYPE_EXT_CAPA); 3094 if (!nested) 3095 goto nla_put_failure; 3096 3097 for (i = state->capa_start; 3098 i < rdev->wiphy.num_iftype_ext_capab; i++) { 3099 const struct wiphy_iftype_ext_capab *capab; 3100 3101 capab = &rdev->wiphy.iftype_ext_capab[i]; 3102 3103 nested_ext_capab = nla_nest_start_noflag(msg, 3104 i); 3105 if (!nested_ext_capab || 3106 nla_put_u32(msg, NL80211_ATTR_IFTYPE, 3107 capab->iftype) || 3108 nla_put(msg, NL80211_ATTR_EXT_CAPA, 3109 capab->extended_capabilities_len, 3110 capab->extended_capabilities) || 3111 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 3112 capab->extended_capabilities_len, 3113 capab->extended_capabilities_mask)) 3114 goto nla_put_failure; 3115 3116 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO && 3117 (nla_put_u16(msg, 3118 NL80211_ATTR_EML_CAPABILITY, 3119 capab->eml_capabilities) || 3120 nla_put_u16(msg, 3121 NL80211_ATTR_MLD_CAPA_AND_OPS, 3122 capab->mld_capa_and_ops))) 3123 goto nla_put_failure; 3124 3125 nla_nest_end(msg, nested_ext_capab); 3126 if (state->split) 3127 break; 3128 } 3129 nla_nest_end(msg, nested); 3130 if (i < rdev->wiphy.num_iftype_ext_capab) { 3131 state->capa_start = i + 1; 3132 break; 3133 } 3134 } 3135 3136 if (nla_put_u32(msg, NL80211_ATTR_BANDS, 3137 rdev->wiphy.nan_supported_bands)) 3138 goto nla_put_failure; 3139 3140 if (wiphy_ext_feature_isset(&rdev->wiphy, 3141 NL80211_EXT_FEATURE_TXQS)) { 3142 struct cfg80211_txq_stats txqstats = {}; 3143 int res; 3144 3145 res = rdev_get_txq_stats(rdev, NULL, &txqstats); 3146 if (!res && 3147 !nl80211_put_txq_stats(msg, &txqstats, 3148 NL80211_ATTR_TXQ_STATS)) 3149 goto nla_put_failure; 3150 3151 if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT, 3152 rdev->wiphy.txq_limit)) 3153 goto nla_put_failure; 3154 if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT, 3155 rdev->wiphy.txq_memory_limit)) 3156 goto nla_put_failure; 3157 if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM, 3158 rdev->wiphy.txq_quantum)) 3159 goto nla_put_failure; 3160 } 3161 3162 state->split_start++; 3163 break; 3164 case 14: 3165 if (nl80211_send_pmsr_capa(rdev, msg)) 3166 goto nla_put_failure; 3167 3168 state->split_start++; 3169 break; 3170 case 15: 3171 if (rdev->wiphy.akm_suites && 3172 nla_put(msg, NL80211_ATTR_AKM_SUITES, 3173 sizeof(u32) * rdev->wiphy.n_akm_suites, 3174 rdev->wiphy.akm_suites)) 3175 goto nla_put_failure; 3176 3177 if (nl80211_put_iftype_akm_suites(rdev, msg)) 3178 goto nla_put_failure; 3179 3180 if (nl80211_put_tid_config_support(rdev, msg)) 3181 goto nla_put_failure; 3182 state->split_start++; 3183 break; 3184 case 16: 3185 if (nl80211_put_sar_specs(rdev, msg)) 3186 goto nla_put_failure; 3187 3188 if (nl80211_put_mbssid_support(&rdev->wiphy, msg)) 3189 goto nla_put_failure; 3190 3191 if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES, 3192 rdev->wiphy.max_num_akm_suites)) 3193 goto nla_put_failure; 3194 3195 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO) 3196 nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT); 3197 3198 if (rdev->wiphy.hw_timestamp_max_peers && 3199 nla_put_u16(msg, NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS, 3200 rdev->wiphy.hw_timestamp_max_peers)) 3201 goto nla_put_failure; 3202 3203 state->split_start++; 3204 break; 3205 case 17: 3206 if (nl80211_put_radios(&rdev->wiphy, msg)) 3207 goto nla_put_failure; 3208 3209 /* done */ 3210 state->split_start = 0; 3211 break; 3212 } 3213 finish: 3214 genlmsg_end(msg, hdr); 3215 return 0; 3216 3217 nla_put_failure: 3218 genlmsg_cancel(msg, hdr); 3219 return -EMSGSIZE; 3220 } 3221 3222 static int nl80211_dump_wiphy_parse(struct sk_buff *skb, 3223 struct netlink_callback *cb, 3224 struct nl80211_dump_wiphy_state *state) 3225 { 3226 struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 3227 int ret; 3228 3229 if (!tb) 3230 return -ENOMEM; 3231 3232 ret = nlmsg_parse_deprecated(cb->nlh, 3233 GENL_HDRLEN + nl80211_fam.hdrsize, 3234 tb, nl80211_fam.maxattr, 3235 nl80211_policy, NULL); 3236 /* ignore parse errors for backward compatibility */ 3237 if (ret) { 3238 ret = 0; 3239 goto out; 3240 } 3241 3242 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP]; 3243 if (tb[NL80211_ATTR_WIPHY]) 3244 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]); 3245 if (tb[NL80211_ATTR_WDEV]) 3246 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32; 3247 if (tb[NL80211_ATTR_IFINDEX]) { 3248 struct net_device *netdev; 3249 struct cfg80211_registered_device *rdev; 3250 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]); 3251 3252 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx); 3253 if (!netdev) { 3254 ret = -ENODEV; 3255 goto out; 3256 } 3257 if (netdev->ieee80211_ptr) { 3258 rdev = wiphy_to_rdev( 3259 netdev->ieee80211_ptr->wiphy); 3260 state->filter_wiphy = rdev->wiphy_idx; 3261 } 3262 } 3263 3264 ret = 0; 3265 out: 3266 kfree(tb); 3267 return ret; 3268 } 3269 3270 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb) 3271 { 3272 int idx = 0, ret; 3273 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0]; 3274 struct cfg80211_registered_device *rdev; 3275 3276 rtnl_lock(); 3277 if (!state) { 3278 state = kzalloc(sizeof(*state), GFP_KERNEL); 3279 if (!state) { 3280 rtnl_unlock(); 3281 return -ENOMEM; 3282 } 3283 state->filter_wiphy = -1; 3284 ret = nl80211_dump_wiphy_parse(skb, cb, state); 3285 if (ret) { 3286 kfree(state); 3287 rtnl_unlock(); 3288 return ret; 3289 } 3290 cb->args[0] = (long)state; 3291 } 3292 3293 for_each_rdev(rdev) { 3294 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 3295 continue; 3296 if (++idx <= state->start) 3297 continue; 3298 if (state->filter_wiphy != -1 && 3299 state->filter_wiphy != rdev->wiphy_idx) 3300 continue; 3301 wiphy_lock(&rdev->wiphy); 3302 /* attempt to fit multiple wiphy data chunks into the skb */ 3303 do { 3304 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, 3305 skb, 3306 NETLINK_CB(cb->skb).portid, 3307 cb->nlh->nlmsg_seq, 3308 NLM_F_MULTI, state); 3309 if (ret < 0) { 3310 /* 3311 * If sending the wiphy data didn't fit (ENOBUFS 3312 * or EMSGSIZE returned), this SKB is still 3313 * empty (so it's not too big because another 3314 * wiphy dataset is already in the skb) and 3315 * we've not tried to adjust the dump allocation 3316 * yet ... then adjust the alloc size to be 3317 * bigger, and return 1 but with the empty skb. 3318 * This results in an empty message being RX'ed 3319 * in userspace, but that is ignored. 3320 * 3321 * We can then retry with the larger buffer. 3322 */ 3323 if ((ret == -ENOBUFS || ret == -EMSGSIZE) && 3324 !skb->len && !state->split && 3325 cb->min_dump_alloc < 4096) { 3326 cb->min_dump_alloc = 4096; 3327 state->split_start = 0; 3328 wiphy_unlock(&rdev->wiphy); 3329 rtnl_unlock(); 3330 return 1; 3331 } 3332 idx--; 3333 break; 3334 } 3335 } while (state->split_start > 0); 3336 wiphy_unlock(&rdev->wiphy); 3337 break; 3338 } 3339 rtnl_unlock(); 3340 3341 state->start = idx; 3342 3343 return skb->len; 3344 } 3345 3346 static int nl80211_dump_wiphy_done(struct netlink_callback *cb) 3347 { 3348 kfree((void *)cb->args[0]); 3349 return 0; 3350 } 3351 3352 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info) 3353 { 3354 struct sk_buff *msg; 3355 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3356 struct nl80211_dump_wiphy_state state = {}; 3357 3358 msg = nlmsg_new(4096, GFP_KERNEL); 3359 if (!msg) 3360 return -ENOMEM; 3361 3362 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg, 3363 info->snd_portid, info->snd_seq, 0, 3364 &state) < 0) { 3365 nlmsg_free(msg); 3366 return -ENOBUFS; 3367 } 3368 3369 return genlmsg_reply(msg, info); 3370 } 3371 3372 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = { 3373 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 }, 3374 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 }, 3375 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 }, 3376 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 }, 3377 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 }, 3378 }; 3379 3380 static int parse_txq_params(struct nlattr *tb[], 3381 struct ieee80211_txq_params *txq_params) 3382 { 3383 u8 ac; 3384 3385 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] || 3386 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] || 3387 !tb[NL80211_TXQ_ATTR_AIFS]) 3388 return -EINVAL; 3389 3390 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]); 3391 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]); 3392 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]); 3393 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]); 3394 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]); 3395 3396 if (ac >= NL80211_NUM_ACS) 3397 return -EINVAL; 3398 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS); 3399 return 0; 3400 } 3401 3402 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev) 3403 { 3404 /* 3405 * You can only set the channel explicitly for some interfaces, 3406 * most have their channel managed via their respective 3407 * "establish a connection" command (connect, join, ...) 3408 * 3409 * For AP/GO and mesh mode, the channel can be set with the 3410 * channel userspace API, but is only stored and passed to the 3411 * low-level driver when the AP starts or the mesh is joined. 3412 * This is for backward compatibility, userspace can also give 3413 * the channel in the start-ap or join-mesh commands instead. 3414 * 3415 * Monitors are special as they are normally slaved to 3416 * whatever else is going on, so they have their own special 3417 * operation to set the monitor channel if possible. 3418 */ 3419 return !wdev || 3420 wdev->iftype == NL80211_IFTYPE_AP || 3421 wdev->iftype == NL80211_IFTYPE_MESH_POINT || 3422 wdev->iftype == NL80211_IFTYPE_MONITOR || 3423 wdev->iftype == NL80211_IFTYPE_P2P_GO; 3424 } 3425 3426 static int _nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3427 struct genl_info *info, bool monitor, 3428 struct cfg80211_chan_def *chandef) 3429 { 3430 struct netlink_ext_ack *extack = info->extack; 3431 struct nlattr **attrs = info->attrs; 3432 u32 control_freq; 3433 3434 if (!attrs[NL80211_ATTR_WIPHY_FREQ]) { 3435 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3436 "Frequency is missing"); 3437 return -EINVAL; 3438 } 3439 3440 control_freq = MHZ_TO_KHZ( 3441 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 3442 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 3443 control_freq += 3444 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 3445 3446 memset(chandef, 0, sizeof(*chandef)); 3447 chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq); 3448 chandef->width = NL80211_CHAN_WIDTH_20_NOHT; 3449 chandef->center_freq1 = KHZ_TO_MHZ(control_freq); 3450 chandef->freq1_offset = control_freq % 1000; 3451 chandef->center_freq2 = 0; 3452 3453 if (!chandef->chan) { 3454 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3455 "Unknown channel"); 3456 return -EINVAL; 3457 } 3458 3459 if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) { 3460 enum nl80211_channel_type chantype; 3461 3462 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]); 3463 3464 switch (chantype) { 3465 case NL80211_CHAN_NO_HT: 3466 case NL80211_CHAN_HT20: 3467 case NL80211_CHAN_HT40PLUS: 3468 case NL80211_CHAN_HT40MINUS: 3469 cfg80211_chandef_create(chandef, chandef->chan, 3470 chantype); 3471 /* user input for center_freq is incorrect */ 3472 if (attrs[NL80211_ATTR_CENTER_FREQ1] && 3473 chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) { 3474 NL_SET_ERR_MSG_ATTR(extack, 3475 attrs[NL80211_ATTR_CENTER_FREQ1], 3476 "bad center frequency 1"); 3477 return -EINVAL; 3478 } 3479 /* center_freq2 must be zero */ 3480 if (attrs[NL80211_ATTR_CENTER_FREQ2] && 3481 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) { 3482 NL_SET_ERR_MSG_ATTR(extack, 3483 attrs[NL80211_ATTR_CENTER_FREQ2], 3484 "center frequency 2 can't be used"); 3485 return -EINVAL; 3486 } 3487 break; 3488 default: 3489 NL_SET_ERR_MSG_ATTR(extack, 3490 attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE], 3491 "invalid channel type"); 3492 return -EINVAL; 3493 } 3494 } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) { 3495 chandef->width = 3496 nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]); 3497 if (chandef->chan->band == NL80211_BAND_S1GHZ) { 3498 /* User input error for channel width doesn't match channel */ 3499 if (chandef->width != ieee80211_s1g_channel_width(chandef->chan)) { 3500 NL_SET_ERR_MSG_ATTR(extack, 3501 attrs[NL80211_ATTR_CHANNEL_WIDTH], 3502 "bad channel width"); 3503 return -EINVAL; 3504 } 3505 } 3506 if (attrs[NL80211_ATTR_CENTER_FREQ1]) { 3507 chandef->center_freq1 = 3508 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]); 3509 chandef->freq1_offset = 3510 nla_get_u32_default(attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET], 3511 0); 3512 } 3513 if (attrs[NL80211_ATTR_CENTER_FREQ2]) 3514 chandef->center_freq2 = 3515 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]); 3516 } 3517 3518 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 3519 chandef->edmg.channels = 3520 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 3521 3522 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 3523 chandef->edmg.bw_config = 3524 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 3525 } else { 3526 chandef->edmg.bw_config = 0; 3527 chandef->edmg.channels = 0; 3528 } 3529 3530 if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) { 3531 chandef->punctured = 3532 nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]); 3533 3534 if (chandef->punctured && 3535 !wiphy_ext_feature_isset(&rdev->wiphy, 3536 NL80211_EXT_FEATURE_PUNCT)) { 3537 NL_SET_ERR_MSG(extack, 3538 "driver doesn't support puncturing"); 3539 return -EINVAL; 3540 } 3541 } 3542 3543 if (!cfg80211_chandef_valid(chandef)) { 3544 NL_SET_ERR_MSG(extack, "invalid channel definition"); 3545 return -EINVAL; 3546 } 3547 3548 if (!_cfg80211_chandef_usable(&rdev->wiphy, chandef, 3549 IEEE80211_CHAN_DISABLED, 3550 monitor ? IEEE80211_CHAN_CAN_MONITOR : 0)) { 3551 NL_SET_ERR_MSG(extack, "(extension) channel is disabled"); 3552 return -EINVAL; 3553 } 3554 3555 if ((chandef->width == NL80211_CHAN_WIDTH_5 || 3556 chandef->width == NL80211_CHAN_WIDTH_10) && 3557 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) { 3558 NL_SET_ERR_MSG(extack, "5/10 MHz not supported"); 3559 return -EINVAL; 3560 } 3561 3562 return 0; 3563 } 3564 3565 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3566 struct genl_info *info, 3567 struct cfg80211_chan_def *chandef) 3568 { 3569 return _nl80211_parse_chandef(rdev, info, false, chandef); 3570 } 3571 3572 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev, 3573 struct net_device *dev, 3574 struct genl_info *info, 3575 int _link_id) 3576 { 3577 struct cfg80211_chan_def chandef; 3578 int result; 3579 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR; 3580 struct wireless_dev *wdev = NULL; 3581 int link_id = _link_id; 3582 3583 if (dev) 3584 wdev = dev->ieee80211_ptr; 3585 if (!nl80211_can_set_dev_channel(wdev)) 3586 return -EOPNOTSUPP; 3587 if (wdev) 3588 iftype = wdev->iftype; 3589 3590 if (link_id < 0) { 3591 if (wdev && wdev->valid_links) 3592 return -EINVAL; 3593 link_id = 0; 3594 } 3595 3596 result = _nl80211_parse_chandef(rdev, info, 3597 iftype == NL80211_IFTYPE_MONITOR, 3598 &chandef); 3599 if (result) 3600 return result; 3601 3602 switch (iftype) { 3603 case NL80211_IFTYPE_AP: 3604 case NL80211_IFTYPE_P2P_GO: 3605 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 3606 iftype)) 3607 return -EINVAL; 3608 if (wdev->links[link_id].ap.beacon_interval) { 3609 struct ieee80211_channel *cur_chan; 3610 3611 if (!dev || !rdev->ops->set_ap_chanwidth || 3612 !(rdev->wiphy.features & 3613 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) 3614 return -EBUSY; 3615 3616 /* Only allow dynamic channel width changes */ 3617 cur_chan = wdev->links[link_id].ap.chandef.chan; 3618 if (chandef.chan != cur_chan) 3619 return -EBUSY; 3620 3621 /* only allow this for regular channel widths */ 3622 switch (wdev->links[link_id].ap.chandef.width) { 3623 case NL80211_CHAN_WIDTH_20_NOHT: 3624 case NL80211_CHAN_WIDTH_20: 3625 case NL80211_CHAN_WIDTH_40: 3626 case NL80211_CHAN_WIDTH_80: 3627 case NL80211_CHAN_WIDTH_80P80: 3628 case NL80211_CHAN_WIDTH_160: 3629 case NL80211_CHAN_WIDTH_320: 3630 break; 3631 default: 3632 return -EINVAL; 3633 } 3634 3635 switch (chandef.width) { 3636 case NL80211_CHAN_WIDTH_20_NOHT: 3637 case NL80211_CHAN_WIDTH_20: 3638 case NL80211_CHAN_WIDTH_40: 3639 case NL80211_CHAN_WIDTH_80: 3640 case NL80211_CHAN_WIDTH_80P80: 3641 case NL80211_CHAN_WIDTH_160: 3642 case NL80211_CHAN_WIDTH_320: 3643 break; 3644 default: 3645 return -EINVAL; 3646 } 3647 3648 result = rdev_set_ap_chanwidth(rdev, dev, link_id, 3649 &chandef); 3650 if (result) 3651 return result; 3652 wdev->links[link_id].ap.chandef = chandef; 3653 } else { 3654 wdev->u.ap.preset_chandef = chandef; 3655 } 3656 return 0; 3657 case NL80211_IFTYPE_MESH_POINT: 3658 return cfg80211_set_mesh_channel(rdev, wdev, &chandef); 3659 case NL80211_IFTYPE_MONITOR: 3660 return cfg80211_set_monitor_channel(rdev, dev, &chandef); 3661 default: 3662 break; 3663 } 3664 3665 return -EINVAL; 3666 } 3667 3668 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info) 3669 { 3670 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3671 int link_id = nl80211_link_id_or_invalid(info->attrs); 3672 struct net_device *netdev = info->user_ptr[1]; 3673 3674 return __nl80211_set_channel(rdev, netdev, info, link_id); 3675 } 3676 3677 static int nl80211_set_wiphy_radio(struct genl_info *info, 3678 struct cfg80211_registered_device *rdev, 3679 int radio_idx) 3680 { 3681 u32 rts_threshold = 0, old_rts, changed = 0; 3682 int result; 3683 3684 if (!rdev->ops->set_wiphy_params) 3685 return -EOPNOTSUPP; 3686 3687 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3688 rts_threshold = nla_get_u32( 3689 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3690 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3691 } 3692 3693 old_rts = rdev->wiphy.radio_cfg[radio_idx].rts_threshold; 3694 3695 rdev->wiphy.radio_cfg[radio_idx].rts_threshold = rts_threshold; 3696 3697 result = rdev_set_wiphy_params(rdev, radio_idx, changed); 3698 if (result) 3699 rdev->wiphy.radio_cfg[radio_idx].rts_threshold = old_rts; 3700 3701 return 0; 3702 } 3703 3704 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info) 3705 { 3706 struct cfg80211_registered_device *rdev = NULL; 3707 struct net_device *netdev = NULL; 3708 struct wireless_dev *wdev; 3709 int result = 0, rem_txq_params = 0; 3710 struct nlattr *nl_txq_params; 3711 u32 changed; 3712 u8 retry_short = 0, retry_long = 0; 3713 u32 frag_threshold = 0, rts_threshold = 0; 3714 u8 coverage_class = 0; 3715 u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0; 3716 int radio_idx = -1; 3717 3718 rtnl_lock(); 3719 /* 3720 * Try to find the wiphy and netdev. Normally this 3721 * function shouldn't need the netdev, but this is 3722 * done for backward compatibility -- previously 3723 * setting the channel was done per wiphy, but now 3724 * it is per netdev. Previous userland like hostapd 3725 * also passed a netdev to set_wiphy, so that it is 3726 * possible to let that go to the right netdev! 3727 */ 3728 3729 if (info->attrs[NL80211_ATTR_IFINDEX]) { 3730 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]); 3731 3732 netdev = __dev_get_by_index(genl_info_net(info), ifindex); 3733 if (netdev && netdev->ieee80211_ptr) 3734 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy); 3735 else 3736 netdev = NULL; 3737 } 3738 3739 if (!netdev) { 3740 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info), 3741 info->attrs); 3742 if (IS_ERR(rdev)) { 3743 rtnl_unlock(); 3744 return PTR_ERR(rdev); 3745 } 3746 wdev = NULL; 3747 netdev = NULL; 3748 result = 0; 3749 } else 3750 wdev = netdev->ieee80211_ptr; 3751 3752 guard(wiphy)(&rdev->wiphy); 3753 3754 /* 3755 * end workaround code, by now the rdev is available 3756 * and locked, and wdev may or may not be NULL. 3757 */ 3758 3759 if (info->attrs[NL80211_ATTR_WIPHY_NAME]) 3760 result = cfg80211_dev_rename( 3761 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME])); 3762 rtnl_unlock(); 3763 3764 if (result) 3765 return result; 3766 3767 if (info->attrs[NL80211_ATTR_WIPHY_RADIO_INDEX]) { 3768 /* Radio idx is not expected for non-multi radio wiphy */ 3769 if (rdev->wiphy.n_radio <= 0) 3770 return -EINVAL; 3771 3772 radio_idx = nla_get_u8( 3773 info->attrs[NL80211_ATTR_WIPHY_RADIO_INDEX]); 3774 if (radio_idx >= rdev->wiphy.n_radio) 3775 return -EINVAL; 3776 3777 return nl80211_set_wiphy_radio(info, rdev, radio_idx); 3778 } 3779 3780 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) { 3781 struct ieee80211_txq_params txq_params; 3782 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1]; 3783 3784 if (!rdev->ops->set_txq_params) 3785 return -EOPNOTSUPP; 3786 3787 if (!netdev) 3788 return -EINVAL; 3789 3790 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 3791 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 3792 return -EINVAL; 3793 3794 if (!netif_running(netdev)) 3795 return -ENETDOWN; 3796 3797 nla_for_each_nested(nl_txq_params, 3798 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS], 3799 rem_txq_params) { 3800 result = nla_parse_nested_deprecated(tb, 3801 NL80211_TXQ_ATTR_MAX, 3802 nl_txq_params, 3803 txq_params_policy, 3804 info->extack); 3805 if (result) 3806 return result; 3807 3808 result = parse_txq_params(tb, &txq_params); 3809 if (result) 3810 return result; 3811 3812 txq_params.link_id = 3813 nl80211_link_id_or_invalid(info->attrs); 3814 3815 if (txq_params.link_id >= 0 && 3816 !(netdev->ieee80211_ptr->valid_links & 3817 BIT(txq_params.link_id))) 3818 result = -ENOLINK; 3819 else if (txq_params.link_id >= 0 && 3820 !netdev->ieee80211_ptr->valid_links) 3821 result = -EINVAL; 3822 else 3823 result = rdev_set_txq_params(rdev, netdev, 3824 &txq_params); 3825 if (result) 3826 return result; 3827 } 3828 } 3829 3830 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 3831 int link_id = nl80211_link_id_or_invalid(info->attrs); 3832 3833 if (wdev) { 3834 result = __nl80211_set_channel( 3835 rdev, 3836 nl80211_can_set_dev_channel(wdev) ? netdev : NULL, 3837 info, link_id); 3838 } else { 3839 result = __nl80211_set_channel(rdev, netdev, info, link_id); 3840 } 3841 3842 if (result) 3843 return result; 3844 } 3845 3846 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) { 3847 struct wireless_dev *txp_wdev = wdev; 3848 enum nl80211_tx_power_setting type; 3849 int idx, mbm = 0; 3850 3851 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER)) 3852 txp_wdev = NULL; 3853 3854 if (!rdev->ops->set_tx_power) 3855 return -EOPNOTSUPP; 3856 3857 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING; 3858 type = nla_get_u32(info->attrs[idx]); 3859 3860 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] && 3861 (type != NL80211_TX_POWER_AUTOMATIC)) 3862 return -EINVAL; 3863 3864 if (type != NL80211_TX_POWER_AUTOMATIC) { 3865 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL; 3866 mbm = nla_get_u32(info->attrs[idx]); 3867 } 3868 3869 result = rdev_set_tx_power(rdev, txp_wdev, radio_idx, type, 3870 mbm); 3871 if (result) 3872 return result; 3873 } 3874 3875 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] && 3876 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) { 3877 u32 tx_ant, rx_ant; 3878 3879 if ((!rdev->wiphy.available_antennas_tx && 3880 !rdev->wiphy.available_antennas_rx) || 3881 !rdev->ops->set_antenna) 3882 return -EOPNOTSUPP; 3883 3884 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]); 3885 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]); 3886 3887 /* reject antenna configurations which don't match the 3888 * available antenna masks, except for the "all" mask */ 3889 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) || 3890 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) 3891 return -EINVAL; 3892 3893 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx; 3894 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx; 3895 3896 result = rdev_set_antenna(rdev, radio_idx, tx_ant, rx_ant); 3897 if (result) 3898 return result; 3899 } 3900 3901 changed = 0; 3902 3903 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) { 3904 retry_short = nla_get_u8( 3905 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]); 3906 3907 changed |= WIPHY_PARAM_RETRY_SHORT; 3908 } 3909 3910 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) { 3911 retry_long = nla_get_u8( 3912 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]); 3913 3914 changed |= WIPHY_PARAM_RETRY_LONG; 3915 } 3916 3917 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) { 3918 frag_threshold = nla_get_u32( 3919 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]); 3920 if (frag_threshold < 256) 3921 return -EINVAL; 3922 3923 if (frag_threshold != (u32) -1) { 3924 /* 3925 * Fragments (apart from the last one) are required to 3926 * have even length. Make the fragmentation code 3927 * simpler by stripping LSB should someone try to use 3928 * odd threshold value. 3929 */ 3930 frag_threshold &= ~0x1; 3931 } 3932 changed |= WIPHY_PARAM_FRAG_THRESHOLD; 3933 } 3934 3935 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3936 rts_threshold = nla_get_u32( 3937 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3938 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3939 } 3940 3941 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) { 3942 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) 3943 return -EINVAL; 3944 3945 coverage_class = nla_get_u8( 3946 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]); 3947 changed |= WIPHY_PARAM_COVERAGE_CLASS; 3948 } 3949 3950 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3951 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) 3952 return -EOPNOTSUPP; 3953 3954 changed |= WIPHY_PARAM_DYN_ACK; 3955 } 3956 3957 if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) { 3958 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3959 NL80211_EXT_FEATURE_TXQS)) 3960 return -EOPNOTSUPP; 3961 3962 txq_limit = nla_get_u32( 3963 info->attrs[NL80211_ATTR_TXQ_LIMIT]); 3964 changed |= WIPHY_PARAM_TXQ_LIMIT; 3965 } 3966 3967 if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) { 3968 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3969 NL80211_EXT_FEATURE_TXQS)) 3970 return -EOPNOTSUPP; 3971 3972 txq_memory_limit = nla_get_u32( 3973 info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]); 3974 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT; 3975 } 3976 3977 if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) { 3978 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3979 NL80211_EXT_FEATURE_TXQS)) 3980 return -EOPNOTSUPP; 3981 3982 txq_quantum = nla_get_u32( 3983 info->attrs[NL80211_ATTR_TXQ_QUANTUM]); 3984 changed |= WIPHY_PARAM_TXQ_QUANTUM; 3985 } 3986 3987 if (changed) { 3988 u8 old_retry_short, old_retry_long; 3989 u32 old_frag_threshold, old_rts_threshold; 3990 u8 old_coverage_class, i; 3991 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum; 3992 u32 *old_radio_rts_threshold = NULL; 3993 3994 if (!rdev->ops->set_wiphy_params) 3995 return -EOPNOTSUPP; 3996 3997 if (rdev->wiphy.n_radio) { 3998 old_radio_rts_threshold = kcalloc(rdev->wiphy.n_radio, 3999 sizeof(u32), 4000 GFP_KERNEL); 4001 if (!old_radio_rts_threshold) 4002 return -ENOMEM; 4003 } 4004 4005 old_retry_short = rdev->wiphy.retry_short; 4006 old_retry_long = rdev->wiphy.retry_long; 4007 old_frag_threshold = rdev->wiphy.frag_threshold; 4008 old_rts_threshold = rdev->wiphy.rts_threshold; 4009 if (old_radio_rts_threshold) { 4010 for (i = 0 ; i < rdev->wiphy.n_radio; i++) 4011 old_radio_rts_threshold[i] = 4012 rdev->wiphy.radio_cfg[i].rts_threshold; 4013 } 4014 old_coverage_class = rdev->wiphy.coverage_class; 4015 old_txq_limit = rdev->wiphy.txq_limit; 4016 old_txq_memory_limit = rdev->wiphy.txq_memory_limit; 4017 old_txq_quantum = rdev->wiphy.txq_quantum; 4018 4019 if (changed & WIPHY_PARAM_RETRY_SHORT) 4020 rdev->wiphy.retry_short = retry_short; 4021 if (changed & WIPHY_PARAM_RETRY_LONG) 4022 rdev->wiphy.retry_long = retry_long; 4023 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) 4024 rdev->wiphy.frag_threshold = frag_threshold; 4025 if ((changed & WIPHY_PARAM_RTS_THRESHOLD) && 4026 old_radio_rts_threshold) { 4027 rdev->wiphy.rts_threshold = rts_threshold; 4028 for (i = 0 ; i < rdev->wiphy.n_radio; i++) 4029 rdev->wiphy.radio_cfg[i].rts_threshold = 4030 rdev->wiphy.rts_threshold; 4031 } 4032 if (changed & WIPHY_PARAM_COVERAGE_CLASS) 4033 rdev->wiphy.coverage_class = coverage_class; 4034 if (changed & WIPHY_PARAM_TXQ_LIMIT) 4035 rdev->wiphy.txq_limit = txq_limit; 4036 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT) 4037 rdev->wiphy.txq_memory_limit = txq_memory_limit; 4038 if (changed & WIPHY_PARAM_TXQ_QUANTUM) 4039 rdev->wiphy.txq_quantum = txq_quantum; 4040 4041 result = rdev_set_wiphy_params(rdev, radio_idx, changed); 4042 if (result) { 4043 rdev->wiphy.retry_short = old_retry_short; 4044 rdev->wiphy.retry_long = old_retry_long; 4045 rdev->wiphy.frag_threshold = old_frag_threshold; 4046 rdev->wiphy.rts_threshold = old_rts_threshold; 4047 if (old_radio_rts_threshold) { 4048 for (i = 0 ; i < rdev->wiphy.n_radio; i++) 4049 rdev->wiphy.radio_cfg[i].rts_threshold = 4050 old_radio_rts_threshold[i]; 4051 } 4052 rdev->wiphy.coverage_class = old_coverage_class; 4053 rdev->wiphy.txq_limit = old_txq_limit; 4054 rdev->wiphy.txq_memory_limit = old_txq_memory_limit; 4055 rdev->wiphy.txq_quantum = old_txq_quantum; 4056 } 4057 4058 if (old_rts_threshold) 4059 kfree(old_radio_rts_threshold); 4060 return result; 4061 } 4062 4063 return 0; 4064 } 4065 4066 int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef) 4067 { 4068 if (WARN_ON(!cfg80211_chandef_valid(chandef))) 4069 return -EINVAL; 4070 4071 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 4072 chandef->chan->center_freq)) 4073 return -ENOBUFS; 4074 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 4075 chandef->chan->freq_offset)) 4076 return -ENOBUFS; 4077 switch (chandef->width) { 4078 case NL80211_CHAN_WIDTH_20_NOHT: 4079 case NL80211_CHAN_WIDTH_20: 4080 case NL80211_CHAN_WIDTH_40: 4081 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 4082 cfg80211_get_chandef_type(chandef))) 4083 return -ENOBUFS; 4084 break; 4085 default: 4086 break; 4087 } 4088 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width)) 4089 return -ENOBUFS; 4090 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1)) 4091 return -ENOBUFS; 4092 if (chandef->center_freq2 && 4093 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2)) 4094 return -ENOBUFS; 4095 if (chandef->punctured && 4096 nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, chandef->punctured)) 4097 return -ENOBUFS; 4098 4099 return 0; 4100 } 4101 EXPORT_SYMBOL(nl80211_send_chandef); 4102 4103 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags, 4104 struct cfg80211_registered_device *rdev, 4105 struct wireless_dev *wdev, 4106 enum nl80211_commands cmd) 4107 { 4108 struct net_device *dev = wdev->netdev; 4109 void *hdr; 4110 4111 lockdep_assert_wiphy(&rdev->wiphy); 4112 4113 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE && 4114 cmd != NL80211_CMD_DEL_INTERFACE && 4115 cmd != NL80211_CMD_SET_INTERFACE); 4116 4117 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 4118 if (!hdr) 4119 return -1; 4120 4121 if (dev && 4122 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4123 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name))) 4124 goto nla_put_failure; 4125 4126 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 4127 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) || 4128 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 4129 NL80211_ATTR_PAD) || 4130 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) || 4131 nla_put_u32(msg, NL80211_ATTR_GENERATION, 4132 rdev->devlist_generation ^ 4133 (cfg80211_rdev_list_generation << 2)) || 4134 nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr) || 4135 nla_put_u32(msg, NL80211_ATTR_VIF_RADIO_MASK, wdev->radio_mask)) 4136 goto nla_put_failure; 4137 4138 if (rdev->ops->get_channel && !wdev->valid_links) { 4139 struct cfg80211_chan_def chandef = {}; 4140 int ret; 4141 4142 ret = rdev_get_channel(rdev, wdev, 0, &chandef); 4143 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 4144 goto nla_put_failure; 4145 } 4146 4147 if (rdev->ops->get_tx_power && !wdev->valid_links) { 4148 int dbm, ret; 4149 4150 ret = rdev_get_tx_power(rdev, wdev, -1, 0, &dbm); 4151 if (ret == 0 && 4152 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 4153 DBM_TO_MBM(dbm))) 4154 goto nla_put_failure; 4155 } 4156 4157 switch (wdev->iftype) { 4158 case NL80211_IFTYPE_AP: 4159 case NL80211_IFTYPE_P2P_GO: 4160 if (wdev->u.ap.ssid_len && 4161 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 4162 wdev->u.ap.ssid)) 4163 goto nla_put_failure; 4164 break; 4165 case NL80211_IFTYPE_STATION: 4166 case NL80211_IFTYPE_P2P_CLIENT: 4167 if (wdev->u.client.ssid_len && 4168 nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len, 4169 wdev->u.client.ssid)) 4170 goto nla_put_failure; 4171 break; 4172 case NL80211_IFTYPE_ADHOC: 4173 if (wdev->u.ibss.ssid_len && 4174 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len, 4175 wdev->u.ibss.ssid)) 4176 goto nla_put_failure; 4177 break; 4178 default: 4179 /* nothing */ 4180 break; 4181 } 4182 4183 if (rdev->ops->get_txq_stats) { 4184 struct cfg80211_txq_stats txqstats = {}; 4185 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats); 4186 4187 if (ret == 0 && 4188 !nl80211_put_txq_stats(msg, &txqstats, 4189 NL80211_ATTR_TXQ_STATS)) 4190 goto nla_put_failure; 4191 } 4192 4193 if (wdev->valid_links) { 4194 unsigned int link_id; 4195 struct nlattr *links = nla_nest_start(msg, 4196 NL80211_ATTR_MLO_LINKS); 4197 4198 if (!links) 4199 goto nla_put_failure; 4200 4201 for_each_valid_link(wdev, link_id) { 4202 struct nlattr *link = nla_nest_start(msg, link_id + 1); 4203 struct cfg80211_chan_def chandef = {}; 4204 int ret; 4205 4206 if (!link) 4207 goto nla_put_failure; 4208 4209 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 4210 goto nla_put_failure; 4211 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 4212 wdev->links[link_id].addr)) 4213 goto nla_put_failure; 4214 4215 ret = rdev_get_channel(rdev, wdev, link_id, &chandef); 4216 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 4217 goto nla_put_failure; 4218 4219 if (rdev->ops->get_tx_power) { 4220 int dbm, ret; 4221 4222 ret = rdev_get_tx_power(rdev, wdev, -1, link_id, &dbm); 4223 if (ret == 0 && 4224 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 4225 DBM_TO_MBM(dbm))) 4226 goto nla_put_failure; 4227 } 4228 nla_nest_end(msg, link); 4229 } 4230 4231 nla_nest_end(msg, links); 4232 } 4233 4234 genlmsg_end(msg, hdr); 4235 return 0; 4236 4237 nla_put_failure: 4238 genlmsg_cancel(msg, hdr); 4239 return -EMSGSIZE; 4240 } 4241 4242 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb) 4243 { 4244 int wp_idx = 0; 4245 int if_idx = 0; 4246 int wp_start = cb->args[0]; 4247 int if_start = cb->args[1]; 4248 int filter_wiphy = -1; 4249 struct cfg80211_registered_device *rdev; 4250 struct wireless_dev *wdev; 4251 int ret; 4252 4253 rtnl_lock(); 4254 if (!cb->args[2]) { 4255 struct nl80211_dump_wiphy_state state = { 4256 .filter_wiphy = -1, 4257 }; 4258 4259 ret = nl80211_dump_wiphy_parse(skb, cb, &state); 4260 if (ret) 4261 goto out_unlock; 4262 4263 filter_wiphy = state.filter_wiphy; 4264 4265 /* 4266 * if filtering, set cb->args[2] to +1 since 0 is the default 4267 * value needed to determine that parsing is necessary. 4268 */ 4269 if (filter_wiphy >= 0) 4270 cb->args[2] = filter_wiphy + 1; 4271 else 4272 cb->args[2] = -1; 4273 } else if (cb->args[2] > 0) { 4274 filter_wiphy = cb->args[2] - 1; 4275 } 4276 4277 for_each_rdev(rdev) { 4278 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 4279 continue; 4280 if (wp_idx < wp_start) { 4281 wp_idx++; 4282 continue; 4283 } 4284 4285 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx) 4286 continue; 4287 4288 if_idx = 0; 4289 4290 guard(wiphy)(&rdev->wiphy); 4291 4292 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 4293 if (if_idx < if_start) { 4294 if_idx++; 4295 continue; 4296 } 4297 4298 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid, 4299 cb->nlh->nlmsg_seq, NLM_F_MULTI, 4300 rdev, wdev, 4301 NL80211_CMD_NEW_INTERFACE) < 0) 4302 goto out; 4303 4304 if_idx++; 4305 } 4306 4307 if_start = 0; 4308 wp_idx++; 4309 } 4310 out: 4311 cb->args[0] = wp_idx; 4312 cb->args[1] = if_idx; 4313 4314 ret = skb->len; 4315 out_unlock: 4316 rtnl_unlock(); 4317 4318 return ret; 4319 } 4320 4321 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info) 4322 { 4323 struct sk_buff *msg; 4324 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4325 struct wireless_dev *wdev = info->user_ptr[1]; 4326 4327 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4328 if (!msg) 4329 return -ENOMEM; 4330 4331 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4332 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4333 nlmsg_free(msg); 4334 return -ENOBUFS; 4335 } 4336 4337 return genlmsg_reply(msg, info); 4338 } 4339 4340 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = { 4341 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG }, 4342 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG }, 4343 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG }, 4344 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG }, 4345 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG }, 4346 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG }, 4347 [NL80211_MNTR_FLAG_SKIP_TX] = { .type = NLA_FLAG }, 4348 }; 4349 4350 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags) 4351 { 4352 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1]; 4353 int flag; 4354 4355 *mntrflags = 0; 4356 4357 if (!nla) 4358 return -EINVAL; 4359 4360 if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL)) 4361 return -EINVAL; 4362 4363 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++) 4364 if (flags[flag]) 4365 *mntrflags |= (1<<flag); 4366 4367 /* cooked monitor mode is incompatible with other modes */ 4368 if (*mntrflags & MONITOR_FLAG_COOK_FRAMES && 4369 *mntrflags != MONITOR_FLAG_COOK_FRAMES) 4370 return -EOPNOTSUPP; 4371 4372 *mntrflags |= MONITOR_FLAG_CHANGED; 4373 4374 return 0; 4375 } 4376 4377 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev, 4378 enum nl80211_iftype type, 4379 struct genl_info *info, 4380 struct vif_params *params) 4381 { 4382 bool change = false; 4383 int err; 4384 4385 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) { 4386 if (type != NL80211_IFTYPE_MONITOR) 4387 return -EINVAL; 4388 4389 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS], 4390 ¶ms->flags); 4391 if (err) 4392 return err; 4393 4394 change = true; 4395 } 4396 4397 /* MONITOR_FLAG_COOK_FRAMES is deprecated, refuse cooperation */ 4398 if (params->flags & MONITOR_FLAG_COOK_FRAMES) 4399 return -EOPNOTSUPP; 4400 4401 if (params->flags & MONITOR_FLAG_ACTIVE && 4402 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR)) 4403 return -EOPNOTSUPP; 4404 4405 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) { 4406 const u8 *mumimo_groups; 4407 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4408 4409 if (type != NL80211_IFTYPE_MONITOR) 4410 return -EINVAL; 4411 4412 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4413 return -EOPNOTSUPP; 4414 4415 mumimo_groups = 4416 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]); 4417 4418 /* bits 0 and 63 are reserved and must be zero */ 4419 if ((mumimo_groups[0] & BIT(0)) || 4420 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7))) 4421 return -EINVAL; 4422 4423 params->vht_mumimo_groups = mumimo_groups; 4424 change = true; 4425 } 4426 4427 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) { 4428 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4429 4430 if (type != NL80211_IFTYPE_MONITOR) 4431 return -EINVAL; 4432 4433 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4434 return -EOPNOTSUPP; 4435 4436 params->vht_mumimo_follow_addr = 4437 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]); 4438 change = true; 4439 } 4440 4441 return change ? 1 : 0; 4442 } 4443 4444 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev, 4445 struct net_device *netdev, u8 use_4addr, 4446 enum nl80211_iftype iftype) 4447 { 4448 if (!use_4addr) { 4449 if (netdev && netif_is_bridge_port(netdev)) 4450 return -EBUSY; 4451 return 0; 4452 } 4453 4454 switch (iftype) { 4455 case NL80211_IFTYPE_AP_VLAN: 4456 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP) 4457 return 0; 4458 break; 4459 case NL80211_IFTYPE_STATION: 4460 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION) 4461 return 0; 4462 break; 4463 default: 4464 break; 4465 } 4466 4467 return -EOPNOTSUPP; 4468 } 4469 4470 static int nl80211_parse_vif_radio_mask(struct genl_info *info, 4471 u32 *radio_mask) 4472 { 4473 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4474 struct nlattr *attr = info->attrs[NL80211_ATTR_VIF_RADIO_MASK]; 4475 u32 mask, allowed; 4476 4477 if (!attr) { 4478 *radio_mask = 0; 4479 return 0; 4480 } 4481 4482 allowed = BIT(rdev->wiphy.n_radio) - 1; 4483 mask = nla_get_u32(attr); 4484 if (mask & ~allowed) 4485 return -EINVAL; 4486 if (!mask) 4487 mask = allowed; 4488 *radio_mask = mask; 4489 4490 return 1; 4491 } 4492 4493 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info) 4494 { 4495 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4496 struct vif_params params; 4497 int err; 4498 enum nl80211_iftype otype, ntype; 4499 struct net_device *dev = info->user_ptr[1]; 4500 struct wireless_dev *wdev = dev->ieee80211_ptr; 4501 u32 radio_mask = 0; 4502 bool change = false; 4503 4504 memset(¶ms, 0, sizeof(params)); 4505 4506 otype = ntype = dev->ieee80211_ptr->iftype; 4507 4508 if (info->attrs[NL80211_ATTR_IFTYPE]) { 4509 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4510 if (otype != ntype) 4511 change = true; 4512 } 4513 4514 if (info->attrs[NL80211_ATTR_MESH_ID]) { 4515 if (ntype != NL80211_IFTYPE_MESH_POINT) 4516 return -EINVAL; 4517 if (otype != NL80211_IFTYPE_MESH_POINT) 4518 return -EINVAL; 4519 if (netif_running(dev)) 4520 return -EBUSY; 4521 4522 wdev->u.mesh.id_up_len = 4523 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4524 memcpy(wdev->u.mesh.id, 4525 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4526 wdev->u.mesh.id_up_len); 4527 } 4528 4529 if (info->attrs[NL80211_ATTR_4ADDR]) { 4530 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4531 change = true; 4532 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype); 4533 if (err) 4534 return err; 4535 } else { 4536 params.use_4addr = -1; 4537 } 4538 4539 err = nl80211_parse_mon_options(rdev, ntype, info, ¶ms); 4540 if (err < 0) 4541 return err; 4542 if (err > 0) 4543 change = true; 4544 4545 err = nl80211_parse_vif_radio_mask(info, &radio_mask); 4546 if (err < 0) 4547 return err; 4548 if (err && netif_running(dev)) 4549 return -EBUSY; 4550 4551 if (change) 4552 err = cfg80211_change_iface(rdev, dev, ntype, ¶ms); 4553 else 4554 err = 0; 4555 4556 if (!err && params.use_4addr != -1) 4557 dev->ieee80211_ptr->use_4addr = params.use_4addr; 4558 4559 if (radio_mask) 4560 wdev->radio_mask = radio_mask; 4561 4562 if (change && !err) 4563 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE); 4564 4565 return err; 4566 } 4567 4568 static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4569 { 4570 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4571 struct vif_params params; 4572 struct wireless_dev *wdev; 4573 struct sk_buff *msg; 4574 u32 radio_mask; 4575 int err; 4576 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED; 4577 4578 memset(¶ms, 0, sizeof(params)); 4579 4580 if (!info->attrs[NL80211_ATTR_IFNAME]) 4581 return -EINVAL; 4582 4583 if (info->attrs[NL80211_ATTR_IFTYPE]) 4584 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4585 4586 if (!rdev->ops->add_virtual_intf) 4587 return -EOPNOTSUPP; 4588 4589 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN || 4590 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) && 4591 info->attrs[NL80211_ATTR_MAC]) { 4592 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC], 4593 ETH_ALEN); 4594 if (!is_valid_ether_addr(params.macaddr)) 4595 return -EADDRNOTAVAIL; 4596 } 4597 4598 if (info->attrs[NL80211_ATTR_4ADDR]) { 4599 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4600 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type); 4601 if (err) 4602 return err; 4603 } 4604 4605 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0)) 4606 return -EOPNOTSUPP; 4607 4608 err = nl80211_parse_mon_options(rdev, type, info, ¶ms); 4609 if (err < 0) 4610 return err; 4611 4612 err = nl80211_parse_vif_radio_mask(info, &radio_mask); 4613 if (err < 0) 4614 return err; 4615 4616 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4617 if (!msg) 4618 return -ENOMEM; 4619 4620 wdev = rdev_add_virtual_intf(rdev, 4621 nla_data(info->attrs[NL80211_ATTR_IFNAME]), 4622 NET_NAME_USER, type, ¶ms); 4623 if (WARN_ON(!wdev)) { 4624 nlmsg_free(msg); 4625 return -EPROTO; 4626 } else if (IS_ERR(wdev)) { 4627 nlmsg_free(msg); 4628 return PTR_ERR(wdev); 4629 } 4630 4631 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 4632 wdev->owner_nlportid = info->snd_portid; 4633 4634 switch (type) { 4635 case NL80211_IFTYPE_MESH_POINT: 4636 if (!info->attrs[NL80211_ATTR_MESH_ID]) 4637 break; 4638 wdev->u.mesh.id_up_len = 4639 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4640 memcpy(wdev->u.mesh.id, 4641 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4642 wdev->u.mesh.id_up_len); 4643 break; 4644 case NL80211_IFTYPE_NAN: 4645 case NL80211_IFTYPE_P2P_DEVICE: 4646 /* 4647 * P2P Device and NAN do not have a netdev, so don't go 4648 * through the netdev notifier and must be added here 4649 */ 4650 cfg80211_init_wdev(wdev); 4651 cfg80211_register_wdev(rdev, wdev); 4652 break; 4653 default: 4654 break; 4655 } 4656 4657 if (radio_mask) 4658 wdev->radio_mask = radio_mask; 4659 4660 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4661 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4662 nlmsg_free(msg); 4663 return -ENOBUFS; 4664 } 4665 4666 return genlmsg_reply(msg, info); 4667 } 4668 4669 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4670 { 4671 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4672 4673 /* to avoid failing a new interface creation due to pending removal */ 4674 cfg80211_destroy_ifaces(rdev); 4675 4676 guard(wiphy)(&rdev->wiphy); 4677 4678 return _nl80211_new_interface(skb, info); 4679 } 4680 4681 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info) 4682 { 4683 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4684 struct wireless_dev *wdev = info->user_ptr[1]; 4685 4686 if (!rdev->ops->del_virtual_intf) 4687 return -EOPNOTSUPP; 4688 4689 /* 4690 * We hold RTNL, so this is safe, without RTNL opencount cannot 4691 * reach 0, and thus the rdev cannot be deleted. 4692 * 4693 * We need to do it for the dev_close(), since that will call 4694 * the netdev notifiers, and we need to acquire the mutex there 4695 * but don't know if we get there from here or from some other 4696 * place (e.g. "ip link set ... down"). 4697 */ 4698 mutex_unlock(&rdev->wiphy.mtx); 4699 4700 /* 4701 * If we remove a wireless device without a netdev then clear 4702 * user_ptr[1] so that nl80211_post_doit won't dereference it 4703 * to check if it needs to do dev_put(). Otherwise it crashes 4704 * since the wdev has been freed, unlike with a netdev where 4705 * we need the dev_put() for the netdev to really be freed. 4706 */ 4707 if (!wdev->netdev) 4708 info->user_ptr[1] = NULL; 4709 else 4710 dev_close(wdev->netdev); 4711 4712 mutex_lock(&rdev->wiphy.mtx); 4713 4714 return cfg80211_remove_virtual_intf(rdev, wdev); 4715 } 4716 4717 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info) 4718 { 4719 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4720 struct net_device *dev = info->user_ptr[1]; 4721 u16 noack_map; 4722 4723 if (!info->attrs[NL80211_ATTR_NOACK_MAP]) 4724 return -EINVAL; 4725 4726 if (!rdev->ops->set_noack_map) 4727 return -EOPNOTSUPP; 4728 4729 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]); 4730 4731 return rdev_set_noack_map(rdev, dev, noack_map); 4732 } 4733 4734 static int nl80211_validate_key_link_id(struct genl_info *info, 4735 struct wireless_dev *wdev, 4736 int link_id, bool pairwise) 4737 { 4738 if (pairwise) { 4739 if (link_id != -1) { 4740 GENL_SET_ERR_MSG(info, 4741 "link ID not allowed for pairwise key"); 4742 return -EINVAL; 4743 } 4744 4745 return 0; 4746 } 4747 4748 if (wdev->valid_links) { 4749 if (link_id == -1) { 4750 GENL_SET_ERR_MSG(info, 4751 "link ID must for MLO group key"); 4752 return -EINVAL; 4753 } 4754 if (!(wdev->valid_links & BIT(link_id))) { 4755 GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key"); 4756 return -EINVAL; 4757 } 4758 } else if (link_id != -1) { 4759 GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key"); 4760 return -EINVAL; 4761 } 4762 4763 return 0; 4764 } 4765 4766 struct get_key_cookie { 4767 struct sk_buff *msg; 4768 int error; 4769 int idx; 4770 }; 4771 4772 static void get_key_callback(void *c, struct key_params *params) 4773 { 4774 struct nlattr *key; 4775 struct get_key_cookie *cookie = c; 4776 4777 if ((params->seq && 4778 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ, 4779 params->seq_len, params->seq)) || 4780 (params->cipher && 4781 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER, 4782 params->cipher))) 4783 goto nla_put_failure; 4784 4785 key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY); 4786 if (!key) 4787 goto nla_put_failure; 4788 4789 if ((params->seq && 4790 nla_put(cookie->msg, NL80211_KEY_SEQ, 4791 params->seq_len, params->seq)) || 4792 (params->cipher && 4793 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER, 4794 params->cipher))) 4795 goto nla_put_failure; 4796 4797 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx)) 4798 goto nla_put_failure; 4799 4800 nla_nest_end(cookie->msg, key); 4801 4802 return; 4803 nla_put_failure: 4804 cookie->error = 1; 4805 } 4806 4807 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info) 4808 { 4809 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4810 int err; 4811 struct net_device *dev = info->user_ptr[1]; 4812 u8 key_idx = 0; 4813 const u8 *mac_addr = NULL; 4814 bool pairwise; 4815 struct get_key_cookie cookie = { 4816 .error = 0, 4817 }; 4818 void *hdr; 4819 struct sk_buff *msg; 4820 bool bigtk_support = false; 4821 int link_id = nl80211_link_id_or_invalid(info->attrs); 4822 struct wireless_dev *wdev = dev->ieee80211_ptr; 4823 4824 if (wiphy_ext_feature_isset(&rdev->wiphy, 4825 NL80211_EXT_FEATURE_BEACON_PROTECTION)) 4826 bigtk_support = true; 4827 4828 if ((wdev->iftype == NL80211_IFTYPE_STATION || 4829 wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) && 4830 wiphy_ext_feature_isset(&rdev->wiphy, 4831 NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT)) 4832 bigtk_support = true; 4833 4834 if (info->attrs[NL80211_ATTR_KEY_IDX]) { 4835 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 4836 4837 if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) { 4838 GENL_SET_ERR_MSG(info, "BIGTK not supported"); 4839 return -EINVAL; 4840 } 4841 } 4842 4843 if (info->attrs[NL80211_ATTR_MAC]) 4844 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4845 4846 pairwise = !!mac_addr; 4847 if (info->attrs[NL80211_ATTR_KEY_TYPE]) { 4848 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 4849 4850 if (kt != NL80211_KEYTYPE_GROUP && 4851 kt != NL80211_KEYTYPE_PAIRWISE) 4852 return -EINVAL; 4853 pairwise = kt == NL80211_KEYTYPE_PAIRWISE; 4854 } 4855 4856 if (!rdev->ops->get_key) 4857 return -EOPNOTSUPP; 4858 4859 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4860 return -ENOENT; 4861 4862 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4863 if (!msg) 4864 return -ENOMEM; 4865 4866 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 4867 NL80211_CMD_NEW_KEY); 4868 if (!hdr) 4869 goto nla_put_failure; 4870 4871 cookie.msg = msg; 4872 cookie.idx = key_idx; 4873 4874 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4875 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx)) 4876 goto nla_put_failure; 4877 if (mac_addr && 4878 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr)) 4879 goto nla_put_failure; 4880 4881 err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise); 4882 if (err) 4883 goto free_msg; 4884 4885 err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr, 4886 &cookie, get_key_callback); 4887 4888 if (err) 4889 goto free_msg; 4890 4891 if (cookie.error) 4892 goto nla_put_failure; 4893 4894 genlmsg_end(msg, hdr); 4895 return genlmsg_reply(msg, info); 4896 4897 nla_put_failure: 4898 err = -ENOBUFS; 4899 free_msg: 4900 nlmsg_free(msg); 4901 return err; 4902 } 4903 4904 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info) 4905 { 4906 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4907 struct key_parse key; 4908 int err; 4909 struct net_device *dev = info->user_ptr[1]; 4910 int link_id = nl80211_link_id_or_invalid(info->attrs); 4911 struct wireless_dev *wdev = dev->ieee80211_ptr; 4912 4913 err = nl80211_parse_key(info, &key); 4914 if (err) 4915 return err; 4916 4917 if (key.idx < 0) 4918 return -EINVAL; 4919 4920 /* Only support setting default key and 4921 * Extended Key ID action NL80211_KEY_SET_TX. 4922 */ 4923 if (!key.def && !key.defmgmt && !key.defbeacon && 4924 !(key.p.mode == NL80211_KEY_SET_TX)) 4925 return -EINVAL; 4926 4927 if (key.def) { 4928 if (!rdev->ops->set_default_key) 4929 return -EOPNOTSUPP; 4930 4931 err = nl80211_key_allowed(wdev); 4932 if (err) 4933 return err; 4934 4935 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4936 if (err) 4937 return err; 4938 4939 err = rdev_set_default_key(rdev, dev, link_id, key.idx, 4940 key.def_uni, key.def_multi); 4941 4942 if (err) 4943 return err; 4944 4945 #ifdef CONFIG_CFG80211_WEXT 4946 wdev->wext.default_key = key.idx; 4947 #endif 4948 return 0; 4949 } else if (key.defmgmt) { 4950 if (key.def_uni || !key.def_multi) 4951 return -EINVAL; 4952 4953 if (!rdev->ops->set_default_mgmt_key) 4954 return -EOPNOTSUPP; 4955 4956 err = nl80211_key_allowed(wdev); 4957 if (err) 4958 return err; 4959 4960 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4961 if (err) 4962 return err; 4963 4964 err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx); 4965 if (err) 4966 return err; 4967 4968 #ifdef CONFIG_CFG80211_WEXT 4969 wdev->wext.default_mgmt_key = key.idx; 4970 #endif 4971 return 0; 4972 } else if (key.defbeacon) { 4973 if (key.def_uni || !key.def_multi) 4974 return -EINVAL; 4975 4976 if (!rdev->ops->set_default_beacon_key) 4977 return -EOPNOTSUPP; 4978 4979 err = nl80211_key_allowed(wdev); 4980 if (err) 4981 return err; 4982 4983 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4984 if (err) 4985 return err; 4986 4987 return rdev_set_default_beacon_key(rdev, dev, link_id, key.idx); 4988 } else if (key.p.mode == NL80211_KEY_SET_TX && 4989 wiphy_ext_feature_isset(&rdev->wiphy, 4990 NL80211_EXT_FEATURE_EXT_KEY_ID)) { 4991 u8 *mac_addr = NULL; 4992 4993 if (info->attrs[NL80211_ATTR_MAC]) 4994 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4995 4996 if (!mac_addr || key.idx < 0 || key.idx > 1) 4997 return -EINVAL; 4998 4999 err = nl80211_validate_key_link_id(info, wdev, link_id, true); 5000 if (err) 5001 return err; 5002 5003 return rdev_add_key(rdev, dev, link_id, key.idx, 5004 NL80211_KEYTYPE_PAIRWISE, 5005 mac_addr, &key.p); 5006 } 5007 5008 return -EINVAL; 5009 } 5010 5011 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info) 5012 { 5013 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5014 int err; 5015 struct net_device *dev = info->user_ptr[1]; 5016 struct key_parse key; 5017 const u8 *mac_addr = NULL; 5018 int link_id = nl80211_link_id_or_invalid(info->attrs); 5019 struct wireless_dev *wdev = dev->ieee80211_ptr; 5020 5021 err = nl80211_parse_key(info, &key); 5022 if (err) 5023 return err; 5024 5025 if (!key.p.key) { 5026 GENL_SET_ERR_MSG(info, "no key"); 5027 return -EINVAL; 5028 } 5029 5030 if (info->attrs[NL80211_ATTR_MAC]) 5031 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5032 5033 if (key.type == -1) { 5034 if (mac_addr) 5035 key.type = NL80211_KEYTYPE_PAIRWISE; 5036 else 5037 key.type = NL80211_KEYTYPE_GROUP; 5038 } 5039 5040 /* for now */ 5041 if (key.type != NL80211_KEYTYPE_PAIRWISE && 5042 key.type != NL80211_KEYTYPE_GROUP) { 5043 GENL_SET_ERR_MSG(info, "key type not pairwise or group"); 5044 return -EINVAL; 5045 } 5046 5047 if (key.type == NL80211_KEYTYPE_GROUP && 5048 info->attrs[NL80211_ATTR_VLAN_ID]) 5049 key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 5050 5051 if (!rdev->ops->add_key) 5052 return -EOPNOTSUPP; 5053 5054 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, 5055 key.type == NL80211_KEYTYPE_PAIRWISE, 5056 mac_addr)) { 5057 GENL_SET_ERR_MSG(info, "key setting validation failed"); 5058 return -EINVAL; 5059 } 5060 5061 err = nl80211_key_allowed(wdev); 5062 if (err) 5063 GENL_SET_ERR_MSG(info, "key not allowed"); 5064 5065 if (!err) 5066 err = nl80211_validate_key_link_id(info, wdev, link_id, 5067 key.type == NL80211_KEYTYPE_PAIRWISE); 5068 5069 if (!err) { 5070 err = rdev_add_key(rdev, dev, link_id, key.idx, 5071 key.type == NL80211_KEYTYPE_PAIRWISE, 5072 mac_addr, &key.p); 5073 if (err) 5074 GENL_SET_ERR_MSG(info, "key addition failed"); 5075 } 5076 5077 return err; 5078 } 5079 5080 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info) 5081 { 5082 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5083 int err; 5084 struct net_device *dev = info->user_ptr[1]; 5085 u8 *mac_addr = NULL; 5086 struct key_parse key; 5087 int link_id = nl80211_link_id_or_invalid(info->attrs); 5088 struct wireless_dev *wdev = dev->ieee80211_ptr; 5089 5090 err = nl80211_parse_key(info, &key); 5091 if (err) 5092 return err; 5093 5094 if (info->attrs[NL80211_ATTR_MAC]) 5095 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 5096 5097 if (key.type == -1) { 5098 if (mac_addr) 5099 key.type = NL80211_KEYTYPE_PAIRWISE; 5100 else 5101 key.type = NL80211_KEYTYPE_GROUP; 5102 } 5103 5104 /* for now */ 5105 if (key.type != NL80211_KEYTYPE_PAIRWISE && 5106 key.type != NL80211_KEYTYPE_GROUP) 5107 return -EINVAL; 5108 5109 if (!cfg80211_valid_key_idx(rdev, key.idx, 5110 key.type == NL80211_KEYTYPE_PAIRWISE)) 5111 return -EINVAL; 5112 5113 if (!rdev->ops->del_key) 5114 return -EOPNOTSUPP; 5115 5116 err = nl80211_key_allowed(wdev); 5117 5118 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr && 5119 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 5120 err = -ENOENT; 5121 5122 if (!err) 5123 err = nl80211_validate_key_link_id(info, wdev, link_id, 5124 key.type == NL80211_KEYTYPE_PAIRWISE); 5125 5126 if (!err) 5127 err = rdev_del_key(rdev, dev, link_id, key.idx, 5128 key.type == NL80211_KEYTYPE_PAIRWISE, 5129 mac_addr); 5130 5131 #ifdef CONFIG_CFG80211_WEXT 5132 if (!err) { 5133 if (key.idx == wdev->wext.default_key) 5134 wdev->wext.default_key = -1; 5135 else if (key.idx == wdev->wext.default_mgmt_key) 5136 wdev->wext.default_mgmt_key = -1; 5137 } 5138 #endif 5139 5140 return err; 5141 } 5142 5143 /* This function returns an error or the number of nested attributes */ 5144 static int validate_acl_mac_addrs(struct nlattr *nl_attr) 5145 { 5146 struct nlattr *attr; 5147 int n_entries = 0, tmp; 5148 5149 nla_for_each_nested(attr, nl_attr, tmp) { 5150 if (nla_len(attr) != ETH_ALEN) 5151 return -EINVAL; 5152 5153 n_entries++; 5154 } 5155 5156 return n_entries; 5157 } 5158 5159 /* 5160 * This function parses ACL information and allocates memory for ACL data. 5161 * On successful return, the calling function is responsible to free the 5162 * ACL buffer returned by this function. 5163 */ 5164 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy, 5165 struct genl_info *info) 5166 { 5167 enum nl80211_acl_policy acl_policy; 5168 struct nlattr *attr; 5169 struct cfg80211_acl_data *acl; 5170 int i = 0, n_entries, tmp; 5171 5172 if (!wiphy->max_acl_mac_addrs) 5173 return ERR_PTR(-EOPNOTSUPP); 5174 5175 if (!info->attrs[NL80211_ATTR_ACL_POLICY]) 5176 return ERR_PTR(-EINVAL); 5177 5178 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]); 5179 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED && 5180 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED) 5181 return ERR_PTR(-EINVAL); 5182 5183 if (!info->attrs[NL80211_ATTR_MAC_ADDRS]) 5184 return ERR_PTR(-EINVAL); 5185 5186 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]); 5187 if (n_entries < 0) 5188 return ERR_PTR(n_entries); 5189 5190 if (n_entries > wiphy->max_acl_mac_addrs) 5191 return ERR_PTR(-EOPNOTSUPP); 5192 5193 acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL); 5194 if (!acl) 5195 return ERR_PTR(-ENOMEM); 5196 acl->n_acl_entries = n_entries; 5197 5198 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) { 5199 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN); 5200 i++; 5201 } 5202 acl->acl_policy = acl_policy; 5203 5204 return acl; 5205 } 5206 5207 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info) 5208 { 5209 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5210 struct net_device *dev = info->user_ptr[1]; 5211 struct cfg80211_acl_data *acl; 5212 int err; 5213 5214 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 5215 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 5216 return -EOPNOTSUPP; 5217 5218 if (!dev->ieee80211_ptr->links[0].ap.beacon_interval) 5219 return -EINVAL; 5220 5221 acl = parse_acl_data(&rdev->wiphy, info); 5222 if (IS_ERR(acl)) 5223 return PTR_ERR(acl); 5224 5225 err = rdev_set_mac_acl(rdev, dev, acl); 5226 5227 kfree(acl); 5228 5229 return err; 5230 } 5231 5232 static u32 rateset_to_mask(struct ieee80211_supported_band *sband, 5233 u8 *rates, u8 rates_len) 5234 { 5235 u8 i; 5236 u32 mask = 0; 5237 5238 for (i = 0; i < rates_len; i++) { 5239 int rate = (rates[i] & 0x7f) * 5; 5240 int ridx; 5241 5242 for (ridx = 0; ridx < sband->n_bitrates; ridx++) { 5243 struct ieee80211_rate *srate = 5244 &sband->bitrates[ridx]; 5245 if (rate == srate->bitrate) { 5246 mask |= 1 << ridx; 5247 break; 5248 } 5249 } 5250 if (ridx == sband->n_bitrates) 5251 return 0; /* rate not found */ 5252 } 5253 5254 return mask; 5255 } 5256 5257 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband, 5258 u8 *rates, u8 rates_len, 5259 u8 mcs[IEEE80211_HT_MCS_MASK_LEN]) 5260 { 5261 u8 i; 5262 5263 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN); 5264 5265 for (i = 0; i < rates_len; i++) { 5266 int ridx, rbit; 5267 5268 ridx = rates[i] / 8; 5269 rbit = BIT(rates[i] % 8); 5270 5271 /* check validity */ 5272 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN)) 5273 return false; 5274 5275 /* check availability */ 5276 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN); 5277 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit) 5278 mcs[ridx] |= rbit; 5279 else 5280 return false; 5281 } 5282 5283 return true; 5284 } 5285 5286 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map) 5287 { 5288 u16 mcs_mask = 0; 5289 5290 switch (vht_mcs_map) { 5291 case IEEE80211_VHT_MCS_NOT_SUPPORTED: 5292 break; 5293 case IEEE80211_VHT_MCS_SUPPORT_0_7: 5294 mcs_mask = 0x00FF; 5295 break; 5296 case IEEE80211_VHT_MCS_SUPPORT_0_8: 5297 mcs_mask = 0x01FF; 5298 break; 5299 case IEEE80211_VHT_MCS_SUPPORT_0_9: 5300 mcs_mask = 0x03FF; 5301 break; 5302 default: 5303 break; 5304 } 5305 5306 return mcs_mask; 5307 } 5308 5309 static void vht_build_mcs_mask(u16 vht_mcs_map, 5310 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX]) 5311 { 5312 u8 nss; 5313 5314 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) { 5315 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03); 5316 vht_mcs_map >>= 2; 5317 } 5318 } 5319 5320 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband, 5321 struct nl80211_txrate_vht *txrate, 5322 u16 mcs[NL80211_VHT_NSS_MAX]) 5323 { 5324 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5325 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {}; 5326 u8 i; 5327 5328 if (!sband->vht_cap.vht_supported) 5329 return false; 5330 5331 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX); 5332 5333 /* Build vht_mcs_mask from VHT capabilities */ 5334 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5335 5336 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5337 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5338 mcs[i] = txrate->mcs[i]; 5339 else 5340 return false; 5341 } 5342 5343 return true; 5344 } 5345 5346 static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map) 5347 { 5348 switch (he_mcs_map) { 5349 case IEEE80211_HE_MCS_NOT_SUPPORTED: 5350 return 0; 5351 case IEEE80211_HE_MCS_SUPPORT_0_7: 5352 return 0x00FF; 5353 case IEEE80211_HE_MCS_SUPPORT_0_9: 5354 return 0x03FF; 5355 case IEEE80211_HE_MCS_SUPPORT_0_11: 5356 return 0xFFF; 5357 default: 5358 break; 5359 } 5360 return 0; 5361 } 5362 5363 static void he_build_mcs_mask(u16 he_mcs_map, 5364 u16 he_mcs_mask[NL80211_HE_NSS_MAX]) 5365 { 5366 u8 nss; 5367 5368 for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) { 5369 he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03); 5370 he_mcs_map >>= 2; 5371 } 5372 } 5373 5374 static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id, 5375 const struct ieee80211_sta_he_cap *he_cap) 5376 { 5377 struct net_device *dev = info->user_ptr[1]; 5378 struct wireless_dev *wdev = dev->ieee80211_ptr; 5379 struct cfg80211_chan_def *chandef; 5380 __le16 tx_mcs; 5381 5382 chandef = wdev_chandef(wdev, link_id); 5383 if (!chandef) { 5384 /* 5385 * This is probably broken, but we never maintained 5386 * a chandef in these cases, so it always was. 5387 */ 5388 return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80); 5389 } 5390 5391 switch (chandef->width) { 5392 case NL80211_CHAN_WIDTH_80P80: 5393 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80; 5394 break; 5395 case NL80211_CHAN_WIDTH_160: 5396 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160; 5397 break; 5398 default: 5399 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80; 5400 break; 5401 } 5402 5403 return le16_to_cpu(tx_mcs); 5404 } 5405 5406 static bool he_set_mcs_mask(struct genl_info *info, 5407 struct wireless_dev *wdev, 5408 struct ieee80211_supported_band *sband, 5409 struct nl80211_txrate_he *txrate, 5410 u16 mcs[NL80211_HE_NSS_MAX], 5411 unsigned int link_id) 5412 { 5413 const struct ieee80211_sta_he_cap *he_cap; 5414 u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {}; 5415 u16 tx_mcs_map = 0; 5416 u8 i; 5417 5418 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5419 if (!he_cap) 5420 return false; 5421 5422 memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX); 5423 5424 tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5425 5426 /* Build he_mcs_mask from HE capabilities */ 5427 he_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5428 5429 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5430 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5431 mcs[i] = txrate->mcs[i]; 5432 else 5433 return false; 5434 } 5435 5436 return true; 5437 } 5438 5439 static void eht_build_mcs_mask(struct genl_info *info, 5440 const struct ieee80211_sta_eht_cap *eht_cap, 5441 u8 mcs_nss_len, u16 *mcs_mask) 5442 { 5443 struct net_device *dev = info->user_ptr[1]; 5444 struct wireless_dev *wdev = dev->ieee80211_ptr; 5445 u8 nss, mcs_7 = 0, mcs_9 = 0, mcs_11 = 0, mcs_13 = 0; 5446 unsigned int link_id = nl80211_link_id(info->attrs); 5447 5448 if (mcs_nss_len == 4) { 5449 const struct ieee80211_eht_mcs_nss_supp_20mhz_only *mcs = 5450 &eht_cap->eht_mcs_nss_supp.only_20mhz; 5451 5452 mcs_7 = u8_get_bits(mcs->rx_tx_mcs7_max_nss, 5453 IEEE80211_EHT_MCS_NSS_TX); 5454 mcs_9 = u8_get_bits(mcs->rx_tx_mcs9_max_nss, 5455 IEEE80211_EHT_MCS_NSS_TX); 5456 mcs_11 = u8_get_bits(mcs->rx_tx_mcs11_max_nss, 5457 IEEE80211_EHT_MCS_NSS_TX); 5458 mcs_13 = u8_get_bits(mcs->rx_tx_mcs13_max_nss, 5459 IEEE80211_EHT_MCS_NSS_TX); 5460 5461 } else { 5462 const struct ieee80211_eht_mcs_nss_supp_bw *mcs; 5463 enum nl80211_chan_width width; 5464 5465 switch (wdev->iftype) { 5466 case NL80211_IFTYPE_ADHOC: 5467 width = wdev->u.ibss.chandef.width; 5468 break; 5469 case NL80211_IFTYPE_MESH_POINT: 5470 width = wdev->u.mesh.chandef.width; 5471 break; 5472 case NL80211_IFTYPE_OCB: 5473 width = wdev->u.ocb.chandef.width; 5474 break; 5475 default: 5476 if (wdev->valid_links) 5477 width = wdev->links[link_id].ap.chandef.width; 5478 else 5479 width = wdev->u.ap.preset_chandef.width; 5480 break; 5481 } 5482 5483 switch (width) { 5484 case NL80211_CHAN_WIDTH_320: 5485 mcs = &eht_cap->eht_mcs_nss_supp.bw._320; 5486 break; 5487 case NL80211_CHAN_WIDTH_160: 5488 mcs = &eht_cap->eht_mcs_nss_supp.bw._160; 5489 break; 5490 default: 5491 mcs = &eht_cap->eht_mcs_nss_supp.bw._80; 5492 break; 5493 } 5494 5495 mcs_7 = u8_get_bits(mcs->rx_tx_mcs9_max_nss, 5496 IEEE80211_EHT_MCS_NSS_TX); 5497 mcs_9 = u8_get_bits(mcs->rx_tx_mcs9_max_nss, 5498 IEEE80211_EHT_MCS_NSS_TX); 5499 mcs_11 = u8_get_bits(mcs->rx_tx_mcs11_max_nss, 5500 IEEE80211_EHT_MCS_NSS_TX); 5501 mcs_13 = u8_get_bits(mcs->rx_tx_mcs13_max_nss, 5502 IEEE80211_EHT_MCS_NSS_TX); 5503 } 5504 5505 /* Enable MCS 14 for NSS 0 */ 5506 if (eht_cap->eht_cap_elem.phy_cap_info[6] & 5507 IEEE80211_EHT_PHY_CAP6_EHT_DUP_6GHZ_SUPP) 5508 mcs_mask[0] |= 0x4000; 5509 5510 /* Enable MCS 15 for NSS 0 */ 5511 mcs_mask[0] |= 0x8000; 5512 5513 for (nss = 0; nss < NL80211_EHT_NSS_MAX; nss++) { 5514 if (!mcs_7) 5515 continue; 5516 mcs_mask[nss] |= 0x00FF; 5517 mcs_7--; 5518 5519 if (!mcs_9) 5520 continue; 5521 mcs_mask[nss] |= 0x0300; 5522 mcs_9--; 5523 5524 if (!mcs_11) 5525 continue; 5526 mcs_mask[nss] |= 0x0C00; 5527 mcs_11--; 5528 5529 if (!mcs_13) 5530 continue; 5531 mcs_mask[nss] |= 0x3000; 5532 mcs_13--; 5533 } 5534 } 5535 5536 static bool eht_set_mcs_mask(struct genl_info *info, struct wireless_dev *wdev, 5537 struct ieee80211_supported_band *sband, 5538 struct nl80211_txrate_eht *txrate, 5539 u16 mcs[NL80211_EHT_NSS_MAX]) 5540 { 5541 const struct ieee80211_sta_he_cap *he_cap; 5542 const struct ieee80211_sta_eht_cap *eht_cap; 5543 u16 tx_mcs_mask[NL80211_EHT_NSS_MAX] = { 0 }; 5544 u8 i, mcs_nss_len; 5545 5546 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5547 if (!he_cap) 5548 return false; 5549 5550 eht_cap = ieee80211_get_eht_iftype_cap(sband, wdev->iftype); 5551 if (!eht_cap) 5552 return false; 5553 5554 /* Checks for MCS 14 */ 5555 if (txrate->mcs[0] & 0x4000) { 5556 if (sband->band != NL80211_BAND_6GHZ) 5557 return false; 5558 5559 if (!(eht_cap->eht_cap_elem.phy_cap_info[6] & 5560 IEEE80211_EHT_PHY_CAP6_EHT_DUP_6GHZ_SUPP)) 5561 return false; 5562 } 5563 5564 mcs_nss_len = ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 5565 &eht_cap->eht_cap_elem, 5566 wdev->iftype == 5567 NL80211_IFTYPE_STATION); 5568 5569 if (mcs_nss_len == 3) { 5570 /* Supported iftypes for setting non-20 MHZ only EHT MCS */ 5571 switch (wdev->iftype) { 5572 case NL80211_IFTYPE_ADHOC: 5573 case NL80211_IFTYPE_AP: 5574 case NL80211_IFTYPE_P2P_GO: 5575 case NL80211_IFTYPE_MESH_POINT: 5576 case NL80211_IFTYPE_OCB: 5577 break; 5578 default: 5579 return false; 5580 } 5581 } 5582 5583 /* Build eht_mcs_mask from EHT and HE capabilities */ 5584 eht_build_mcs_mask(info, eht_cap, mcs_nss_len, tx_mcs_mask); 5585 5586 memset(mcs, 0, sizeof(u16) * NL80211_EHT_NSS_MAX); 5587 for (i = 0; i < NL80211_EHT_NSS_MAX; i++) { 5588 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5589 mcs[i] = txrate->mcs[i]; 5590 else 5591 return false; 5592 } 5593 5594 return true; 5595 } 5596 5597 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info, 5598 struct nlattr *attrs[], 5599 enum nl80211_attrs attr, 5600 struct cfg80211_bitrate_mask *mask, 5601 struct net_device *dev, 5602 bool default_all_enabled, 5603 unsigned int link_id) 5604 { 5605 struct nlattr *tb[NL80211_TXRATE_MAX + 1]; 5606 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5607 struct wireless_dev *wdev = dev->ieee80211_ptr; 5608 int rem, i; 5609 struct nlattr *tx_rates; 5610 struct ieee80211_supported_band *sband; 5611 u16 vht_tx_mcs_map, he_tx_mcs_map; 5612 5613 memset(mask, 0, sizeof(*mask)); 5614 /* Default to all rates enabled */ 5615 for (i = 0; i < NUM_NL80211_BANDS; i++) { 5616 const struct ieee80211_sta_he_cap *he_cap; 5617 const struct ieee80211_sta_eht_cap *eht_cap; 5618 u8 mcs_nss_len; 5619 5620 if (!default_all_enabled) 5621 break; 5622 5623 sband = rdev->wiphy.bands[i]; 5624 5625 if (!sband) 5626 continue; 5627 5628 mask->control[i].legacy = (1 << sband->n_bitrates) - 1; 5629 memcpy(mask->control[i].ht_mcs, 5630 sband->ht_cap.mcs.rx_mask, 5631 sizeof(mask->control[i].ht_mcs)); 5632 5633 if (sband->vht_cap.vht_supported) { 5634 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5635 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs); 5636 } 5637 5638 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5639 if (!he_cap) 5640 continue; 5641 5642 he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5643 he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs); 5644 5645 mask->control[i].he_gi = 0xFF; 5646 mask->control[i].he_ltf = 0xFF; 5647 5648 eht_cap = ieee80211_get_eht_iftype_cap(sband, wdev->iftype); 5649 if (!eht_cap) 5650 continue; 5651 5652 mcs_nss_len = ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 5653 &eht_cap->eht_cap_elem, 5654 wdev->iftype == 5655 NL80211_IFTYPE_STATION); 5656 5657 eht_build_mcs_mask(info, eht_cap, mcs_nss_len, 5658 mask->control[i].eht_mcs); 5659 5660 mask->control[i].eht_gi = 0xFF; 5661 mask->control[i].eht_ltf = 0xFF; 5662 } 5663 5664 /* if no rates are given set it back to the defaults */ 5665 if (!attrs[attr]) 5666 goto out; 5667 5668 /* The nested attribute uses enum nl80211_band as the index. This maps 5669 * directly to the enum nl80211_band values used in cfg80211. 5670 */ 5671 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8); 5672 nla_for_each_nested(tx_rates, attrs[attr], rem) { 5673 enum nl80211_band band = nla_type(tx_rates); 5674 int err; 5675 5676 if (band < 0 || band >= NUM_NL80211_BANDS) 5677 return -EINVAL; 5678 sband = rdev->wiphy.bands[band]; 5679 if (sband == NULL) 5680 return -EINVAL; 5681 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX, 5682 tx_rates, 5683 nl80211_txattr_policy, 5684 info->extack); 5685 if (err) 5686 return err; 5687 if (tb[NL80211_TXRATE_LEGACY]) { 5688 mask->control[band].legacy = rateset_to_mask( 5689 sband, 5690 nla_data(tb[NL80211_TXRATE_LEGACY]), 5691 nla_len(tb[NL80211_TXRATE_LEGACY])); 5692 if ((mask->control[band].legacy == 0) && 5693 nla_len(tb[NL80211_TXRATE_LEGACY])) 5694 return -EINVAL; 5695 } 5696 if (tb[NL80211_TXRATE_HT]) { 5697 if (!ht_rateset_to_mask( 5698 sband, 5699 nla_data(tb[NL80211_TXRATE_HT]), 5700 nla_len(tb[NL80211_TXRATE_HT]), 5701 mask->control[band].ht_mcs)) 5702 return -EINVAL; 5703 } 5704 5705 if (tb[NL80211_TXRATE_VHT]) { 5706 if (!vht_set_mcs_mask( 5707 sband, 5708 nla_data(tb[NL80211_TXRATE_VHT]), 5709 mask->control[band].vht_mcs)) 5710 return -EINVAL; 5711 } 5712 5713 if (tb[NL80211_TXRATE_GI]) { 5714 mask->control[band].gi = 5715 nla_get_u8(tb[NL80211_TXRATE_GI]); 5716 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI) 5717 return -EINVAL; 5718 } 5719 if (tb[NL80211_TXRATE_HE] && 5720 !he_set_mcs_mask(info, wdev, sband, 5721 nla_data(tb[NL80211_TXRATE_HE]), 5722 mask->control[band].he_mcs, 5723 link_id)) 5724 return -EINVAL; 5725 5726 if (tb[NL80211_TXRATE_HE_GI]) 5727 mask->control[band].he_gi = 5728 nla_get_u8(tb[NL80211_TXRATE_HE_GI]); 5729 if (tb[NL80211_TXRATE_HE_LTF]) 5730 mask->control[band].he_ltf = 5731 nla_get_u8(tb[NL80211_TXRATE_HE_LTF]); 5732 5733 if (tb[NL80211_TXRATE_EHT] && 5734 !eht_set_mcs_mask(info, wdev, sband, 5735 nla_data(tb[NL80211_TXRATE_EHT]), 5736 mask->control[band].eht_mcs)) 5737 return -EINVAL; 5738 5739 if (tb[NL80211_TXRATE_EHT_GI]) 5740 mask->control[band].eht_gi = 5741 nla_get_u8(tb[NL80211_TXRATE_EHT_GI]); 5742 if (tb[NL80211_TXRATE_EHT_LTF]) 5743 mask->control[band].eht_ltf = 5744 nla_get_u8(tb[NL80211_TXRATE_EHT_LTF]); 5745 5746 if (mask->control[band].legacy == 0) { 5747 /* don't allow empty legacy rates if HT, VHT, HE or EHT 5748 * are not even supported. 5749 */ 5750 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported || 5751 rdev->wiphy.bands[band]->vht_cap.vht_supported || 5752 ieee80211_get_he_iftype_cap(sband, wdev->iftype) || 5753 ieee80211_get_eht_iftype_cap(sband, wdev->iftype))) 5754 return -EINVAL; 5755 5756 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) 5757 if (mask->control[band].ht_mcs[i]) 5758 goto out; 5759 5760 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) 5761 if (mask->control[band].vht_mcs[i]) 5762 goto out; 5763 5764 for (i = 0; i < NL80211_HE_NSS_MAX; i++) 5765 if (mask->control[band].he_mcs[i]) 5766 goto out; 5767 5768 for (i = 0; i < NL80211_EHT_NSS_MAX; i++) 5769 if (mask->control[band].eht_mcs[i]) 5770 goto out; 5771 5772 /* legacy and mcs rates may not be both empty */ 5773 return -EINVAL; 5774 } 5775 } 5776 5777 out: 5778 return 0; 5779 } 5780 5781 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev, 5782 enum nl80211_band band, 5783 struct cfg80211_bitrate_mask *beacon_rate) 5784 { 5785 u32 count_ht, count_vht, count_he, count_eht, i; 5786 u32 rate = beacon_rate->control[band].legacy; 5787 5788 /* Allow only one rate */ 5789 if (hweight32(rate) > 1) 5790 return -EINVAL; 5791 5792 count_ht = 0; 5793 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) { 5794 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) { 5795 return -EINVAL; 5796 } else if (beacon_rate->control[band].ht_mcs[i]) { 5797 count_ht++; 5798 if (count_ht > 1) 5799 return -EINVAL; 5800 } 5801 if (count_ht && rate) 5802 return -EINVAL; 5803 } 5804 5805 count_vht = 0; 5806 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5807 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) { 5808 return -EINVAL; 5809 } else if (beacon_rate->control[band].vht_mcs[i]) { 5810 count_vht++; 5811 if (count_vht > 1) 5812 return -EINVAL; 5813 } 5814 if (count_vht && rate) 5815 return -EINVAL; 5816 } 5817 5818 count_he = 0; 5819 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5820 if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) { 5821 return -EINVAL; 5822 } else if (beacon_rate->control[band].he_mcs[i]) { 5823 count_he++; 5824 if (count_he > 1) 5825 return -EINVAL; 5826 } 5827 if (count_he && rate) 5828 return -EINVAL; 5829 } 5830 5831 count_eht = 0; 5832 for (i = 0; i < NL80211_EHT_NSS_MAX; i++) { 5833 if (hweight16(beacon_rate->control[band].eht_mcs[i]) > 1) { 5834 return -EINVAL; 5835 } else if (beacon_rate->control[band].eht_mcs[i]) { 5836 count_eht++; 5837 if (count_eht > 1) 5838 return -EINVAL; 5839 } 5840 if (count_eht && rate) 5841 return -EINVAL; 5842 } 5843 5844 if ((count_ht && count_vht && count_he && count_eht) || 5845 (!rate && !count_ht && !count_vht && !count_he && !count_eht)) 5846 return -EINVAL; 5847 5848 if (rate && 5849 !wiphy_ext_feature_isset(&rdev->wiphy, 5850 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) 5851 return -EINVAL; 5852 if (count_ht && 5853 !wiphy_ext_feature_isset(&rdev->wiphy, 5854 NL80211_EXT_FEATURE_BEACON_RATE_HT)) 5855 return -EINVAL; 5856 if (count_vht && 5857 !wiphy_ext_feature_isset(&rdev->wiphy, 5858 NL80211_EXT_FEATURE_BEACON_RATE_VHT)) 5859 return -EINVAL; 5860 if (count_he && 5861 !wiphy_ext_feature_isset(&rdev->wiphy, 5862 NL80211_EXT_FEATURE_BEACON_RATE_HE)) 5863 return -EINVAL; 5864 5865 if (count_eht && 5866 !wiphy_ext_feature_isset(&rdev->wiphy, 5867 NL80211_EXT_FEATURE_BEACON_RATE_EHT)) 5868 return -EINVAL; 5869 5870 return 0; 5871 } 5872 5873 static int nl80211_parse_mbssid_config(struct wiphy *wiphy, 5874 struct net_device *dev, 5875 unsigned int link_id, 5876 struct nlattr *attrs, 5877 struct cfg80211_mbssid_config *config, 5878 u8 num_elems) 5879 { 5880 struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1]; 5881 int tx_link_id = -1; 5882 5883 if (!wiphy->mbssid_max_interfaces) 5884 return -EOPNOTSUPP; 5885 5886 if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL, 5887 NULL) || 5888 !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]) 5889 return -EINVAL; 5890 5891 config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]); 5892 if (config->ema) { 5893 if (!wiphy->ema_max_profile_periodicity) 5894 return -EOPNOTSUPP; 5895 5896 if (num_elems > wiphy->ema_max_profile_periodicity) 5897 return -EINVAL; 5898 } 5899 5900 config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]); 5901 if (config->index >= wiphy->mbssid_max_interfaces || 5902 (!config->index && !num_elems)) 5903 return -EINVAL; 5904 5905 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_LINK_ID]) 5906 tx_link_id = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_TX_LINK_ID]); 5907 5908 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) { 5909 u32 tx_ifindex = 5910 nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]); 5911 5912 if ((!config->index && tx_ifindex != dev->ifindex) || 5913 (config->index && tx_ifindex == dev->ifindex)) 5914 return -EINVAL; 5915 5916 if (tx_ifindex != dev->ifindex) { 5917 struct net_device *tx_netdev = 5918 dev_get_by_index(wiphy_net(wiphy), tx_ifindex); 5919 5920 if (!tx_netdev || !tx_netdev->ieee80211_ptr || 5921 tx_netdev->ieee80211_ptr->wiphy != wiphy || 5922 tx_netdev->ieee80211_ptr->iftype != 5923 NL80211_IFTYPE_AP) { 5924 dev_put(tx_netdev); 5925 return -EINVAL; 5926 } 5927 5928 config->tx_wdev = tx_netdev->ieee80211_ptr; 5929 /* Caller should call dev_put(config->tx_wdev) from this point */ 5930 5931 if (config->tx_wdev->valid_links) { 5932 if (tx_link_id == -1 || 5933 !(config->tx_wdev->valid_links & BIT(tx_link_id))) 5934 return -ENOLINK; 5935 5936 config->tx_link_id = tx_link_id; 5937 } 5938 } else { 5939 if (tx_link_id >= 0 && tx_link_id != link_id) 5940 return -EINVAL; 5941 5942 config->tx_wdev = dev->ieee80211_ptr; 5943 } 5944 } else if (!config->index) { 5945 if (tx_link_id >= 0 && tx_link_id != link_id) 5946 return -EINVAL; 5947 5948 config->tx_wdev = dev->ieee80211_ptr; 5949 } else { 5950 return -EINVAL; 5951 } 5952 5953 return 0; 5954 } 5955 5956 static struct cfg80211_mbssid_elems * 5957 nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs) 5958 { 5959 struct nlattr *nl_elems; 5960 struct cfg80211_mbssid_elems *elems; 5961 int rem_elems; 5962 u8 i = 0, num_elems = 0; 5963 5964 if (!wiphy->mbssid_max_interfaces) 5965 return ERR_PTR(-EINVAL); 5966 5967 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5968 if (num_elems >= 255) 5969 return ERR_PTR(-EINVAL); 5970 num_elems++; 5971 } 5972 5973 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5974 if (!elems) 5975 return ERR_PTR(-ENOMEM); 5976 elems->cnt = num_elems; 5977 5978 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5979 elems->elem[i].data = nla_data(nl_elems); 5980 elems->elem[i].len = nla_len(nl_elems); 5981 i++; 5982 } 5983 return elems; 5984 } 5985 5986 static struct cfg80211_rnr_elems * 5987 nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs, 5988 struct netlink_ext_ack *extack) 5989 { 5990 struct nlattr *nl_elems; 5991 struct cfg80211_rnr_elems *elems; 5992 int rem_elems; 5993 u8 i = 0, num_elems = 0; 5994 5995 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5996 int ret; 5997 5998 ret = validate_ie_attr(nl_elems, extack); 5999 if (ret) 6000 return ERR_PTR(ret); 6001 6002 num_elems++; 6003 } 6004 6005 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 6006 if (!elems) 6007 return ERR_PTR(-ENOMEM); 6008 elems->cnt = num_elems; 6009 6010 nla_for_each_nested(nl_elems, attrs, rem_elems) { 6011 elems->elem[i].data = nla_data(nl_elems); 6012 elems->elem[i].len = nla_len(nl_elems); 6013 i++; 6014 } 6015 return elems; 6016 } 6017 6018 static int nl80211_parse_he_bss_color(struct nlattr *attrs, 6019 struct cfg80211_he_bss_color *he_bss_color) 6020 { 6021 struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1]; 6022 int err; 6023 6024 err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs, 6025 he_bss_color_policy, NULL); 6026 if (err) 6027 return err; 6028 6029 if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]) 6030 return -EINVAL; 6031 6032 he_bss_color->color = 6033 nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]); 6034 he_bss_color->enabled = 6035 !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]); 6036 he_bss_color->partial = 6037 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]); 6038 6039 return 0; 6040 } 6041 6042 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev, 6043 struct nlattr *attrs[], 6044 struct cfg80211_beacon_data *bcn, 6045 struct netlink_ext_ack *extack) 6046 { 6047 bool haveinfo = false; 6048 int err; 6049 6050 memset(bcn, 0, sizeof(*bcn)); 6051 6052 bcn->link_id = nl80211_link_id(attrs); 6053 6054 if (attrs[NL80211_ATTR_BEACON_HEAD]) { 6055 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]); 6056 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]); 6057 if (!bcn->head_len) 6058 return -EINVAL; 6059 haveinfo = true; 6060 } 6061 6062 if (attrs[NL80211_ATTR_BEACON_TAIL]) { 6063 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]); 6064 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]); 6065 haveinfo = true; 6066 } 6067 6068 if (!haveinfo) 6069 return -EINVAL; 6070 6071 if (attrs[NL80211_ATTR_IE]) { 6072 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]); 6073 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]); 6074 } 6075 6076 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) { 6077 bcn->proberesp_ies = 6078 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]); 6079 bcn->proberesp_ies_len = 6080 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]); 6081 } 6082 6083 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) { 6084 bcn->assocresp_ies = 6085 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 6086 bcn->assocresp_ies_len = 6087 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 6088 } 6089 6090 if (attrs[NL80211_ATTR_PROBE_RESP]) { 6091 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]); 6092 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]); 6093 } 6094 6095 if (attrs[NL80211_ATTR_FTM_RESPONDER]) { 6096 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1]; 6097 6098 err = nla_parse_nested_deprecated(tb, 6099 NL80211_FTM_RESP_ATTR_MAX, 6100 attrs[NL80211_ATTR_FTM_RESPONDER], 6101 NULL, NULL); 6102 if (err) 6103 return err; 6104 6105 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] && 6106 wiphy_ext_feature_isset(&rdev->wiphy, 6107 NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER)) 6108 bcn->ftm_responder = 1; 6109 else 6110 return -EOPNOTSUPP; 6111 6112 if (tb[NL80211_FTM_RESP_ATTR_LCI]) { 6113 bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]); 6114 bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]); 6115 } 6116 6117 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) { 6118 bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 6119 bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 6120 } 6121 } else { 6122 bcn->ftm_responder = -1; 6123 } 6124 6125 if (attrs[NL80211_ATTR_HE_BSS_COLOR]) { 6126 err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR], 6127 &bcn->he_bss_color); 6128 if (err) 6129 return err; 6130 bcn->he_bss_color_valid = true; 6131 } 6132 6133 if (attrs[NL80211_ATTR_MBSSID_ELEMS]) { 6134 struct cfg80211_mbssid_elems *mbssid = 6135 nl80211_parse_mbssid_elems(&rdev->wiphy, 6136 attrs[NL80211_ATTR_MBSSID_ELEMS]); 6137 6138 if (IS_ERR(mbssid)) 6139 return PTR_ERR(mbssid); 6140 6141 bcn->mbssid_ies = mbssid; 6142 6143 if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) { 6144 struct cfg80211_rnr_elems *rnr = 6145 nl80211_parse_rnr_elems(&rdev->wiphy, 6146 attrs[NL80211_ATTR_EMA_RNR_ELEMS], 6147 extack); 6148 6149 if (IS_ERR(rnr)) 6150 return PTR_ERR(rnr); 6151 6152 if (rnr && rnr->cnt < bcn->mbssid_ies->cnt) 6153 return -EINVAL; 6154 6155 bcn->rnr_ies = rnr; 6156 } 6157 } 6158 6159 return 0; 6160 } 6161 6162 static int nl80211_parse_he_obss_pd(struct nlattr *attrs, 6163 struct ieee80211_he_obss_pd *he_obss_pd) 6164 { 6165 struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1]; 6166 int err; 6167 6168 err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs, 6169 he_obss_pd_policy, NULL); 6170 if (err) 6171 return err; 6172 6173 if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]) 6174 return -EINVAL; 6175 6176 he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]); 6177 6178 if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]) 6179 he_obss_pd->min_offset = 6180 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]); 6181 if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]) 6182 he_obss_pd->max_offset = 6183 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]); 6184 if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]) 6185 he_obss_pd->non_srg_max_offset = 6186 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]); 6187 6188 if (he_obss_pd->min_offset > he_obss_pd->max_offset) 6189 return -EINVAL; 6190 6191 if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]) 6192 memcpy(he_obss_pd->bss_color_bitmap, 6193 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]), 6194 sizeof(he_obss_pd->bss_color_bitmap)); 6195 6196 if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]) 6197 memcpy(he_obss_pd->partial_bssid_bitmap, 6198 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]), 6199 sizeof(he_obss_pd->partial_bssid_bitmap)); 6200 6201 he_obss_pd->enable = true; 6202 6203 return 0; 6204 } 6205 6206 static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev, 6207 struct nlattr *attrs, 6208 struct cfg80211_fils_discovery *fd) 6209 { 6210 struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1]; 6211 int ret; 6212 6213 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6214 NL80211_EXT_FEATURE_FILS_DISCOVERY)) 6215 return -EINVAL; 6216 6217 ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs, 6218 NULL, NULL); 6219 if (ret) 6220 return ret; 6221 6222 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] && 6223 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] && 6224 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) { 6225 fd->update = true; 6226 return 0; 6227 } 6228 6229 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] || 6230 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] || 6231 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) 6232 return -EINVAL; 6233 6234 fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 6235 fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 6236 fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]); 6237 fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]); 6238 fd->update = true; 6239 return 0; 6240 } 6241 6242 static int 6243 nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev, 6244 struct nlattr *attrs, 6245 struct cfg80211_unsol_bcast_probe_resp *presp) 6246 { 6247 struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1]; 6248 int ret; 6249 6250 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6251 NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP)) 6252 return -EINVAL; 6253 6254 ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX, 6255 attrs, NULL, NULL); 6256 if (ret) 6257 return ret; 6258 6259 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] && 6260 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) { 6261 presp->update = true; 6262 return 0; 6263 } 6264 6265 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] || 6266 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) 6267 return -EINVAL; 6268 6269 presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 6270 presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 6271 presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]); 6272 presp->update = true; 6273 return 0; 6274 } 6275 6276 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params, 6277 const struct element *rates) 6278 { 6279 int i; 6280 6281 if (!rates) 6282 return; 6283 6284 for (i = 0; i < rates->datalen; i++) { 6285 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY) 6286 params->ht_required = true; 6287 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY) 6288 params->vht_required = true; 6289 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY) 6290 params->he_required = true; 6291 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E) 6292 params->sae_h2e_required = true; 6293 } 6294 } 6295 6296 /* 6297 * Since the nl80211 API didn't include, from the beginning, attributes about 6298 * HT/VHT requirements/capabilities, we parse them out of the IEs for the 6299 * benefit of drivers that rebuild IEs in the firmware. 6300 */ 6301 static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params) 6302 { 6303 const struct cfg80211_beacon_data *bcn = ¶ms->beacon; 6304 size_t ies_len = bcn->tail_len; 6305 const u8 *ies = bcn->tail; 6306 const struct element *rates; 6307 const struct element *cap; 6308 6309 rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len); 6310 nl80211_check_ap_rate_selectors(params, rates); 6311 6312 rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len); 6313 nl80211_check_ap_rate_selectors(params, rates); 6314 6315 cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len); 6316 if (cap && cap->datalen >= sizeof(*params->ht_cap)) 6317 params->ht_cap = (void *)cap->data; 6318 cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len); 6319 if (cap && cap->datalen >= sizeof(*params->vht_cap)) 6320 params->vht_cap = (void *)cap->data; 6321 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len); 6322 if (cap && cap->datalen >= sizeof(*params->he_cap) + 1) 6323 params->he_cap = (void *)(cap->data + 1); 6324 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len); 6325 if (cap && cap->datalen >= sizeof(*params->he_oper) + 1) 6326 params->he_oper = (void *)(cap->data + 1); 6327 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len); 6328 if (cap) { 6329 if (!cap->datalen) 6330 return -EINVAL; 6331 params->eht_cap = (void *)(cap->data + 1); 6332 if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap, 6333 (const u8 *)params->eht_cap, 6334 cap->datalen - 1, true)) 6335 return -EINVAL; 6336 } 6337 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len); 6338 if (cap) { 6339 if (!cap->datalen) 6340 return -EINVAL; 6341 params->eht_oper = (void *)(cap->data + 1); 6342 if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper, 6343 cap->datalen - 1)) 6344 return -EINVAL; 6345 } 6346 return 0; 6347 } 6348 6349 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev, 6350 struct cfg80211_ap_settings *params) 6351 { 6352 struct wireless_dev *wdev; 6353 6354 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 6355 if (wdev->iftype != NL80211_IFTYPE_AP && 6356 wdev->iftype != NL80211_IFTYPE_P2P_GO) 6357 continue; 6358 6359 if (!wdev->u.ap.preset_chandef.chan) 6360 continue; 6361 6362 params->chandef = wdev->u.ap.preset_chandef; 6363 return true; 6364 } 6365 6366 return false; 6367 } 6368 6369 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev, 6370 enum nl80211_auth_type auth_type, 6371 enum nl80211_commands cmd) 6372 { 6373 if (auth_type > NL80211_AUTHTYPE_MAX) 6374 return false; 6375 6376 switch (cmd) { 6377 case NL80211_CMD_AUTHENTICATE: 6378 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 6379 auth_type == NL80211_AUTHTYPE_SAE) 6380 return false; 6381 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6382 NL80211_EXT_FEATURE_FILS_STA) && 6383 (auth_type == NL80211_AUTHTYPE_FILS_SK || 6384 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6385 auth_type == NL80211_AUTHTYPE_FILS_PK)) 6386 return false; 6387 return true; 6388 case NL80211_CMD_CONNECT: 6389 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 6390 !wiphy_ext_feature_isset(&rdev->wiphy, 6391 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 6392 auth_type == NL80211_AUTHTYPE_SAE) 6393 return false; 6394 6395 /* FILS with SK PFS or PK not supported yet */ 6396 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6397 auth_type == NL80211_AUTHTYPE_FILS_PK) 6398 return false; 6399 if (!wiphy_ext_feature_isset( 6400 &rdev->wiphy, 6401 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 6402 auth_type == NL80211_AUTHTYPE_FILS_SK) 6403 return false; 6404 return true; 6405 case NL80211_CMD_START_AP: 6406 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6407 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) && 6408 auth_type == NL80211_AUTHTYPE_SAE) 6409 return false; 6410 /* FILS not supported yet */ 6411 if (auth_type == NL80211_AUTHTYPE_FILS_SK || 6412 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6413 auth_type == NL80211_AUTHTYPE_FILS_PK) 6414 return false; 6415 return true; 6416 default: 6417 return false; 6418 } 6419 } 6420 6421 static void nl80211_send_ap_started(struct wireless_dev *wdev, 6422 unsigned int link_id) 6423 { 6424 struct wiphy *wiphy = wdev->wiphy; 6425 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 6426 struct sk_buff *msg; 6427 void *hdr; 6428 6429 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6430 if (!msg) 6431 return; 6432 6433 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP); 6434 if (!hdr) 6435 goto out; 6436 6437 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 6438 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 6439 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 6440 NL80211_ATTR_PAD) || 6441 (wdev->u.ap.ssid_len && 6442 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 6443 wdev->u.ap.ssid)) || 6444 (wdev->valid_links && 6445 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 6446 goto out; 6447 6448 genlmsg_end(msg, hdr); 6449 6450 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 6451 NL80211_MCGRP_MLME, GFP_KERNEL); 6452 return; 6453 out: 6454 nlmsg_free(msg); 6455 } 6456 6457 static int nl80211_validate_ap_phy_operation(struct cfg80211_ap_settings *params) 6458 { 6459 struct ieee80211_channel *channel = params->chandef.chan; 6460 6461 if ((params->he_cap || params->he_oper) && 6462 (channel->flags & IEEE80211_CHAN_NO_HE)) 6463 return -EOPNOTSUPP; 6464 6465 if ((params->eht_cap || params->eht_oper) && 6466 (channel->flags & IEEE80211_CHAN_NO_EHT)) 6467 return -EOPNOTSUPP; 6468 6469 return 0; 6470 } 6471 6472 static int 6473 nl80211_parse_s1g_short_beacon(struct cfg80211_registered_device *rdev, 6474 struct nlattr *attrs, 6475 struct cfg80211_s1g_short_beacon *sb) 6476 { 6477 struct nlattr *tb[NL80211_S1G_SHORT_BEACON_ATTR_MAX + 1]; 6478 int ret; 6479 6480 if (!rdev->wiphy.bands[NL80211_BAND_S1GHZ]) 6481 return -EINVAL; 6482 6483 ret = nla_parse_nested(tb, NL80211_S1G_SHORT_BEACON_ATTR_MAX, attrs, 6484 NULL, NULL); 6485 if (ret) 6486 return ret; 6487 6488 /* Short beacon tail is optional (i.e might only include the TIM) */ 6489 if (!tb[NL80211_S1G_SHORT_BEACON_ATTR_HEAD]) 6490 return -EINVAL; 6491 6492 sb->short_head = nla_data(tb[NL80211_S1G_SHORT_BEACON_ATTR_HEAD]); 6493 sb->short_head_len = nla_len(tb[NL80211_S1G_SHORT_BEACON_ATTR_HEAD]); 6494 sb->short_tail_len = 0; 6495 6496 if (tb[NL80211_S1G_SHORT_BEACON_ATTR_TAIL]) { 6497 sb->short_tail = 6498 nla_data(tb[NL80211_S1G_SHORT_BEACON_ATTR_TAIL]); 6499 sb->short_tail_len = 6500 nla_len(tb[NL80211_S1G_SHORT_BEACON_ATTR_TAIL]); 6501 } 6502 6503 sb->update = true; 6504 return 0; 6505 } 6506 6507 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info) 6508 { 6509 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6510 struct cfg80211_beaconing_check_config beacon_check = {}; 6511 unsigned int link_id = nl80211_link_id(info->attrs); 6512 struct net_device *dev = info->user_ptr[1]; 6513 struct wireless_dev *wdev = dev->ieee80211_ptr; 6514 struct cfg80211_ap_settings *params; 6515 int err; 6516 6517 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6518 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6519 return -EOPNOTSUPP; 6520 6521 if (!rdev->ops->start_ap) 6522 return -EOPNOTSUPP; 6523 6524 if (wdev->links[link_id].cac_started) 6525 return -EBUSY; 6526 6527 if (wdev->links[link_id].ap.beacon_interval) 6528 return -EALREADY; 6529 6530 /* these are required for START_AP */ 6531 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] || 6532 !info->attrs[NL80211_ATTR_DTIM_PERIOD] || 6533 !info->attrs[NL80211_ATTR_BEACON_HEAD]) 6534 return -EINVAL; 6535 6536 if (info->attrs[NL80211_ATTR_SMPS_MODE] && 6537 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]) != NL80211_SMPS_OFF) 6538 return -EOPNOTSUPP; 6539 6540 params = kzalloc(sizeof(*params), GFP_KERNEL); 6541 if (!params) 6542 return -ENOMEM; 6543 6544 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6545 info->extack); 6546 if (err) 6547 goto out; 6548 6549 params->beacon_interval = 6550 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 6551 params->dtim_period = 6552 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 6553 6554 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype, 6555 params->beacon_interval); 6556 if (err) 6557 goto out; 6558 6559 /* 6560 * In theory, some of these attributes should be required here 6561 * but since they were not used when the command was originally 6562 * added, keep them optional for old user space programs to let 6563 * them continue to work with drivers that do not need the 6564 * additional information -- drivers must check! 6565 */ 6566 if (info->attrs[NL80211_ATTR_SSID]) { 6567 params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 6568 params->ssid_len = 6569 nla_len(info->attrs[NL80211_ATTR_SSID]); 6570 if (params->ssid_len == 0) { 6571 err = -EINVAL; 6572 goto out; 6573 } 6574 6575 if (wdev->u.ap.ssid_len && 6576 (wdev->u.ap.ssid_len != params->ssid_len || 6577 memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) { 6578 /* require identical SSID for MLO */ 6579 err = -EINVAL; 6580 goto out; 6581 } 6582 } else if (wdev->valid_links) { 6583 /* require SSID for MLO */ 6584 err = -EINVAL; 6585 goto out; 6586 } 6587 6588 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) 6589 params->hidden_ssid = nla_get_u32( 6590 info->attrs[NL80211_ATTR_HIDDEN_SSID]); 6591 6592 params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 6593 6594 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 6595 params->auth_type = nla_get_u32( 6596 info->attrs[NL80211_ATTR_AUTH_TYPE]); 6597 if (!nl80211_valid_auth_type(rdev, params->auth_type, 6598 NL80211_CMD_START_AP)) { 6599 err = -EINVAL; 6600 goto out; 6601 } 6602 } else 6603 params->auth_type = NL80211_AUTHTYPE_AUTOMATIC; 6604 6605 err = nl80211_crypto_settings(rdev, info, ¶ms->crypto, 6606 NL80211_MAX_NR_CIPHER_SUITES); 6607 if (err) 6608 goto out; 6609 6610 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) { 6611 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) { 6612 err = -EOPNOTSUPP; 6613 goto out; 6614 } 6615 params->inactivity_timeout = nla_get_u16( 6616 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]); 6617 } 6618 6619 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 6620 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6621 err = -EINVAL; 6622 goto out; 6623 } 6624 params->p2p_ctwindow = 6625 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 6626 if (params->p2p_ctwindow != 0 && 6627 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) { 6628 err = -EINVAL; 6629 goto out; 6630 } 6631 } 6632 6633 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 6634 u8 tmp; 6635 6636 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6637 err = -EINVAL; 6638 goto out; 6639 } 6640 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 6641 params->p2p_opp_ps = tmp; 6642 if (params->p2p_opp_ps != 0 && 6643 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) { 6644 err = -EINVAL; 6645 goto out; 6646 } 6647 } 6648 6649 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 6650 err = nl80211_parse_chandef(rdev, info, ¶ms->chandef); 6651 if (err) 6652 goto out; 6653 } else if (wdev->valid_links) { 6654 /* with MLD need to specify the channel configuration */ 6655 err = -EINVAL; 6656 goto out; 6657 } else if (wdev->u.ap.preset_chandef.chan) { 6658 params->chandef = wdev->u.ap.preset_chandef; 6659 } else if (!nl80211_get_ap_channel(rdev, params)) { 6660 err = -EINVAL; 6661 goto out; 6662 } 6663 6664 beacon_check.iftype = wdev->iftype; 6665 beacon_check.relax = true; 6666 beacon_check.reg_power = 6667 cfg80211_get_6ghz_power_type(params->beacon.tail, 6668 params->beacon.tail_len); 6669 if (!cfg80211_reg_check_beaconing(&rdev->wiphy, ¶ms->chandef, 6670 &beacon_check)) { 6671 err = -EINVAL; 6672 goto out; 6673 } 6674 6675 if (info->attrs[NL80211_ATTR_TX_RATES]) { 6676 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 6677 NL80211_ATTR_TX_RATES, 6678 ¶ms->beacon_rate, 6679 dev, false, link_id); 6680 if (err) 6681 goto out; 6682 6683 err = validate_beacon_tx_rate(rdev, params->chandef.chan->band, 6684 ¶ms->beacon_rate); 6685 if (err) 6686 goto out; 6687 } 6688 6689 params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 6690 if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 6691 err = -EOPNOTSUPP; 6692 goto out; 6693 } 6694 6695 if (info->attrs[NL80211_ATTR_ACL_POLICY]) { 6696 params->acl = parse_acl_data(&rdev->wiphy, info); 6697 if (IS_ERR(params->acl)) { 6698 err = PTR_ERR(params->acl); 6699 params->acl = NULL; 6700 goto out; 6701 } 6702 } 6703 6704 params->twt_responder = 6705 nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]); 6706 6707 if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) { 6708 err = nl80211_parse_he_obss_pd( 6709 info->attrs[NL80211_ATTR_HE_OBSS_PD], 6710 ¶ms->he_obss_pd); 6711 if (err) 6712 goto out; 6713 } 6714 6715 if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) { 6716 err = nl80211_parse_fils_discovery(rdev, 6717 info->attrs[NL80211_ATTR_FILS_DISCOVERY], 6718 ¶ms->fils_discovery); 6719 if (err) 6720 goto out; 6721 } 6722 6723 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 6724 err = nl80211_parse_unsol_bcast_probe_resp( 6725 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 6726 ¶ms->unsol_bcast_probe_resp); 6727 if (err) 6728 goto out; 6729 } 6730 6731 if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) { 6732 err = nl80211_parse_mbssid_config(&rdev->wiphy, dev, link_id, 6733 info->attrs[NL80211_ATTR_MBSSID_CONFIG], 6734 ¶ms->mbssid_config, 6735 params->beacon.mbssid_ies ? 6736 params->beacon.mbssid_ies->cnt : 6737 0); 6738 if (err) 6739 goto out; 6740 } 6741 6742 if (!params->mbssid_config.ema && params->beacon.rnr_ies) { 6743 err = -EINVAL; 6744 goto out; 6745 } 6746 6747 if (info->attrs[NL80211_ATTR_S1G_SHORT_BEACON]) { 6748 if (!info->attrs[NL80211_ATTR_S1G_LONG_BEACON_PERIOD]) { 6749 err = -EINVAL; 6750 goto out; 6751 } 6752 6753 params->s1g_long_beacon_period = nla_get_u8( 6754 info->attrs[NL80211_ATTR_S1G_LONG_BEACON_PERIOD]); 6755 6756 err = nl80211_parse_s1g_short_beacon( 6757 rdev, info->attrs[NL80211_ATTR_S1G_SHORT_BEACON], 6758 ¶ms->s1g_short_beacon); 6759 if (err) 6760 goto out; 6761 } 6762 6763 err = nl80211_calculate_ap_params(params); 6764 if (err) 6765 goto out; 6766 6767 err = nl80211_validate_ap_phy_operation(params); 6768 if (err) 6769 goto out; 6770 6771 if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]) 6772 params->flags = nla_get_u32( 6773 info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]); 6774 else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT]) 6775 params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT; 6776 6777 if (wdev->conn_owner_nlportid && 6778 info->attrs[NL80211_ATTR_SOCKET_OWNER] && 6779 wdev->conn_owner_nlportid != info->snd_portid) { 6780 err = -EINVAL; 6781 goto out; 6782 } 6783 6784 /* FIXME: validate MLO/link-id against driver capabilities */ 6785 6786 err = rdev_start_ap(rdev, dev, params); 6787 if (!err) { 6788 wdev->links[link_id].ap.beacon_interval = params->beacon_interval; 6789 wdev->links[link_id].ap.chandef = params->chandef; 6790 wdev->u.ap.ssid_len = params->ssid_len; 6791 memcpy(wdev->u.ap.ssid, params->ssid, 6792 params->ssid_len); 6793 6794 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 6795 wdev->conn_owner_nlportid = info->snd_portid; 6796 6797 nl80211_send_ap_started(wdev, link_id); 6798 } 6799 out: 6800 kfree(params->acl); 6801 kfree(params->beacon.mbssid_ies); 6802 if (params->mbssid_config.tx_wdev && 6803 params->mbssid_config.tx_wdev->netdev && 6804 params->mbssid_config.tx_wdev->netdev != dev) 6805 dev_put(params->mbssid_config.tx_wdev->netdev); 6806 kfree(params->beacon.rnr_ies); 6807 kfree(params); 6808 6809 return err; 6810 } 6811 6812 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info) 6813 { 6814 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6815 struct cfg80211_beaconing_check_config beacon_check = {}; 6816 unsigned int link_id = nl80211_link_id(info->attrs); 6817 struct net_device *dev = info->user_ptr[1]; 6818 struct wireless_dev *wdev = dev->ieee80211_ptr; 6819 struct cfg80211_ap_update *params; 6820 struct nlattr *attr; 6821 int err; 6822 6823 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6824 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6825 return -EOPNOTSUPP; 6826 6827 if (!rdev->ops->change_beacon) 6828 return -EOPNOTSUPP; 6829 6830 if (!wdev->links[link_id].ap.beacon_interval) 6831 return -EINVAL; 6832 6833 params = kzalloc(sizeof(*params), GFP_KERNEL); 6834 if (!params) 6835 return -ENOMEM; 6836 6837 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6838 info->extack); 6839 if (err) 6840 goto out; 6841 6842 /* recheck beaconing is permitted with possibly changed power type */ 6843 beacon_check.iftype = wdev->iftype; 6844 beacon_check.relax = true; 6845 beacon_check.reg_power = 6846 cfg80211_get_6ghz_power_type(params->beacon.tail, 6847 params->beacon.tail_len); 6848 if (!cfg80211_reg_check_beaconing(&rdev->wiphy, 6849 &wdev->links[link_id].ap.chandef, 6850 &beacon_check)) { 6851 err = -EINVAL; 6852 goto out; 6853 } 6854 6855 attr = info->attrs[NL80211_ATTR_FILS_DISCOVERY]; 6856 if (attr) { 6857 err = nl80211_parse_fils_discovery(rdev, attr, 6858 ¶ms->fils_discovery); 6859 if (err) 6860 goto out; 6861 } 6862 6863 attr = info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]; 6864 if (attr) { 6865 err = nl80211_parse_unsol_bcast_probe_resp(rdev, attr, 6866 ¶ms->unsol_bcast_probe_resp); 6867 if (err) 6868 goto out; 6869 } 6870 6871 attr = info->attrs[NL80211_ATTR_S1G_SHORT_BEACON]; 6872 if (attr) { 6873 err = nl80211_parse_s1g_short_beacon(rdev, attr, 6874 ¶ms->s1g_short_beacon); 6875 if (err) 6876 goto out; 6877 } 6878 6879 err = rdev_change_beacon(rdev, dev, params); 6880 6881 out: 6882 kfree(params->beacon.mbssid_ies); 6883 kfree(params->beacon.rnr_ies); 6884 kfree(params); 6885 return err; 6886 } 6887 6888 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info) 6889 { 6890 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6891 unsigned int link_id = nl80211_link_id(info->attrs); 6892 struct net_device *dev = info->user_ptr[1]; 6893 6894 return cfg80211_stop_ap(rdev, dev, link_id, false); 6895 } 6896 6897 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = { 6898 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG }, 6899 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG }, 6900 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG }, 6901 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG }, 6902 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG }, 6903 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG }, 6904 }; 6905 6906 static int parse_station_flags(struct genl_info *info, 6907 enum nl80211_iftype iftype, 6908 struct station_parameters *params) 6909 { 6910 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1]; 6911 struct nlattr *nla; 6912 int flag; 6913 6914 /* 6915 * Try parsing the new attribute first so userspace 6916 * can specify both for older kernels. 6917 */ 6918 nla = info->attrs[NL80211_ATTR_STA_FLAGS2]; 6919 if (nla) { 6920 struct nl80211_sta_flag_update *sta_flags; 6921 6922 sta_flags = nla_data(nla); 6923 params->sta_flags_mask = sta_flags->mask; 6924 params->sta_flags_set = sta_flags->set; 6925 params->sta_flags_set &= params->sta_flags_mask; 6926 if ((params->sta_flags_mask | 6927 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID)) 6928 return -EINVAL; 6929 return 0; 6930 } 6931 6932 /* if present, parse the old attribute */ 6933 6934 nla = info->attrs[NL80211_ATTR_STA_FLAGS]; 6935 if (!nla) 6936 return 0; 6937 6938 if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack)) 6939 return -EINVAL; 6940 6941 /* 6942 * Only allow certain flags for interface types so that 6943 * other attributes are silently ignored. Remember that 6944 * this is backward compatibility code with old userspace 6945 * and shouldn't be hit in other cases anyway. 6946 */ 6947 switch (iftype) { 6948 case NL80211_IFTYPE_AP: 6949 case NL80211_IFTYPE_AP_VLAN: 6950 case NL80211_IFTYPE_P2P_GO: 6951 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6952 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6953 BIT(NL80211_STA_FLAG_WME) | 6954 BIT(NL80211_STA_FLAG_MFP); 6955 break; 6956 case NL80211_IFTYPE_P2P_CLIENT: 6957 case NL80211_IFTYPE_STATION: 6958 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6959 BIT(NL80211_STA_FLAG_TDLS_PEER); 6960 break; 6961 case NL80211_IFTYPE_MESH_POINT: 6962 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6963 BIT(NL80211_STA_FLAG_MFP) | 6964 BIT(NL80211_STA_FLAG_AUTHORIZED); 6965 break; 6966 default: 6967 return -EINVAL; 6968 } 6969 6970 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) { 6971 if (flags[flag]) { 6972 params->sta_flags_set |= (1<<flag); 6973 6974 /* no longer support new API additions in old API */ 6975 if (flag > NL80211_STA_FLAG_MAX_OLD_API) 6976 return -EINVAL; 6977 } 6978 } 6979 6980 return 0; 6981 } 6982 6983 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr) 6984 { 6985 struct nlattr *rate; 6986 u32 bitrate; 6987 u16 bitrate_compat; 6988 enum nl80211_rate_info rate_flg; 6989 6990 rate = nla_nest_start_noflag(msg, attr); 6991 if (!rate) 6992 return false; 6993 6994 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */ 6995 bitrate = cfg80211_calculate_bitrate(info); 6996 /* report 16-bit bitrate only if we can */ 6997 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0; 6998 if (bitrate > 0 && 6999 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate)) 7000 return false; 7001 if (bitrate_compat > 0 && 7002 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat)) 7003 return false; 7004 7005 switch (info->bw) { 7006 case RATE_INFO_BW_1: 7007 rate_flg = NL80211_RATE_INFO_1_MHZ_WIDTH; 7008 break; 7009 case RATE_INFO_BW_2: 7010 rate_flg = NL80211_RATE_INFO_2_MHZ_WIDTH; 7011 break; 7012 case RATE_INFO_BW_4: 7013 rate_flg = NL80211_RATE_INFO_4_MHZ_WIDTH; 7014 break; 7015 case RATE_INFO_BW_5: 7016 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH; 7017 break; 7018 case RATE_INFO_BW_8: 7019 rate_flg = NL80211_RATE_INFO_8_MHZ_WIDTH; 7020 break; 7021 case RATE_INFO_BW_10: 7022 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH; 7023 break; 7024 case RATE_INFO_BW_16: 7025 rate_flg = NL80211_RATE_INFO_16_MHZ_WIDTH; 7026 break; 7027 default: 7028 WARN_ON(1); 7029 fallthrough; 7030 case RATE_INFO_BW_20: 7031 rate_flg = 0; 7032 break; 7033 case RATE_INFO_BW_40: 7034 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH; 7035 break; 7036 case RATE_INFO_BW_80: 7037 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH; 7038 break; 7039 case RATE_INFO_BW_160: 7040 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH; 7041 break; 7042 case RATE_INFO_BW_HE_RU: 7043 rate_flg = 0; 7044 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS)); 7045 break; 7046 case RATE_INFO_BW_320: 7047 rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH; 7048 break; 7049 case RATE_INFO_BW_EHT_RU: 7050 rate_flg = 0; 7051 WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS)); 7052 break; 7053 } 7054 7055 if (rate_flg && nla_put_flag(msg, rate_flg)) 7056 return false; 7057 7058 if (info->flags & RATE_INFO_FLAGS_MCS) { 7059 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs)) 7060 return false; 7061 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 7062 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 7063 return false; 7064 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) { 7065 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs)) 7066 return false; 7067 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss)) 7068 return false; 7069 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 7070 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 7071 return false; 7072 } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) { 7073 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs)) 7074 return false; 7075 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss)) 7076 return false; 7077 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi)) 7078 return false; 7079 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm)) 7080 return false; 7081 if (info->bw == RATE_INFO_BW_HE_RU && 7082 nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC, 7083 info->he_ru_alloc)) 7084 return false; 7085 } else if (info->flags & RATE_INFO_FLAGS_S1G_MCS) { 7086 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_MCS, info->mcs)) 7087 return false; 7088 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_NSS, info->nss)) 7089 return false; 7090 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 7091 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 7092 return false; 7093 } else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) { 7094 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs)) 7095 return false; 7096 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss)) 7097 return false; 7098 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi)) 7099 return false; 7100 if (info->bw == RATE_INFO_BW_EHT_RU && 7101 nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC, 7102 info->eht_ru_alloc)) 7103 return false; 7104 } 7105 7106 nla_nest_end(msg, rate); 7107 return true; 7108 } 7109 7110 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal, 7111 int id) 7112 { 7113 void *attr; 7114 int i = 0; 7115 7116 if (!mask) 7117 return true; 7118 7119 attr = nla_nest_start_noflag(msg, id); 7120 if (!attr) 7121 return false; 7122 7123 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { 7124 if (!(mask & BIT(i))) 7125 continue; 7126 7127 if (nla_put_u8(msg, i, signal[i])) 7128 return false; 7129 } 7130 7131 nla_nest_end(msg, attr); 7132 7133 return true; 7134 } 7135 7136 static int nl80211_fill_link_station(struct sk_buff *msg, 7137 struct cfg80211_registered_device *rdev, 7138 struct link_station_info *link_sinfo) 7139 { 7140 struct nlattr *bss_param, *link_sinfoattr; 7141 7142 #define PUT_LINK_SINFO(attr, memb, type) do { \ 7143 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 7144 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7145 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 7146 link_sinfo->memb)) \ 7147 goto nla_put_failure; \ 7148 } while (0) 7149 #define PUT_LINK_SINFO_U64(attr, memb) do { \ 7150 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7151 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 7152 link_sinfo->memb, NL80211_STA_INFO_PAD)) \ 7153 goto nla_put_failure; \ 7154 } while (0) 7155 7156 link_sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 7157 if (!link_sinfoattr) 7158 goto nla_put_failure; 7159 7160 PUT_LINK_SINFO(INACTIVE_TIME, inactive_time, u32); 7161 7162 if (link_sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 7163 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 7164 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 7165 (u32)link_sinfo->rx_bytes)) 7166 goto nla_put_failure; 7167 7168 if (link_sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 7169 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 7170 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 7171 (u32)link_sinfo->tx_bytes)) 7172 goto nla_put_failure; 7173 7174 PUT_LINK_SINFO_U64(RX_BYTES64, rx_bytes); 7175 PUT_LINK_SINFO_U64(TX_BYTES64, tx_bytes); 7176 PUT_LINK_SINFO_U64(RX_DURATION, rx_duration); 7177 PUT_LINK_SINFO_U64(TX_DURATION, tx_duration); 7178 7179 if (wiphy_ext_feature_isset(&rdev->wiphy, 7180 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7181 PUT_LINK_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 7182 7183 switch (rdev->wiphy.signal_type) { 7184 case CFG80211_SIGNAL_TYPE_MBM: 7185 PUT_LINK_SINFO(SIGNAL, signal, u8); 7186 PUT_LINK_SINFO(SIGNAL_AVG, signal_avg, u8); 7187 break; 7188 default: 7189 break; 7190 } 7191 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 7192 if (!nl80211_put_signal(msg, link_sinfo->chains, 7193 link_sinfo->chain_signal, 7194 NL80211_STA_INFO_CHAIN_SIGNAL)) 7195 goto nla_put_failure; 7196 } 7197 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 7198 if (!nl80211_put_signal(msg, link_sinfo->chains, 7199 link_sinfo->chain_signal_avg, 7200 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 7201 goto nla_put_failure; 7202 } 7203 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 7204 if (!nl80211_put_sta_rate(msg, &link_sinfo->txrate, 7205 NL80211_STA_INFO_TX_BITRATE)) 7206 goto nla_put_failure; 7207 } 7208 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 7209 if (!nl80211_put_sta_rate(msg, &link_sinfo->rxrate, 7210 NL80211_STA_INFO_RX_BITRATE)) 7211 goto nla_put_failure; 7212 } 7213 7214 PUT_LINK_SINFO(RX_PACKETS, rx_packets, u32); 7215 PUT_LINK_SINFO(TX_PACKETS, tx_packets, u32); 7216 PUT_LINK_SINFO(TX_RETRIES, tx_retries, u32); 7217 PUT_LINK_SINFO(TX_FAILED, tx_failed, u32); 7218 PUT_LINK_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 7219 PUT_LINK_SINFO(BEACON_LOSS, beacon_loss_count, u32); 7220 7221 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 7222 bss_param = nla_nest_start_noflag(msg, 7223 NL80211_STA_INFO_BSS_PARAM); 7224 if (!bss_param) 7225 goto nla_put_failure; 7226 7227 if (((link_sinfo->bss_param.flags & 7228 BSS_PARAM_FLAGS_CTS_PROT) && 7229 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 7230 ((link_sinfo->bss_param.flags & 7231 BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 7232 nla_put_flag(msg, 7233 NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 7234 ((link_sinfo->bss_param.flags & 7235 BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 7236 nla_put_flag(msg, 7237 NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 7238 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 7239 link_sinfo->bss_param.dtim_period) || 7240 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 7241 link_sinfo->bss_param.beacon_interval)) 7242 goto nla_put_failure; 7243 7244 nla_nest_end(msg, bss_param); 7245 } 7246 7247 PUT_LINK_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 7248 PUT_LINK_SINFO_U64(BEACON_RX, rx_beacon); 7249 PUT_LINK_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 7250 PUT_LINK_SINFO(RX_MPDUS, rx_mpdu_count, u32); 7251 PUT_LINK_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 7252 if (wiphy_ext_feature_isset(&rdev->wiphy, 7253 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 7254 PUT_LINK_SINFO(ACK_SIGNAL, ack_signal, u8); 7255 PUT_LINK_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 7256 } 7257 7258 #undef PUT_LINK_SINFO 7259 #undef PUT_LINK_SINFO_U64 7260 7261 if (link_sinfo->pertid) { 7262 struct nlattr *tidsattr; 7263 int tid; 7264 7265 tidsattr = nla_nest_start_noflag(msg, 7266 NL80211_STA_INFO_TID_STATS); 7267 if (!tidsattr) 7268 goto nla_put_failure; 7269 7270 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 7271 struct cfg80211_tid_stats *tidstats; 7272 struct nlattr *tidattr; 7273 7274 tidstats = &link_sinfo->pertid[tid]; 7275 7276 if (!tidstats->filled) 7277 continue; 7278 7279 tidattr = nla_nest_start_noflag(msg, tid + 1); 7280 if (!tidattr) 7281 goto nla_put_failure; 7282 7283 #define PUT_TIDVAL_U64(attr, memb) do { \ 7284 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 7285 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 7286 tidstats->memb, NL80211_TID_STATS_PAD)) \ 7287 goto nla_put_failure; \ 7288 } while (0) 7289 7290 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 7291 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 7292 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 7293 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 7294 7295 #undef PUT_TIDVAL_U64 7296 if ((tidstats->filled & 7297 BIT(NL80211_TID_STATS_TXQ_STATS)) && 7298 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 7299 NL80211_TID_STATS_TXQ_STATS)) 7300 goto nla_put_failure; 7301 7302 nla_nest_end(msg, tidattr); 7303 } 7304 7305 nla_nest_end(msg, tidsattr); 7306 } 7307 7308 nla_nest_end(msg, link_sinfoattr); 7309 return 0; 7310 7311 nla_put_failure: 7312 return -EMSGSIZE; 7313 } 7314 7315 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid, 7316 u32 seq, int flags, 7317 struct cfg80211_registered_device *rdev, 7318 struct net_device *dev, 7319 const u8 *mac_addr, struct station_info *sinfo, 7320 bool link_stats) 7321 { 7322 void *hdr; 7323 struct nlattr *sinfoattr, *bss_param; 7324 struct link_station_info *link_sinfo; 7325 struct nlattr *links, *link; 7326 int link_id; 7327 7328 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 7329 if (!hdr) { 7330 cfg80211_sinfo_release_content(sinfo); 7331 return -1; 7332 } 7333 7334 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 7335 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 7336 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation)) 7337 goto nla_put_failure; 7338 7339 sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 7340 if (!sinfoattr) 7341 goto nla_put_failure; 7342 7343 #define PUT_SINFO(attr, memb, type) do { \ 7344 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 7345 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7346 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 7347 sinfo->memb)) \ 7348 goto nla_put_failure; \ 7349 } while (0) 7350 #define PUT_SINFO_U64(attr, memb) do { \ 7351 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 7352 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 7353 sinfo->memb, NL80211_STA_INFO_PAD)) \ 7354 goto nla_put_failure; \ 7355 } while (0) 7356 7357 PUT_SINFO(CONNECTED_TIME, connected_time, u32); 7358 PUT_SINFO(INACTIVE_TIME, inactive_time, u32); 7359 PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at); 7360 7361 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 7362 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 7363 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 7364 (u32)sinfo->rx_bytes)) 7365 goto nla_put_failure; 7366 7367 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 7368 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 7369 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 7370 (u32)sinfo->tx_bytes)) 7371 goto nla_put_failure; 7372 7373 PUT_SINFO_U64(RX_BYTES64, rx_bytes); 7374 PUT_SINFO_U64(TX_BYTES64, tx_bytes); 7375 PUT_SINFO_U64(RX_DURATION, rx_duration); 7376 PUT_SINFO_U64(TX_DURATION, tx_duration); 7377 7378 if (wiphy_ext_feature_isset(&rdev->wiphy, 7379 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7380 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 7381 7382 switch (rdev->wiphy.signal_type) { 7383 case CFG80211_SIGNAL_TYPE_MBM: 7384 PUT_SINFO(SIGNAL, signal, u8); 7385 PUT_SINFO(SIGNAL_AVG, signal_avg, u8); 7386 break; 7387 default: 7388 break; 7389 } 7390 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 7391 if (!nl80211_put_signal(msg, sinfo->chains, 7392 sinfo->chain_signal, 7393 NL80211_STA_INFO_CHAIN_SIGNAL)) 7394 goto nla_put_failure; 7395 } 7396 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 7397 if (!nl80211_put_signal(msg, sinfo->chains, 7398 sinfo->chain_signal_avg, 7399 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 7400 goto nla_put_failure; 7401 } 7402 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 7403 if (!nl80211_put_sta_rate(msg, &sinfo->txrate, 7404 NL80211_STA_INFO_TX_BITRATE)) 7405 goto nla_put_failure; 7406 } 7407 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 7408 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate, 7409 NL80211_STA_INFO_RX_BITRATE)) 7410 goto nla_put_failure; 7411 } 7412 7413 PUT_SINFO(RX_PACKETS, rx_packets, u32); 7414 PUT_SINFO(TX_PACKETS, tx_packets, u32); 7415 PUT_SINFO(TX_RETRIES, tx_retries, u32); 7416 PUT_SINFO(TX_FAILED, tx_failed, u32); 7417 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 7418 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32); 7419 7420 PUT_SINFO(LLID, llid, u16); 7421 PUT_SINFO(PLID, plid, u16); 7422 PUT_SINFO(PLINK_STATE, plink_state, u8); 7423 PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32); 7424 PUT_SINFO(LOCAL_PM, local_pm, u32); 7425 PUT_SINFO(PEER_PM, peer_pm, u32); 7426 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32); 7427 PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8); 7428 PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8); 7429 PUT_SINFO_U64(T_OFFSET, t_offset); 7430 7431 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 7432 bss_param = nla_nest_start_noflag(msg, 7433 NL80211_STA_INFO_BSS_PARAM); 7434 if (!bss_param) 7435 goto nla_put_failure; 7436 7437 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) && 7438 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 7439 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 7440 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 7441 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 7442 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 7443 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 7444 sinfo->bss_param.dtim_period) || 7445 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 7446 sinfo->bss_param.beacon_interval)) 7447 goto nla_put_failure; 7448 7449 nla_nest_end(msg, bss_param); 7450 } 7451 if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) && 7452 nla_put(msg, NL80211_STA_INFO_STA_FLAGS, 7453 sizeof(struct nl80211_sta_flag_update), 7454 &sinfo->sta_flags)) 7455 goto nla_put_failure; 7456 7457 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 7458 PUT_SINFO_U64(BEACON_RX, rx_beacon); 7459 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 7460 PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32); 7461 PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 7462 if (wiphy_ext_feature_isset(&rdev->wiphy, 7463 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 7464 PUT_SINFO(ACK_SIGNAL, ack_signal, u8); 7465 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 7466 } 7467 7468 #undef PUT_SINFO 7469 #undef PUT_SINFO_U64 7470 7471 if (sinfo->pertid) { 7472 struct nlattr *tidsattr; 7473 int tid; 7474 7475 tidsattr = nla_nest_start_noflag(msg, 7476 NL80211_STA_INFO_TID_STATS); 7477 if (!tidsattr) 7478 goto nla_put_failure; 7479 7480 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 7481 struct cfg80211_tid_stats *tidstats; 7482 struct nlattr *tidattr; 7483 7484 tidstats = &sinfo->pertid[tid]; 7485 7486 if (!tidstats->filled) 7487 continue; 7488 7489 tidattr = nla_nest_start_noflag(msg, tid + 1); 7490 if (!tidattr) 7491 goto nla_put_failure; 7492 7493 #define PUT_TIDVAL_U64(attr, memb) do { \ 7494 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 7495 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 7496 tidstats->memb, NL80211_TID_STATS_PAD)) \ 7497 goto nla_put_failure; \ 7498 } while (0) 7499 7500 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 7501 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 7502 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 7503 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 7504 7505 #undef PUT_TIDVAL_U64 7506 if ((tidstats->filled & 7507 BIT(NL80211_TID_STATS_TXQ_STATS)) && 7508 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 7509 NL80211_TID_STATS_TXQ_STATS)) 7510 goto nla_put_failure; 7511 7512 nla_nest_end(msg, tidattr); 7513 } 7514 7515 nla_nest_end(msg, tidsattr); 7516 } 7517 7518 nla_nest_end(msg, sinfoattr); 7519 7520 if (sinfo->assoc_req_ies_len && 7521 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len, 7522 sinfo->assoc_req_ies)) 7523 goto nla_put_failure; 7524 7525 if (sinfo->assoc_resp_ies_len && 7526 nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len, 7527 sinfo->assoc_resp_ies)) 7528 goto nla_put_failure; 7529 7530 if (sinfo->mlo_params_valid) { 7531 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 7532 sinfo->assoc_link_id)) 7533 goto nla_put_failure; 7534 7535 if (!is_zero_ether_addr(sinfo->mld_addr) && 7536 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 7537 sinfo->mld_addr)) 7538 goto nla_put_failure; 7539 } 7540 7541 if (link_stats && sinfo->valid_links) { 7542 links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 7543 if (!links) 7544 goto nla_put_failure; 7545 7546 for_each_valid_link(sinfo, link_id) { 7547 link_sinfo = sinfo->links[link_id]; 7548 7549 if (WARN_ON_ONCE(!link_sinfo)) 7550 continue; 7551 7552 if (!is_valid_ether_addr(link_sinfo->addr)) 7553 continue; 7554 7555 link = nla_nest_start(msg, link_id + 1); 7556 if (!link) 7557 goto nla_put_failure; 7558 7559 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 7560 link_id)) 7561 goto nla_put_failure; 7562 7563 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 7564 link_sinfo->addr)) 7565 goto nla_put_failure; 7566 7567 if (nl80211_fill_link_station(msg, rdev, link_sinfo)) 7568 goto nla_put_failure; 7569 7570 nla_nest_end(msg, link); 7571 } 7572 nla_nest_end(msg, links); 7573 } 7574 7575 cfg80211_sinfo_release_content(sinfo); 7576 genlmsg_end(msg, hdr); 7577 return 0; 7578 7579 nla_put_failure: 7580 cfg80211_sinfo_release_content(sinfo); 7581 genlmsg_cancel(msg, hdr); 7582 return -EMSGSIZE; 7583 } 7584 7585 static void cfg80211_sta_set_mld_sinfo(struct station_info *sinfo) 7586 { 7587 struct link_station_info *link_sinfo; 7588 int link_id, init = 0; 7589 u32 link_inactive_time; 7590 7591 sinfo->signal = -99; 7592 7593 for_each_valid_link(sinfo, link_id) { 7594 link_sinfo = sinfo->links[link_id]; 7595 if (!link_sinfo) 7596 continue; 7597 7598 if ((link_sinfo->filled & 7599 BIT_ULL(NL80211_STA_INFO_TX_PACKETS))) { 7600 sinfo->tx_packets += link_sinfo->tx_packets; 7601 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_PACKETS); 7602 } 7603 7604 if ((link_sinfo->filled & 7605 BIT_ULL(NL80211_STA_INFO_RX_PACKETS))) { 7606 sinfo->rx_packets += link_sinfo->rx_packets; 7607 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_PACKETS); 7608 } 7609 7610 if (link_sinfo->filled & 7611 (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 7612 BIT_ULL(NL80211_STA_INFO_TX_BYTES64))) { 7613 sinfo->tx_bytes += link_sinfo->tx_bytes; 7614 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BYTES); 7615 } 7616 7617 if (link_sinfo->filled & 7618 (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 7619 BIT_ULL(NL80211_STA_INFO_TX_BYTES64))) { 7620 sinfo->rx_bytes += link_sinfo->rx_bytes; 7621 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_BYTES); 7622 } 7623 7624 if (link_sinfo->filled & 7625 BIT_ULL(NL80211_STA_INFO_TX_RETRIES)) { 7626 sinfo->tx_retries += link_sinfo->tx_retries; 7627 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_RETRIES); 7628 } 7629 7630 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_FAILED)) { 7631 sinfo->tx_failed += link_sinfo->tx_failed; 7632 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_FAILED); 7633 } 7634 7635 if (link_sinfo->filled & 7636 BIT_ULL(NL80211_STA_INFO_RX_DROP_MISC)) { 7637 sinfo->rx_dropped_misc += link_sinfo->rx_dropped_misc; 7638 sinfo->filled |= 7639 BIT_ULL(NL80211_STA_INFO_RX_DROP_MISC); 7640 } 7641 7642 if (link_sinfo->filled & 7643 BIT_ULL(NL80211_STA_INFO_BEACON_LOSS)) { 7644 sinfo->beacon_loss_count += 7645 link_sinfo->beacon_loss_count; 7646 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_BEACON_LOSS); 7647 } 7648 7649 if (link_sinfo->filled & 7650 BIT_ULL(NL80211_STA_INFO_EXPECTED_THROUGHPUT)) { 7651 sinfo->expected_throughput += 7652 link_sinfo->expected_throughput; 7653 sinfo->filled |= 7654 BIT_ULL(NL80211_STA_INFO_EXPECTED_THROUGHPUT); 7655 } 7656 7657 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_MPDUS)) { 7658 sinfo->rx_mpdu_count += link_sinfo->rx_mpdu_count; 7659 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_MPDUS); 7660 } 7661 7662 if (link_sinfo->filled & 7663 BIT_ULL(NL80211_STA_INFO_FCS_ERROR_COUNT)) { 7664 sinfo->fcs_err_count += link_sinfo->fcs_err_count; 7665 sinfo->filled |= 7666 BIT_ULL(NL80211_STA_INFO_FCS_ERROR_COUNT); 7667 } 7668 7669 if (link_sinfo->filled & 7670 BIT_ULL(NL80211_STA_INFO_BEACON_RX)) { 7671 sinfo->rx_beacon += link_sinfo->rx_beacon; 7672 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_BEACON_RX); 7673 } 7674 7675 /* Update MLO signal, signal_avg as best among links */ 7676 if ((link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_SIGNAL)) && 7677 link_sinfo->signal > sinfo->signal) { 7678 sinfo->signal = link_sinfo->signal; 7679 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL); 7680 } 7681 7682 if ((link_sinfo->filled & 7683 BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG)) && 7684 link_sinfo->signal_avg > sinfo->signal_avg) { 7685 sinfo->signal_avg = link_sinfo->signal_avg; 7686 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL_AVG); 7687 } 7688 7689 /* Update MLO inactive_time, bss_param based on least 7690 * value for corresponding field of link. 7691 */ 7692 if ((link_sinfo->filled & 7693 BIT_ULL(NL80211_STA_INFO_INACTIVE_TIME)) && 7694 (!init || 7695 link_inactive_time > link_sinfo->inactive_time)) { 7696 link_inactive_time = link_sinfo->inactive_time; 7697 sinfo->inactive_time = link_sinfo->inactive_time; 7698 sinfo->filled |= NL80211_STA_INFO_INACTIVE_TIME; 7699 } 7700 7701 if (link_sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM) && 7702 (!init || 7703 sinfo->bss_param.dtim_period > 7704 link_sinfo->bss_param.dtim_period)) { 7705 sinfo->bss_param.dtim_period = 7706 link_sinfo->bss_param.dtim_period; 7707 sinfo->filled |= NL80211_STA_BSS_PARAM_DTIM_PERIOD; 7708 sinfo->bss_param.beacon_interval = 7709 link_sinfo->bss_param.beacon_interval; 7710 sinfo->filled |= NL80211_STA_BSS_PARAM_BEACON_INTERVAL; 7711 } 7712 7713 /* Update MLO rates as per last updated link rate */ 7714 if ((link_sinfo->filled & 7715 BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) && 7716 (!init || 7717 link_inactive_time > link_sinfo->inactive_time)) { 7718 sinfo->txrate = link_sinfo->txrate; 7719 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE); 7720 } 7721 if ((link_sinfo->filled & 7722 BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) && 7723 (!init || 7724 link_inactive_time > link_sinfo->inactive_time)) { 7725 sinfo->rxrate = link_sinfo->rxrate; 7726 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_BITRATE); 7727 } 7728 7729 if (link_sinfo->filled & 7730 BIT_ULL(NL80211_STA_INFO_TX_DURATION) && 7731 (!init || 7732 link_inactive_time > link_sinfo->inactive_time)) { 7733 sinfo->tx_duration += link_sinfo->tx_duration; 7734 sinfo->filled |= 7735 BIT_ULL(NL80211_STA_INFO_TX_DURATION); 7736 } 7737 if (link_sinfo->filled & 7738 BIT_ULL(NL80211_STA_INFO_RX_DURATION) && 7739 (!init || 7740 link_inactive_time > link_sinfo->inactive_time)) { 7741 sinfo->rx_duration += link_sinfo->rx_duration; 7742 sinfo->filled |= 7743 BIT_ULL(NL80211_STA_INFO_RX_DURATION); 7744 } 7745 init++; 7746 7747 /* pertid stats accumulate for rx/tx fields */ 7748 if (sinfo->pertid) { 7749 sinfo->pertid->rx_msdu += 7750 link_sinfo->pertid->rx_msdu; 7751 sinfo->pertid->tx_msdu += 7752 link_sinfo->pertid->tx_msdu; 7753 sinfo->pertid->tx_msdu_retries += 7754 link_sinfo->pertid->tx_msdu_retries; 7755 sinfo->pertid->tx_msdu_failed += 7756 link_sinfo->pertid->tx_msdu_failed; 7757 7758 sinfo->pertid->filled |= 7759 BIT(NL80211_TID_STATS_RX_MSDU) | 7760 BIT(NL80211_TID_STATS_TX_MSDU) | 7761 BIT(NL80211_TID_STATS_TX_MSDU_RETRIES) | 7762 BIT(NL80211_TID_STATS_TX_MSDU_FAILED); 7763 } 7764 } 7765 7766 /* Reset sinfo->filled bits to exclude fields which don't make 7767 * much sense at the MLO level. 7768 */ 7769 sinfo->filled &= ~BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL); 7770 sinfo->filled &= ~BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG); 7771 } 7772 7773 static int nl80211_dump_station(struct sk_buff *skb, 7774 struct netlink_callback *cb) 7775 { 7776 struct station_info sinfo; 7777 struct cfg80211_registered_device *rdev; 7778 struct wireless_dev *wdev; 7779 u8 mac_addr[ETH_ALEN]; 7780 int sta_idx = cb->args[2]; 7781 bool sinfo_alloc = false; 7782 int err, i; 7783 7784 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7785 if (err) 7786 return err; 7787 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7788 __acquire(&rdev->wiphy.mtx); 7789 7790 if (!wdev->netdev) { 7791 err = -EINVAL; 7792 goto out_err; 7793 } 7794 7795 if (!rdev->ops->dump_station) { 7796 err = -EOPNOTSUPP; 7797 goto out_err; 7798 } 7799 7800 while (1) { 7801 memset(&sinfo, 0, sizeof(sinfo)); 7802 7803 for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) { 7804 sinfo.links[i] = 7805 kzalloc(sizeof(*sinfo.links[0]), GFP_KERNEL); 7806 if (!sinfo.links[i]) { 7807 err = -ENOMEM; 7808 goto out_err; 7809 } 7810 sinfo_alloc = true; 7811 } 7812 7813 err = rdev_dump_station(rdev, wdev->netdev, sta_idx, 7814 mac_addr, &sinfo); 7815 if (err == -ENOENT) 7816 break; 7817 if (err) 7818 goto out_err; 7819 7820 if (sinfo.valid_links) 7821 cfg80211_sta_set_mld_sinfo(&sinfo); 7822 7823 /* reset the sinfo_alloc flag as nl80211_send_station() 7824 * always releases sinfo 7825 */ 7826 sinfo_alloc = false; 7827 7828 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION, 7829 NETLINK_CB(cb->skb).portid, 7830 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7831 rdev, wdev->netdev, mac_addr, 7832 &sinfo, false) < 0) 7833 goto out; 7834 7835 sta_idx++; 7836 } 7837 7838 out: 7839 cb->args[2] = sta_idx; 7840 err = skb->len; 7841 out_err: 7842 if (sinfo_alloc) 7843 cfg80211_sinfo_release_content(&sinfo); 7844 wiphy_unlock(&rdev->wiphy); 7845 7846 return err; 7847 } 7848 7849 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info) 7850 { 7851 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7852 struct net_device *dev = info->user_ptr[1]; 7853 struct station_info sinfo; 7854 struct sk_buff *msg; 7855 u8 *mac_addr = NULL; 7856 int err, i; 7857 7858 memset(&sinfo, 0, sizeof(sinfo)); 7859 7860 if (!info->attrs[NL80211_ATTR_MAC]) 7861 return -EINVAL; 7862 7863 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7864 7865 if (!rdev->ops->get_station) 7866 return -EOPNOTSUPP; 7867 7868 for (i = 0; i < IEEE80211_MLD_MAX_NUM_LINKS; i++) { 7869 sinfo.links[i] = kzalloc(sizeof(*sinfo.links[0]), GFP_KERNEL); 7870 if (!sinfo.links[i]) { 7871 cfg80211_sinfo_release_content(&sinfo); 7872 return -ENOMEM; 7873 } 7874 } 7875 7876 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 7877 if (err) { 7878 cfg80211_sinfo_release_content(&sinfo); 7879 return err; 7880 } 7881 7882 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7883 if (!msg) { 7884 cfg80211_sinfo_release_content(&sinfo); 7885 return -ENOMEM; 7886 } 7887 7888 if (sinfo.valid_links) 7889 cfg80211_sta_set_mld_sinfo(&sinfo); 7890 7891 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 7892 info->snd_portid, info->snd_seq, 0, 7893 rdev, dev, mac_addr, &sinfo, false) < 0) { 7894 nlmsg_free(msg); 7895 return -ENOBUFS; 7896 } 7897 7898 return genlmsg_reply(msg, info); 7899 } 7900 7901 int cfg80211_check_station_change(struct wiphy *wiphy, 7902 struct station_parameters *params, 7903 enum cfg80211_station_type statype) 7904 { 7905 if (params->listen_interval != -1 && 7906 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 7907 return -EINVAL; 7908 7909 if (params->support_p2p_ps != -1 && 7910 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 7911 return -EINVAL; 7912 7913 if (params->aid && 7914 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && 7915 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 7916 return -EINVAL; 7917 7918 /* When you run into this, adjust the code below for the new flag */ 7919 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 7920 7921 switch (statype) { 7922 case CFG80211_STA_MESH_PEER_KERNEL: 7923 case CFG80211_STA_MESH_PEER_USER: 7924 /* 7925 * No ignoring the TDLS flag here -- the userspace mesh 7926 * code doesn't have the bug of including TDLS in the 7927 * mask everywhere. 7928 */ 7929 if (params->sta_flags_mask & 7930 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7931 BIT(NL80211_STA_FLAG_MFP) | 7932 BIT(NL80211_STA_FLAG_AUTHORIZED))) 7933 return -EINVAL; 7934 break; 7935 case CFG80211_STA_TDLS_PEER_SETUP: 7936 case CFG80211_STA_TDLS_PEER_ACTIVE: 7937 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 7938 return -EINVAL; 7939 /* ignore since it can't change */ 7940 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7941 break; 7942 default: 7943 /* disallow mesh-specific things */ 7944 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) 7945 return -EINVAL; 7946 if (params->local_pm) 7947 return -EINVAL; 7948 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 7949 return -EINVAL; 7950 } 7951 7952 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 7953 statype != CFG80211_STA_TDLS_PEER_ACTIVE) { 7954 /* TDLS can't be set, ... */ 7955 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) 7956 return -EINVAL; 7957 /* 7958 * ... but don't bother the driver with it. This works around 7959 * a hostapd/wpa_supplicant issue -- it always includes the 7960 * TLDS_PEER flag in the mask even for AP mode. 7961 */ 7962 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7963 } 7964 7965 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 7966 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 7967 /* reject other things that can't change */ 7968 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) 7969 return -EINVAL; 7970 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) 7971 return -EINVAL; 7972 if (params->link_sta_params.supported_rates) 7973 return -EINVAL; 7974 if (params->ext_capab || params->link_sta_params.ht_capa || 7975 params->link_sta_params.vht_capa || 7976 params->link_sta_params.he_capa || 7977 params->link_sta_params.eht_capa) 7978 return -EINVAL; 7979 if (params->sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 7980 return -EINVAL; 7981 } 7982 7983 if (statype != CFG80211_STA_AP_CLIENT && 7984 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 7985 if (params->vlan) 7986 return -EINVAL; 7987 } 7988 7989 /* Accept EMLSR capabilities only for AP client before association */ 7990 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 7991 params->eml_cap_present) 7992 return -EINVAL; 7993 7994 switch (statype) { 7995 case CFG80211_STA_AP_MLME_CLIENT: 7996 /* Use this only for authorizing/unauthorizing a station */ 7997 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 7998 return -EOPNOTSUPP; 7999 break; 8000 case CFG80211_STA_AP_CLIENT: 8001 case CFG80211_STA_AP_CLIENT_UNASSOC: 8002 /* accept only the listed bits */ 8003 if (params->sta_flags_mask & 8004 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 8005 BIT(NL80211_STA_FLAG_AUTHENTICATED) | 8006 BIT(NL80211_STA_FLAG_ASSOCIATED) | 8007 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 8008 BIT(NL80211_STA_FLAG_WME) | 8009 BIT(NL80211_STA_FLAG_MFP) | 8010 BIT(NL80211_STA_FLAG_SPP_AMSDU))) 8011 return -EINVAL; 8012 8013 /* but authenticated/associated only if driver handles it */ 8014 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 8015 params->sta_flags_mask & 8016 (BIT(NL80211_STA_FLAG_AUTHENTICATED) | 8017 BIT(NL80211_STA_FLAG_ASSOCIATED))) 8018 return -EINVAL; 8019 break; 8020 case CFG80211_STA_IBSS: 8021 case CFG80211_STA_AP_STA: 8022 /* reject any changes other than AUTHORIZED */ 8023 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED)) 8024 return -EINVAL; 8025 break; 8026 case CFG80211_STA_TDLS_PEER_SETUP: 8027 /* reject any changes other than AUTHORIZED or WME */ 8028 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 8029 BIT(NL80211_STA_FLAG_WME))) 8030 return -EINVAL; 8031 /* force (at least) rates when authorizing */ 8032 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) && 8033 !params->link_sta_params.supported_rates) 8034 return -EINVAL; 8035 break; 8036 case CFG80211_STA_TDLS_PEER_ACTIVE: 8037 /* reject any changes */ 8038 return -EINVAL; 8039 case CFG80211_STA_MESH_PEER_KERNEL: 8040 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 8041 return -EINVAL; 8042 break; 8043 case CFG80211_STA_MESH_PEER_USER: 8044 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION && 8045 params->plink_action != NL80211_PLINK_ACTION_BLOCK) 8046 return -EINVAL; 8047 break; 8048 } 8049 8050 /* 8051 * Older kernel versions ignored this attribute entirely, so don't 8052 * reject attempts to update it but mark it as unused instead so the 8053 * driver won't look at the data. 8054 */ 8055 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 8056 statype != CFG80211_STA_TDLS_PEER_SETUP) 8057 params->link_sta_params.opmode_notif_used = false; 8058 8059 return 0; 8060 } 8061 EXPORT_SYMBOL(cfg80211_check_station_change); 8062 8063 /* 8064 * Get vlan interface making sure it is running and on the right wiphy. 8065 */ 8066 static struct net_device *get_vlan(struct genl_info *info, 8067 struct cfg80211_registered_device *rdev) 8068 { 8069 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN]; 8070 struct net_device *v; 8071 int ret; 8072 8073 if (!vlanattr) 8074 return NULL; 8075 8076 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr)); 8077 if (!v) 8078 return ERR_PTR(-ENODEV); 8079 8080 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) { 8081 ret = -EINVAL; 8082 goto error; 8083 } 8084 8085 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 8086 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 8087 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 8088 ret = -EINVAL; 8089 goto error; 8090 } 8091 8092 if (!netif_running(v)) { 8093 ret = -ENETDOWN; 8094 goto error; 8095 } 8096 8097 return v; 8098 error: 8099 dev_put(v); 8100 return ERR_PTR(ret); 8101 } 8102 8103 static int nl80211_parse_sta_wme(struct genl_info *info, 8104 struct station_parameters *params) 8105 { 8106 struct nlattr *tb[NL80211_STA_WME_MAX + 1]; 8107 struct nlattr *nla; 8108 int err; 8109 8110 /* parse WME attributes if present */ 8111 if (!info->attrs[NL80211_ATTR_STA_WME]) 8112 return 0; 8113 8114 nla = info->attrs[NL80211_ATTR_STA_WME]; 8115 err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla, 8116 nl80211_sta_wme_policy, 8117 info->extack); 8118 if (err) 8119 return err; 8120 8121 if (tb[NL80211_STA_WME_UAPSD_QUEUES]) 8122 params->uapsd_queues = nla_get_u8( 8123 tb[NL80211_STA_WME_UAPSD_QUEUES]); 8124 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) 8125 return -EINVAL; 8126 8127 if (tb[NL80211_STA_WME_MAX_SP]) 8128 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]); 8129 8130 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) 8131 return -EINVAL; 8132 8133 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD; 8134 8135 return 0; 8136 } 8137 8138 static int nl80211_parse_sta_channel_info(struct genl_info *info, 8139 struct station_parameters *params) 8140 { 8141 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) { 8142 params->supported_channels = 8143 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 8144 params->supported_channels_len = 8145 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 8146 /* 8147 * Need to include at least one (first channel, number of 8148 * channels) tuple for each subband (checked in policy), 8149 * and must have proper tuples for the rest of the data as well. 8150 */ 8151 if (params->supported_channels_len % 2) 8152 return -EINVAL; 8153 } 8154 8155 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) { 8156 params->supported_oper_classes = 8157 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 8158 params->supported_oper_classes_len = 8159 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 8160 } 8161 return 0; 8162 } 8163 8164 static int nl80211_set_station_tdls(struct genl_info *info, 8165 struct station_parameters *params) 8166 { 8167 int err; 8168 /* Dummy STA entry gets updated once the peer capabilities are known */ 8169 if (info->attrs[NL80211_ATTR_PEER_AID]) 8170 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 8171 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 8172 params->link_sta_params.ht_capa = 8173 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 8174 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 8175 params->link_sta_params.vht_capa = 8176 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 8177 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 8178 params->link_sta_params.he_capa = 8179 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8180 params->link_sta_params.he_capa_len = 8181 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8182 8183 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 8184 params->link_sta_params.eht_capa = 8185 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8186 params->link_sta_params.eht_capa_len = 8187 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8188 8189 if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa, 8190 (const u8 *)params->link_sta_params.eht_capa, 8191 params->link_sta_params.eht_capa_len, 8192 false)) 8193 return -EINVAL; 8194 } 8195 } 8196 8197 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 8198 params->link_sta_params.s1g_capa = 8199 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]); 8200 8201 err = nl80211_parse_sta_channel_info(info, params); 8202 if (err) 8203 return err; 8204 8205 return nl80211_parse_sta_wme(info, params); 8206 } 8207 8208 static int nl80211_parse_sta_txpower_setting(struct genl_info *info, 8209 struct sta_txpwr *txpwr, 8210 bool *txpwr_set) 8211 { 8212 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8213 int idx; 8214 8215 if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) { 8216 if (!rdev->ops->set_tx_power || 8217 !wiphy_ext_feature_isset(&rdev->wiphy, 8218 NL80211_EXT_FEATURE_STA_TX_PWR)) 8219 return -EOPNOTSUPP; 8220 8221 idx = NL80211_ATTR_STA_TX_POWER_SETTING; 8222 txpwr->type = nla_get_u8(info->attrs[idx]); 8223 8224 if (txpwr->type == NL80211_TX_POWER_LIMITED) { 8225 idx = NL80211_ATTR_STA_TX_POWER; 8226 8227 if (info->attrs[idx]) 8228 txpwr->power = nla_get_s16(info->attrs[idx]); 8229 else 8230 return -EINVAL; 8231 } 8232 8233 *txpwr_set = true; 8234 } else { 8235 *txpwr_set = false; 8236 } 8237 8238 return 0; 8239 } 8240 8241 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info) 8242 { 8243 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8244 struct net_device *dev = info->user_ptr[1]; 8245 struct station_parameters params; 8246 u8 *mac_addr; 8247 int err; 8248 8249 memset(¶ms, 0, sizeof(params)); 8250 8251 if (!rdev->ops->change_station) 8252 return -EOPNOTSUPP; 8253 8254 /* 8255 * AID and listen_interval properties can be set only for unassociated 8256 * station. Include these parameters here and will check them in 8257 * cfg80211_check_station_change(). 8258 */ 8259 if (info->attrs[NL80211_ATTR_STA_AID]) 8260 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 8261 8262 if (info->attrs[NL80211_ATTR_VLAN_ID]) 8263 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 8264 8265 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 8266 params.listen_interval = 8267 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 8268 else 8269 params.listen_interval = -1; 8270 8271 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) 8272 params.support_p2p_ps = 8273 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 8274 else 8275 params.support_p2p_ps = -1; 8276 8277 if (!info->attrs[NL80211_ATTR_MAC]) 8278 return -EINVAL; 8279 8280 params.link_sta_params.link_id = 8281 nl80211_link_id_or_invalid(info->attrs); 8282 8283 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 8284 /* If MLD_ADDR attribute is set then this is an MLD station 8285 * and the MLD_ADDR attribute holds the MLD address and the 8286 * MAC attribute holds for the LINK address. 8287 * In that case, the link_id is also expected to be valid. 8288 */ 8289 if (params.link_sta_params.link_id < 0) 8290 return -EINVAL; 8291 8292 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 8293 params.link_sta_params.mld_mac = mac_addr; 8294 params.link_sta_params.link_mac = 8295 nla_data(info->attrs[NL80211_ATTR_MAC]); 8296 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 8297 return -EINVAL; 8298 } else { 8299 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 8300 } 8301 8302 8303 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 8304 params.link_sta_params.supported_rates = 8305 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8306 params.link_sta_params.supported_rates_len = 8307 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8308 } 8309 8310 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 8311 params.capability = 8312 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 8313 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 8314 } 8315 8316 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 8317 params.ext_capab = 8318 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8319 params.ext_capab_len = 8320 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8321 } 8322 8323 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 8324 return -EINVAL; 8325 8326 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 8327 params.plink_action = 8328 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 8329 8330 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) { 8331 params.plink_state = 8332 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]); 8333 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) 8334 params.peer_aid = nla_get_u16( 8335 info->attrs[NL80211_ATTR_MESH_PEER_AID]); 8336 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE; 8337 } 8338 8339 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) 8340 params.local_pm = nla_get_u32( 8341 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]); 8342 8343 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 8344 params.link_sta_params.opmode_notif_used = true; 8345 params.link_sta_params.opmode_notif = 8346 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 8347 } 8348 8349 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 8350 params.link_sta_params.he_6ghz_capa = 8351 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 8352 8353 if (info->attrs[NL80211_ATTR_EML_CAPABILITY]) { 8354 params.eml_cap_present = true; 8355 params.eml_cap = 8356 nla_get_u16(info->attrs[NL80211_ATTR_EML_CAPABILITY]); 8357 } 8358 8359 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 8360 params.airtime_weight = 8361 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 8362 8363 if (params.airtime_weight && 8364 !wiphy_ext_feature_isset(&rdev->wiphy, 8365 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 8366 return -EOPNOTSUPP; 8367 8368 err = nl80211_parse_sta_txpower_setting(info, 8369 ¶ms.link_sta_params.txpwr, 8370 ¶ms.link_sta_params.txpwr_set); 8371 if (err) 8372 return err; 8373 8374 /* Include parameters for TDLS peer (will check later) */ 8375 err = nl80211_set_station_tdls(info, ¶ms); 8376 if (err) 8377 return err; 8378 8379 params.vlan = get_vlan(info, rdev); 8380 if (IS_ERR(params.vlan)) 8381 return PTR_ERR(params.vlan); 8382 8383 switch (dev->ieee80211_ptr->iftype) { 8384 case NL80211_IFTYPE_AP: 8385 case NL80211_IFTYPE_AP_VLAN: 8386 case NL80211_IFTYPE_P2P_GO: 8387 case NL80211_IFTYPE_P2P_CLIENT: 8388 case NL80211_IFTYPE_STATION: 8389 case NL80211_IFTYPE_ADHOC: 8390 case NL80211_IFTYPE_MESH_POINT: 8391 break; 8392 default: 8393 err = -EOPNOTSUPP; 8394 goto out_put_vlan; 8395 } 8396 8397 /* driver will call cfg80211_check_station_change() */ 8398 err = rdev_change_station(rdev, dev, mac_addr, ¶ms); 8399 8400 out_put_vlan: 8401 dev_put(params.vlan); 8402 8403 return err; 8404 } 8405 8406 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info) 8407 { 8408 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8409 int err; 8410 struct net_device *dev = info->user_ptr[1]; 8411 struct wireless_dev *wdev = dev->ieee80211_ptr; 8412 struct station_parameters params; 8413 u8 *mac_addr = NULL; 8414 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 8415 BIT(NL80211_STA_FLAG_ASSOCIATED); 8416 8417 memset(¶ms, 0, sizeof(params)); 8418 8419 if (!rdev->ops->add_station) 8420 return -EOPNOTSUPP; 8421 8422 if (!info->attrs[NL80211_ATTR_MAC]) 8423 return -EINVAL; 8424 8425 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 8426 return -EINVAL; 8427 8428 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 8429 return -EINVAL; 8430 8431 if (!info->attrs[NL80211_ATTR_STA_AID] && 8432 !info->attrs[NL80211_ATTR_PEER_AID]) 8433 return -EINVAL; 8434 8435 params.link_sta_params.link_id = 8436 nl80211_link_id_or_invalid(info->attrs); 8437 8438 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 8439 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 8440 params.link_sta_params.mld_mac = mac_addr; 8441 params.link_sta_params.link_mac = 8442 nla_data(info->attrs[NL80211_ATTR_MAC]); 8443 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 8444 return -EINVAL; 8445 } else { 8446 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 8447 } 8448 8449 params.link_sta_params.supported_rates = 8450 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8451 params.link_sta_params.supported_rates_len = 8452 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 8453 params.listen_interval = 8454 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 8455 8456 if (info->attrs[NL80211_ATTR_VLAN_ID]) 8457 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 8458 8459 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) { 8460 params.support_p2p_ps = 8461 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 8462 } else { 8463 /* 8464 * if not specified, assume it's supported for P2P GO interface, 8465 * and is NOT supported for AP interface 8466 */ 8467 params.support_p2p_ps = 8468 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO; 8469 } 8470 8471 if (info->attrs[NL80211_ATTR_PEER_AID]) 8472 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 8473 else 8474 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 8475 8476 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 8477 params.capability = 8478 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 8479 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 8480 } 8481 8482 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 8483 params.ext_capab = 8484 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8485 params.ext_capab_len = 8486 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 8487 } 8488 8489 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 8490 params.link_sta_params.ht_capa = 8491 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 8492 8493 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 8494 params.link_sta_params.vht_capa = 8495 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 8496 8497 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 8498 params.link_sta_params.he_capa = 8499 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8500 params.link_sta_params.he_capa_len = 8501 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 8502 8503 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 8504 params.link_sta_params.eht_capa = 8505 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8506 params.link_sta_params.eht_capa_len = 8507 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 8508 8509 if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa, 8510 (const u8 *)params.link_sta_params.eht_capa, 8511 params.link_sta_params.eht_capa_len, 8512 false)) 8513 return -EINVAL; 8514 } 8515 } 8516 8517 if (info->attrs[NL80211_ATTR_EML_CAPABILITY]) { 8518 params.eml_cap_present = true; 8519 params.eml_cap = 8520 nla_get_u16(info->attrs[NL80211_ATTR_EML_CAPABILITY]); 8521 } 8522 8523 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 8524 params.link_sta_params.he_6ghz_capa = 8525 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 8526 8527 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 8528 params.link_sta_params.s1g_capa = 8529 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]); 8530 8531 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 8532 params.link_sta_params.opmode_notif_used = true; 8533 params.link_sta_params.opmode_notif = 8534 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 8535 } 8536 8537 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 8538 params.plink_action = 8539 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 8540 8541 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 8542 params.airtime_weight = 8543 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 8544 8545 if (params.airtime_weight && 8546 !wiphy_ext_feature_isset(&rdev->wiphy, 8547 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 8548 return -EOPNOTSUPP; 8549 8550 err = nl80211_parse_sta_txpower_setting(info, 8551 ¶ms.link_sta_params.txpwr, 8552 ¶ms.link_sta_params.txpwr_set); 8553 if (err) 8554 return err; 8555 8556 err = nl80211_parse_sta_channel_info(info, ¶ms); 8557 if (err) 8558 return err; 8559 8560 err = nl80211_parse_sta_wme(info, ¶ms); 8561 if (err) 8562 return err; 8563 8564 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 8565 return -EINVAL; 8566 8567 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT 8568 * as userspace might just pass through the capabilities from the IEs 8569 * directly, rather than enforcing this restriction and returning an 8570 * error in this case. 8571 */ 8572 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) { 8573 params.link_sta_params.ht_capa = NULL; 8574 params.link_sta_params.vht_capa = NULL; 8575 8576 /* HE and EHT require WME */ 8577 if (params.link_sta_params.he_capa_len || 8578 params.link_sta_params.he_6ghz_capa || 8579 params.link_sta_params.eht_capa_len) 8580 return -EINVAL; 8581 } 8582 8583 /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */ 8584 if (params.link_sta_params.he_6ghz_capa && 8585 (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa)) 8586 return -EINVAL; 8587 8588 /* When you run into this, adjust the code below for the new flag */ 8589 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 8590 8591 switch (dev->ieee80211_ptr->iftype) { 8592 case NL80211_IFTYPE_AP: 8593 case NL80211_IFTYPE_AP_VLAN: 8594 case NL80211_IFTYPE_P2P_GO: 8595 /* ignore WME attributes if iface/sta is not capable */ 8596 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) || 8597 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) 8598 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 8599 8600 /* TDLS peers cannot be added */ 8601 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 8602 info->attrs[NL80211_ATTR_PEER_AID]) 8603 return -EINVAL; 8604 /* but don't bother the driver with it */ 8605 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 8606 8607 /* allow authenticated/associated only if driver handles it */ 8608 if (!(rdev->wiphy.features & 8609 NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 8610 params.sta_flags_mask & auth_assoc) 8611 return -EINVAL; 8612 8613 if (!wiphy_ext_feature_isset(&rdev->wiphy, 8614 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT) && 8615 params.sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 8616 return -EINVAL; 8617 8618 /* Older userspace, or userspace wanting to be compatible with 8619 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth 8620 * and assoc flags in the mask, but assumes the station will be 8621 * added as associated anyway since this was the required driver 8622 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was 8623 * introduced. 8624 * In order to not bother drivers with this quirk in the API 8625 * set the flags in both the mask and set for new stations in 8626 * this case. 8627 */ 8628 if (!(params.sta_flags_mask & auth_assoc)) { 8629 params.sta_flags_mask |= auth_assoc; 8630 params.sta_flags_set |= auth_assoc; 8631 } 8632 8633 /* must be last in here for error handling */ 8634 params.vlan = get_vlan(info, rdev); 8635 if (IS_ERR(params.vlan)) 8636 return PTR_ERR(params.vlan); 8637 break; 8638 case NL80211_IFTYPE_MESH_POINT: 8639 /* ignore uAPSD data */ 8640 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 8641 8642 /* associated is disallowed */ 8643 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) 8644 return -EINVAL; 8645 /* TDLS peers cannot be added */ 8646 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 8647 info->attrs[NL80211_ATTR_PEER_AID]) 8648 return -EINVAL; 8649 break; 8650 case NL80211_IFTYPE_STATION: 8651 case NL80211_IFTYPE_P2P_CLIENT: 8652 /* ignore uAPSD data */ 8653 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 8654 8655 /* these are disallowed */ 8656 if (params.sta_flags_mask & 8657 (BIT(NL80211_STA_FLAG_ASSOCIATED) | 8658 BIT(NL80211_STA_FLAG_AUTHENTICATED))) 8659 return -EINVAL; 8660 /* Only TDLS peers can be added */ 8661 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 8662 return -EINVAL; 8663 /* Can only add if TDLS ... */ 8664 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS)) 8665 return -EOPNOTSUPP; 8666 /* ... with external setup is supported */ 8667 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP)) 8668 return -EOPNOTSUPP; 8669 /* 8670 * Older wpa_supplicant versions always mark the TDLS peer 8671 * as authorized, but it shouldn't yet be. 8672 */ 8673 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED); 8674 break; 8675 default: 8676 return -EOPNOTSUPP; 8677 } 8678 8679 /* be aware of params.vlan when changing code here */ 8680 8681 if (wdev->valid_links) { 8682 if (params.link_sta_params.link_id < 0) { 8683 err = -EINVAL; 8684 goto out; 8685 } 8686 if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) { 8687 err = -ENOLINK; 8688 goto out; 8689 } 8690 } else { 8691 if (params.link_sta_params.link_id >= 0) { 8692 err = -EINVAL; 8693 goto out; 8694 } 8695 } 8696 err = rdev_add_station(rdev, dev, mac_addr, ¶ms); 8697 out: 8698 dev_put(params.vlan); 8699 return err; 8700 } 8701 8702 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info) 8703 { 8704 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8705 struct net_device *dev = info->user_ptr[1]; 8706 struct wireless_dev *wdev = dev->ieee80211_ptr; 8707 struct station_del_parameters params; 8708 int link_id = nl80211_link_id_or_invalid(info->attrs); 8709 8710 memset(¶ms, 0, sizeof(params)); 8711 8712 if (info->attrs[NL80211_ATTR_MAC]) 8713 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 8714 8715 switch (wdev->iftype) { 8716 case NL80211_IFTYPE_AP: 8717 case NL80211_IFTYPE_AP_VLAN: 8718 case NL80211_IFTYPE_MESH_POINT: 8719 case NL80211_IFTYPE_P2P_GO: 8720 /* always accept these */ 8721 break; 8722 case NL80211_IFTYPE_ADHOC: 8723 /* conditionally accept */ 8724 if (wiphy_ext_feature_isset(&rdev->wiphy, 8725 NL80211_EXT_FEATURE_DEL_IBSS_STA)) 8726 break; 8727 return -EINVAL; 8728 default: 8729 return -EINVAL; 8730 } 8731 8732 if (!rdev->ops->del_station) 8733 return -EOPNOTSUPP; 8734 8735 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) { 8736 params.subtype = 8737 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]); 8738 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 && 8739 params.subtype != IEEE80211_STYPE_DEAUTH >> 4) 8740 return -EINVAL; 8741 } else { 8742 /* Default to Deauthentication frame */ 8743 params.subtype = IEEE80211_STYPE_DEAUTH >> 4; 8744 } 8745 8746 if (info->attrs[NL80211_ATTR_REASON_CODE]) { 8747 params.reason_code = 8748 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 8749 if (params.reason_code == 0) 8750 return -EINVAL; /* 0 is reserved */ 8751 } else { 8752 /* Default to reason code 2 */ 8753 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID; 8754 } 8755 8756 /* Link ID not expected in case of non-ML operation */ 8757 if (!wdev->valid_links && link_id != -1) 8758 return -EINVAL; 8759 8760 /* If given, a valid link ID should be passed during MLO */ 8761 if (wdev->valid_links && link_id >= 0 && 8762 !(wdev->valid_links & BIT(link_id))) 8763 return -EINVAL; 8764 8765 params.link_id = link_id; 8766 8767 return rdev_del_station(rdev, dev, ¶ms); 8768 } 8769 8770 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq, 8771 int flags, struct net_device *dev, 8772 u8 *dst, u8 *next_hop, 8773 struct mpath_info *pinfo) 8774 { 8775 void *hdr; 8776 struct nlattr *pinfoattr; 8777 8778 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH); 8779 if (!hdr) 8780 return -1; 8781 8782 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 8783 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) || 8784 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) || 8785 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation)) 8786 goto nla_put_failure; 8787 8788 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO); 8789 if (!pinfoattr) 8790 goto nla_put_failure; 8791 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) && 8792 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN, 8793 pinfo->frame_qlen)) 8794 goto nla_put_failure; 8795 if (((pinfo->filled & MPATH_INFO_SN) && 8796 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) || 8797 ((pinfo->filled & MPATH_INFO_METRIC) && 8798 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC, 8799 pinfo->metric)) || 8800 ((pinfo->filled & MPATH_INFO_EXPTIME) && 8801 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME, 8802 pinfo->exptime)) || 8803 ((pinfo->filled & MPATH_INFO_FLAGS) && 8804 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS, 8805 pinfo->flags)) || 8806 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) && 8807 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT, 8808 pinfo->discovery_timeout)) || 8809 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) && 8810 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES, 8811 pinfo->discovery_retries)) || 8812 ((pinfo->filled & MPATH_INFO_HOP_COUNT) && 8813 nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT, 8814 pinfo->hop_count)) || 8815 ((pinfo->filled & MPATH_INFO_PATH_CHANGE) && 8816 nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE, 8817 pinfo->path_change_count))) 8818 goto nla_put_failure; 8819 8820 nla_nest_end(msg, pinfoattr); 8821 8822 genlmsg_end(msg, hdr); 8823 return 0; 8824 8825 nla_put_failure: 8826 genlmsg_cancel(msg, hdr); 8827 return -EMSGSIZE; 8828 } 8829 8830 static int nl80211_dump_mpath(struct sk_buff *skb, 8831 struct netlink_callback *cb) 8832 { 8833 struct mpath_info pinfo; 8834 struct cfg80211_registered_device *rdev; 8835 struct wireless_dev *wdev; 8836 u8 dst[ETH_ALEN]; 8837 u8 next_hop[ETH_ALEN]; 8838 int path_idx = cb->args[2]; 8839 int err; 8840 8841 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 8842 if (err) 8843 return err; 8844 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 8845 __acquire(&rdev->wiphy.mtx); 8846 8847 if (!rdev->ops->dump_mpath) { 8848 err = -EOPNOTSUPP; 8849 goto out_err; 8850 } 8851 8852 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 8853 err = -EOPNOTSUPP; 8854 goto out_err; 8855 } 8856 8857 while (1) { 8858 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst, 8859 next_hop, &pinfo); 8860 if (err == -ENOENT) 8861 break; 8862 if (err) 8863 goto out_err; 8864 8865 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 8866 cb->nlh->nlmsg_seq, NLM_F_MULTI, 8867 wdev->netdev, dst, next_hop, 8868 &pinfo) < 0) 8869 goto out; 8870 8871 path_idx++; 8872 } 8873 8874 out: 8875 cb->args[2] = path_idx; 8876 err = skb->len; 8877 out_err: 8878 wiphy_unlock(&rdev->wiphy); 8879 return err; 8880 } 8881 8882 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info) 8883 { 8884 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8885 int err; 8886 struct net_device *dev = info->user_ptr[1]; 8887 struct mpath_info pinfo; 8888 struct sk_buff *msg; 8889 u8 *dst = NULL; 8890 u8 next_hop[ETH_ALEN]; 8891 8892 memset(&pinfo, 0, sizeof(pinfo)); 8893 8894 if (!info->attrs[NL80211_ATTR_MAC]) 8895 return -EINVAL; 8896 8897 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8898 8899 if (!rdev->ops->get_mpath) 8900 return -EOPNOTSUPP; 8901 8902 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8903 return -EOPNOTSUPP; 8904 8905 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo); 8906 if (err) 8907 return err; 8908 8909 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8910 if (!msg) 8911 return -ENOMEM; 8912 8913 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 8914 dev, dst, next_hop, &pinfo) < 0) { 8915 nlmsg_free(msg); 8916 return -ENOBUFS; 8917 } 8918 8919 return genlmsg_reply(msg, info); 8920 } 8921 8922 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info) 8923 { 8924 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8925 struct net_device *dev = info->user_ptr[1]; 8926 u8 *dst = NULL; 8927 u8 *next_hop = NULL; 8928 8929 if (!info->attrs[NL80211_ATTR_MAC]) 8930 return -EINVAL; 8931 8932 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 8933 return -EINVAL; 8934 8935 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8936 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 8937 8938 if (!rdev->ops->change_mpath) 8939 return -EOPNOTSUPP; 8940 8941 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8942 return -EOPNOTSUPP; 8943 8944 return rdev_change_mpath(rdev, dev, dst, next_hop); 8945 } 8946 8947 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info) 8948 { 8949 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8950 struct net_device *dev = info->user_ptr[1]; 8951 u8 *dst = NULL; 8952 u8 *next_hop = NULL; 8953 8954 if (!info->attrs[NL80211_ATTR_MAC]) 8955 return -EINVAL; 8956 8957 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 8958 return -EINVAL; 8959 8960 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8961 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 8962 8963 if (!rdev->ops->add_mpath) 8964 return -EOPNOTSUPP; 8965 8966 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8967 return -EOPNOTSUPP; 8968 8969 return rdev_add_mpath(rdev, dev, dst, next_hop); 8970 } 8971 8972 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info) 8973 { 8974 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8975 struct net_device *dev = info->user_ptr[1]; 8976 u8 *dst = NULL; 8977 8978 if (info->attrs[NL80211_ATTR_MAC]) 8979 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8980 8981 if (!rdev->ops->del_mpath) 8982 return -EOPNOTSUPP; 8983 8984 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8985 return -EOPNOTSUPP; 8986 8987 return rdev_del_mpath(rdev, dev, dst); 8988 } 8989 8990 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info) 8991 { 8992 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8993 int err; 8994 struct net_device *dev = info->user_ptr[1]; 8995 struct mpath_info pinfo; 8996 struct sk_buff *msg; 8997 u8 *dst = NULL; 8998 u8 mpp[ETH_ALEN]; 8999 9000 memset(&pinfo, 0, sizeof(pinfo)); 9001 9002 if (!info->attrs[NL80211_ATTR_MAC]) 9003 return -EINVAL; 9004 9005 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 9006 9007 if (!rdev->ops->get_mpp) 9008 return -EOPNOTSUPP; 9009 9010 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 9011 return -EOPNOTSUPP; 9012 9013 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo); 9014 if (err) 9015 return err; 9016 9017 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 9018 if (!msg) 9019 return -ENOMEM; 9020 9021 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 9022 dev, dst, mpp, &pinfo) < 0) { 9023 nlmsg_free(msg); 9024 return -ENOBUFS; 9025 } 9026 9027 return genlmsg_reply(msg, info); 9028 } 9029 9030 static int nl80211_dump_mpp(struct sk_buff *skb, 9031 struct netlink_callback *cb) 9032 { 9033 struct mpath_info pinfo; 9034 struct cfg80211_registered_device *rdev; 9035 struct wireless_dev *wdev; 9036 u8 dst[ETH_ALEN]; 9037 u8 mpp[ETH_ALEN]; 9038 int path_idx = cb->args[2]; 9039 int err; 9040 9041 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 9042 if (err) 9043 return err; 9044 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 9045 __acquire(&rdev->wiphy.mtx); 9046 9047 if (!rdev->ops->dump_mpp) { 9048 err = -EOPNOTSUPP; 9049 goto out_err; 9050 } 9051 9052 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 9053 err = -EOPNOTSUPP; 9054 goto out_err; 9055 } 9056 9057 while (1) { 9058 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst, 9059 mpp, &pinfo); 9060 if (err == -ENOENT) 9061 break; 9062 if (err) 9063 goto out_err; 9064 9065 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 9066 cb->nlh->nlmsg_seq, NLM_F_MULTI, 9067 wdev->netdev, dst, mpp, 9068 &pinfo) < 0) 9069 goto out; 9070 9071 path_idx++; 9072 } 9073 9074 out: 9075 cb->args[2] = path_idx; 9076 err = skb->len; 9077 out_err: 9078 wiphy_unlock(&rdev->wiphy); 9079 return err; 9080 } 9081 9082 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info) 9083 { 9084 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9085 struct net_device *dev = info->user_ptr[1]; 9086 struct bss_parameters params; 9087 u32 bss_param_support = rdev->wiphy.bss_param_support; 9088 u32 changed = 0; 9089 bool strict; 9090 9091 memset(¶ms, 0, sizeof(params)); 9092 params.link_id = nl80211_link_id_or_invalid(info->attrs); 9093 /* default to not changing parameters */ 9094 params.use_cts_prot = -1; 9095 params.use_short_preamble = -1; 9096 params.use_short_slot_time = -1; 9097 params.ap_isolate = -1; 9098 params.ht_opmode = -1; 9099 params.p2p_ctwindow = -1; 9100 params.p2p_opp_ps = -1; 9101 9102 strict = nla_get_flag(info->attrs[NL80211_ATTR_BSS_PARAM]); 9103 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT]) { 9104 if (strict && !(bss_param_support & WIPHY_BSS_PARAM_CTS_PROT)) 9105 return -EINVAL; 9106 params.use_cts_prot = 9107 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]); 9108 changed |= WIPHY_BSS_PARAM_CTS_PROT; 9109 } 9110 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]) { 9111 if (strict && 9112 !(bss_param_support & WIPHY_BSS_PARAM_SHORT_PREAMBLE)) 9113 return -EINVAL; 9114 params.use_short_preamble = 9115 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]); 9116 changed |= WIPHY_BSS_PARAM_SHORT_PREAMBLE; 9117 } 9118 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]) { 9119 if (strict && 9120 !(bss_param_support & WIPHY_BSS_PARAM_SHORT_SLOT_TIME)) 9121 return -EINVAL; 9122 params.use_short_slot_time = 9123 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]); 9124 changed |= WIPHY_BSS_PARAM_SHORT_SLOT_TIME; 9125 } 9126 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 9127 if (strict && 9128 !(bss_param_support & WIPHY_BSS_PARAM_BASIC_RATES)) 9129 return -EINVAL; 9130 params.basic_rates = 9131 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 9132 params.basic_rates_len = 9133 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 9134 changed |= WIPHY_BSS_PARAM_BASIC_RATES; 9135 } 9136 if (info->attrs[NL80211_ATTR_AP_ISOLATE]) { 9137 if (strict && !(bss_param_support & WIPHY_BSS_PARAM_AP_ISOLATE)) 9138 return -EINVAL; 9139 params.ap_isolate = 9140 !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]); 9141 changed |= WIPHY_BSS_PARAM_AP_ISOLATE; 9142 } 9143 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE]) { 9144 if (strict && !(bss_param_support & WIPHY_BSS_PARAM_HT_OPMODE)) 9145 return -EINVAL; 9146 params.ht_opmode = 9147 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]); 9148 changed |= WIPHY_BSS_PARAM_HT_OPMODE; 9149 } 9150 9151 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 9152 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 9153 return -EINVAL; 9154 params.p2p_ctwindow = 9155 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 9156 if (params.p2p_ctwindow != 0 && 9157 !(bss_param_support & WIPHY_BSS_PARAM_P2P_CTWINDOW)) 9158 return -EINVAL; 9159 changed |= WIPHY_BSS_PARAM_P2P_CTWINDOW; 9160 } 9161 9162 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 9163 u8 tmp; 9164 9165 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 9166 return -EINVAL; 9167 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 9168 if (tmp && !(bss_param_support & WIPHY_BSS_PARAM_P2P_OPPPS)) 9169 return -EINVAL; 9170 params.p2p_opp_ps = tmp; 9171 if (params.p2p_opp_ps && 9172 !(rdev->wiphy.bss_param_support & WIPHY_BSS_PARAM_P2P_OPPPS)) 9173 return -EINVAL; 9174 } 9175 9176 if (!rdev->ops->change_bss) 9177 return -EOPNOTSUPP; 9178 9179 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 9180 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 9181 return -EOPNOTSUPP; 9182 9183 changed &= rdev->wiphy.bss_param_support; 9184 if (!changed) 9185 return 0; 9186 9187 return rdev_change_bss(rdev, dev, ¶ms); 9188 } 9189 9190 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info) 9191 { 9192 char *data = NULL; 9193 bool is_indoor; 9194 enum nl80211_user_reg_hint_type user_reg_hint_type; 9195 u32 owner_nlportid; 9196 9197 /* 9198 * You should only get this when cfg80211 hasn't yet initialized 9199 * completely when built-in to the kernel right between the time 9200 * window between nl80211_init() and regulatory_init(), if that is 9201 * even possible. 9202 */ 9203 if (unlikely(!rcu_access_pointer(cfg80211_regdomain))) 9204 return -EINPROGRESS; 9205 9206 user_reg_hint_type = 9207 nla_get_u32_default(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE], 9208 NL80211_USER_REG_HINT_USER); 9209 9210 switch (user_reg_hint_type) { 9211 case NL80211_USER_REG_HINT_USER: 9212 case NL80211_USER_REG_HINT_CELL_BASE: 9213 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 9214 return -EINVAL; 9215 9216 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 9217 return regulatory_hint_user(data, user_reg_hint_type); 9218 case NL80211_USER_REG_HINT_INDOOR: 9219 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 9220 owner_nlportid = info->snd_portid; 9221 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR]; 9222 } else { 9223 owner_nlportid = 0; 9224 is_indoor = true; 9225 } 9226 9227 regulatory_hint_indoor(is_indoor, owner_nlportid); 9228 return 0; 9229 default: 9230 return -EINVAL; 9231 } 9232 } 9233 9234 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info) 9235 { 9236 return reg_reload_regdb(); 9237 } 9238 9239 static int nl80211_get_mesh_config(struct sk_buff *skb, 9240 struct genl_info *info) 9241 { 9242 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9243 struct net_device *dev = info->user_ptr[1]; 9244 struct wireless_dev *wdev = dev->ieee80211_ptr; 9245 struct mesh_config cur_params; 9246 int err = 0; 9247 void *hdr; 9248 struct nlattr *pinfoattr; 9249 struct sk_buff *msg; 9250 9251 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 9252 return -EOPNOTSUPP; 9253 9254 if (!rdev->ops->get_mesh_config) 9255 return -EOPNOTSUPP; 9256 9257 /* If not connected, get default parameters */ 9258 if (!wdev->u.mesh.id_len) 9259 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params)); 9260 else 9261 err = rdev_get_mesh_config(rdev, dev, &cur_params); 9262 9263 if (err) 9264 return err; 9265 9266 /* Draw up a netlink message to send back */ 9267 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 9268 if (!msg) 9269 return -ENOMEM; 9270 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 9271 NL80211_CMD_GET_MESH_CONFIG); 9272 if (!hdr) 9273 goto out; 9274 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG); 9275 if (!pinfoattr) 9276 goto nla_put_failure; 9277 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 9278 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT, 9279 cur_params.dot11MeshRetryTimeout) || 9280 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT, 9281 cur_params.dot11MeshConfirmTimeout) || 9282 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT, 9283 cur_params.dot11MeshHoldingTimeout) || 9284 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS, 9285 cur_params.dot11MeshMaxPeerLinks) || 9286 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES, 9287 cur_params.dot11MeshMaxRetries) || 9288 nla_put_u8(msg, NL80211_MESHCONF_TTL, 9289 cur_params.dot11MeshTTL) || 9290 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL, 9291 cur_params.element_ttl) || 9292 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS, 9293 cur_params.auto_open_plinks) || 9294 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 9295 cur_params.dot11MeshNbrOffsetMaxNeighbor) || 9296 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 9297 cur_params.dot11MeshHWMPmaxPREQretries) || 9298 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME, 9299 cur_params.path_refresh_time) || 9300 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 9301 cur_params.min_discovery_timeout) || 9302 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 9303 cur_params.dot11MeshHWMPactivePathTimeout) || 9304 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 9305 cur_params.dot11MeshHWMPpreqMinInterval) || 9306 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 9307 cur_params.dot11MeshHWMPperrMinInterval) || 9308 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 9309 cur_params.dot11MeshHWMPnetDiameterTraversalTime) || 9310 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE, 9311 cur_params.dot11MeshHWMPRootMode) || 9312 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL, 9313 cur_params.dot11MeshHWMPRannInterval) || 9314 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 9315 cur_params.dot11MeshGateAnnouncementProtocol) || 9316 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING, 9317 cur_params.dot11MeshForwarding) || 9318 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD, 9319 cur_params.rssi_threshold) || 9320 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE, 9321 cur_params.ht_opmode) || 9322 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 9323 cur_params.dot11MeshHWMPactivePathToRootTimeout) || 9324 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 9325 cur_params.dot11MeshHWMProotInterval) || 9326 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 9327 cur_params.dot11MeshHWMPconfirmationInterval) || 9328 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE, 9329 cur_params.power_mode) || 9330 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW, 9331 cur_params.dot11MeshAwakeWindowDuration) || 9332 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT, 9333 cur_params.plink_timeout) || 9334 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE, 9335 cur_params.dot11MeshConnectedToMeshGate) || 9336 nla_put_u8(msg, NL80211_MESHCONF_NOLEARN, 9337 cur_params.dot11MeshNolearn) || 9338 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS, 9339 cur_params.dot11MeshConnectedToAuthServer)) 9340 goto nla_put_failure; 9341 nla_nest_end(msg, pinfoattr); 9342 genlmsg_end(msg, hdr); 9343 return genlmsg_reply(msg, info); 9344 9345 nla_put_failure: 9346 out: 9347 nlmsg_free(msg); 9348 return -ENOBUFS; 9349 } 9350 9351 static const struct nla_policy 9352 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = { 9353 [NL80211_MESHCONF_RETRY_TIMEOUT] = 9354 NLA_POLICY_RANGE(NLA_U16, 1, 255), 9355 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = 9356 NLA_POLICY_RANGE(NLA_U16, 1, 255), 9357 [NL80211_MESHCONF_HOLDING_TIMEOUT] = 9358 NLA_POLICY_RANGE(NLA_U16, 1, 255), 9359 [NL80211_MESHCONF_MAX_PEER_LINKS] = 9360 NLA_POLICY_RANGE(NLA_U16, 0, 255), 9361 [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16), 9362 [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 9363 [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 9364 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1), 9365 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = 9366 NLA_POLICY_RANGE(NLA_U32, 1, 255), 9367 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 }, 9368 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 }, 9369 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1), 9370 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 }, 9371 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = 9372 NLA_POLICY_MIN(NLA_U16, 1), 9373 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = 9374 NLA_POLICY_MIN(NLA_U16, 1), 9375 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = 9376 NLA_POLICY_MIN(NLA_U16, 1), 9377 [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4), 9378 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = 9379 NLA_POLICY_MIN(NLA_U16, 1), 9380 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1), 9381 [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1), 9382 [NL80211_MESHCONF_RSSI_THRESHOLD] = 9383 NLA_POLICY_RANGE(NLA_S32, -255, 0), 9384 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 }, 9385 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 }, 9386 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = 9387 NLA_POLICY_MIN(NLA_U16, 1), 9388 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = 9389 NLA_POLICY_MIN(NLA_U16, 1), 9390 [NL80211_MESHCONF_POWER_MODE] = 9391 NLA_POLICY_RANGE(NLA_U32, 9392 NL80211_MESH_POWER_ACTIVE, 9393 NL80211_MESH_POWER_MAX), 9394 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 }, 9395 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 }, 9396 [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 9397 [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 9398 [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 9399 }; 9400 9401 static const struct nla_policy 9402 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = { 9403 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 }, 9404 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 }, 9405 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 }, 9406 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG }, 9407 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 }, 9408 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG }, 9409 [NL80211_MESH_SETUP_IE] = 9410 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 9411 IEEE80211_MAX_DATA_LEN), 9412 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG }, 9413 }; 9414 9415 static int nl80211_parse_mesh_config(struct genl_info *info, 9416 struct mesh_config *cfg, 9417 u32 *mask_out) 9418 { 9419 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1]; 9420 u32 mask = 0; 9421 u16 ht_opmode; 9422 9423 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \ 9424 do { \ 9425 if (tb[attr]) { \ 9426 cfg->param = fn(tb[attr]); \ 9427 mask |= BIT((attr) - 1); \ 9428 } \ 9429 } while (0) 9430 9431 if (!info->attrs[NL80211_ATTR_MESH_CONFIG]) 9432 return -EINVAL; 9433 if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack)) 9434 return -EINVAL; 9435 9436 /* This makes sure that there aren't more than 32 mesh config 9437 * parameters (otherwise our bitfield scheme would not work.) */ 9438 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32); 9439 9440 /* Fill in the params struct */ 9441 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask, 9442 NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16); 9443 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask, 9444 NL80211_MESHCONF_CONFIRM_TIMEOUT, 9445 nla_get_u16); 9446 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask, 9447 NL80211_MESHCONF_HOLDING_TIMEOUT, 9448 nla_get_u16); 9449 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask, 9450 NL80211_MESHCONF_MAX_PEER_LINKS, 9451 nla_get_u16); 9452 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask, 9453 NL80211_MESHCONF_MAX_RETRIES, nla_get_u8); 9454 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask, 9455 NL80211_MESHCONF_TTL, nla_get_u8); 9456 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask, 9457 NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8); 9458 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask, 9459 NL80211_MESHCONF_AUTO_OPEN_PLINKS, 9460 nla_get_u8); 9461 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, 9462 mask, 9463 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 9464 nla_get_u32); 9465 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask, 9466 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 9467 nla_get_u8); 9468 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask, 9469 NL80211_MESHCONF_PATH_REFRESH_TIME, 9470 nla_get_u32); 9471 if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) && 9472 (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535)) 9473 return -EINVAL; 9474 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask, 9475 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 9476 nla_get_u16); 9477 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, 9478 mask, 9479 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 9480 nla_get_u32); 9481 if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) && 9482 (cfg->dot11MeshHWMPactivePathTimeout < 1 || 9483 cfg->dot11MeshHWMPactivePathTimeout > 65535)) 9484 return -EINVAL; 9485 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask, 9486 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 9487 nla_get_u16); 9488 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask, 9489 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 9490 nla_get_u16); 9491 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 9492 dot11MeshHWMPnetDiameterTraversalTime, mask, 9493 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 9494 nla_get_u16); 9495 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask, 9496 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8); 9497 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask, 9498 NL80211_MESHCONF_HWMP_RANN_INTERVAL, 9499 nla_get_u16); 9500 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol, 9501 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 9502 nla_get_u8); 9503 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask, 9504 NL80211_MESHCONF_FORWARDING, nla_get_u8); 9505 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask, 9506 NL80211_MESHCONF_RSSI_THRESHOLD, 9507 nla_get_s32); 9508 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask, 9509 NL80211_MESHCONF_CONNECTED_TO_GATE, 9510 nla_get_u8); 9511 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask, 9512 NL80211_MESHCONF_CONNECTED_TO_AS, 9513 nla_get_u8); 9514 /* 9515 * Check HT operation mode based on 9516 * IEEE 802.11-2016 9.4.2.57 HT Operation element. 9517 */ 9518 if (tb[NL80211_MESHCONF_HT_OPMODE]) { 9519 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]); 9520 9521 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION | 9522 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT | 9523 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)) 9524 return -EINVAL; 9525 9526 /* NON_HT_STA bit is reserved, but some programs set it */ 9527 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT; 9528 9529 cfg->ht_opmode = ht_opmode; 9530 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1)); 9531 } 9532 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 9533 dot11MeshHWMPactivePathToRootTimeout, mask, 9534 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 9535 nla_get_u32); 9536 if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) && 9537 (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 || 9538 cfg->dot11MeshHWMPactivePathToRootTimeout > 65535)) 9539 return -EINVAL; 9540 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask, 9541 NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 9542 nla_get_u16); 9543 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval, 9544 mask, 9545 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 9546 nla_get_u16); 9547 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask, 9548 NL80211_MESHCONF_POWER_MODE, nla_get_u32); 9549 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask, 9550 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16); 9551 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask, 9552 NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32); 9553 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask, 9554 NL80211_MESHCONF_NOLEARN, nla_get_u8); 9555 if (mask_out) 9556 *mask_out = mask; 9557 9558 return 0; 9559 9560 #undef FILL_IN_MESH_PARAM_IF_SET 9561 } 9562 9563 static int nl80211_parse_mesh_setup(struct genl_info *info, 9564 struct mesh_setup *setup) 9565 { 9566 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9567 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1]; 9568 9569 if (!info->attrs[NL80211_ATTR_MESH_SETUP]) 9570 return -EINVAL; 9571 if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack)) 9572 return -EINVAL; 9573 9574 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC]) 9575 setup->sync_method = 9576 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ? 9577 IEEE80211_SYNC_METHOD_VENDOR : 9578 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET; 9579 9580 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL]) 9581 setup->path_sel_proto = 9582 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ? 9583 IEEE80211_PATH_PROTOCOL_VENDOR : 9584 IEEE80211_PATH_PROTOCOL_HWMP; 9585 9586 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC]) 9587 setup->path_metric = 9588 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ? 9589 IEEE80211_PATH_METRIC_VENDOR : 9590 IEEE80211_PATH_METRIC_AIRTIME; 9591 9592 if (tb[NL80211_MESH_SETUP_IE]) { 9593 struct nlattr *ieattr = 9594 tb[NL80211_MESH_SETUP_IE]; 9595 setup->ie = nla_data(ieattr); 9596 setup->ie_len = nla_len(ieattr); 9597 } 9598 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] && 9599 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM)) 9600 return -EINVAL; 9601 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]); 9602 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]); 9603 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]); 9604 if (setup->is_secure) 9605 setup->user_mpm = true; 9606 9607 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) { 9608 if (!setup->user_mpm) 9609 return -EINVAL; 9610 setup->auth_id = 9611 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]); 9612 } 9613 9614 return 0; 9615 } 9616 9617 static int nl80211_update_mesh_config(struct sk_buff *skb, 9618 struct genl_info *info) 9619 { 9620 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9621 struct net_device *dev = info->user_ptr[1]; 9622 struct wireless_dev *wdev = dev->ieee80211_ptr; 9623 struct mesh_config cfg = {}; 9624 u32 mask; 9625 int err; 9626 9627 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 9628 return -EOPNOTSUPP; 9629 9630 if (!rdev->ops->update_mesh_config) 9631 return -EOPNOTSUPP; 9632 9633 err = nl80211_parse_mesh_config(info, &cfg, &mask); 9634 if (err) 9635 return err; 9636 9637 if (!wdev->u.mesh.id_len) 9638 err = -ENOLINK; 9639 9640 if (!err) 9641 err = rdev_update_mesh_config(rdev, dev, mask, &cfg); 9642 9643 return err; 9644 } 9645 9646 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom, 9647 struct sk_buff *msg) 9648 { 9649 struct nlattr *nl_reg_rules; 9650 unsigned int i; 9651 9652 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) || 9653 (regdom->dfs_region && 9654 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region))) 9655 goto nla_put_failure; 9656 9657 nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES); 9658 if (!nl_reg_rules) 9659 goto nla_put_failure; 9660 9661 for (i = 0; i < regdom->n_reg_rules; i++) { 9662 struct nlattr *nl_reg_rule; 9663 const struct ieee80211_reg_rule *reg_rule; 9664 const struct ieee80211_freq_range *freq_range; 9665 const struct ieee80211_power_rule *power_rule; 9666 unsigned int max_bandwidth_khz; 9667 9668 reg_rule = ®dom->reg_rules[i]; 9669 freq_range = ®_rule->freq_range; 9670 power_rule = ®_rule->power_rule; 9671 9672 nl_reg_rule = nla_nest_start_noflag(msg, i); 9673 if (!nl_reg_rule) 9674 goto nla_put_failure; 9675 9676 max_bandwidth_khz = freq_range->max_bandwidth_khz; 9677 if (!max_bandwidth_khz) 9678 max_bandwidth_khz = reg_get_max_bandwidth(regdom, 9679 reg_rule); 9680 9681 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS, 9682 reg_rule->flags) || 9683 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START, 9684 freq_range->start_freq_khz) || 9685 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END, 9686 freq_range->end_freq_khz) || 9687 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW, 9688 max_bandwidth_khz) || 9689 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN, 9690 power_rule->max_antenna_gain) || 9691 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP, 9692 power_rule->max_eirp) || 9693 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME, 9694 reg_rule->dfs_cac_ms)) 9695 goto nla_put_failure; 9696 9697 if ((reg_rule->flags & NL80211_RRF_PSD) && 9698 nla_put_s8(msg, NL80211_ATTR_POWER_RULE_PSD, 9699 reg_rule->psd)) 9700 goto nla_put_failure; 9701 9702 nla_nest_end(msg, nl_reg_rule); 9703 } 9704 9705 nla_nest_end(msg, nl_reg_rules); 9706 return 0; 9707 9708 nla_put_failure: 9709 return -EMSGSIZE; 9710 } 9711 9712 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info) 9713 { 9714 const struct ieee80211_regdomain *regdom = NULL; 9715 struct cfg80211_registered_device *rdev; 9716 struct wiphy *wiphy = NULL; 9717 struct sk_buff *msg; 9718 int err = -EMSGSIZE; 9719 void *hdr; 9720 9721 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 9722 if (!msg) 9723 return -ENOBUFS; 9724 9725 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 9726 NL80211_CMD_GET_REG); 9727 if (!hdr) 9728 goto put_failure; 9729 9730 rtnl_lock(); 9731 9732 if (info->attrs[NL80211_ATTR_WIPHY]) { 9733 bool self_managed; 9734 9735 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 9736 if (IS_ERR(rdev)) { 9737 err = PTR_ERR(rdev); 9738 goto nla_put_failure; 9739 } 9740 9741 wiphy = &rdev->wiphy; 9742 self_managed = wiphy->regulatory_flags & 9743 REGULATORY_WIPHY_SELF_MANAGED; 9744 9745 rcu_read_lock(); 9746 9747 regdom = get_wiphy_regdom(wiphy); 9748 9749 /* a self-managed-reg device must have a private regdom */ 9750 if (WARN_ON(!regdom && self_managed)) { 9751 err = -EINVAL; 9752 goto nla_put_failure_rcu; 9753 } 9754 9755 if (regdom && 9756 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 9757 goto nla_put_failure_rcu; 9758 } else { 9759 rcu_read_lock(); 9760 } 9761 9762 if (!wiphy && reg_last_request_cell_base() && 9763 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 9764 NL80211_USER_REG_HINT_CELL_BASE)) 9765 goto nla_put_failure_rcu; 9766 9767 if (!regdom) 9768 regdom = rcu_dereference(cfg80211_regdomain); 9769 9770 if (nl80211_put_regdom(regdom, msg)) 9771 goto nla_put_failure_rcu; 9772 9773 rcu_read_unlock(); 9774 9775 genlmsg_end(msg, hdr); 9776 rtnl_unlock(); 9777 return genlmsg_reply(msg, info); 9778 9779 nla_put_failure_rcu: 9780 rcu_read_unlock(); 9781 nla_put_failure: 9782 rtnl_unlock(); 9783 put_failure: 9784 nlmsg_free(msg); 9785 return err; 9786 } 9787 9788 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb, 9789 u32 seq, int flags, struct wiphy *wiphy, 9790 const struct ieee80211_regdomain *regdom) 9791 { 9792 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 9793 NL80211_CMD_GET_REG); 9794 9795 if (!hdr) 9796 return -1; 9797 9798 genl_dump_check_consistent(cb, hdr); 9799 9800 if (nl80211_put_regdom(regdom, msg)) 9801 goto nla_put_failure; 9802 9803 if (!wiphy && reg_last_request_cell_base() && 9804 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 9805 NL80211_USER_REG_HINT_CELL_BASE)) 9806 goto nla_put_failure; 9807 9808 if (wiphy && 9809 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 9810 goto nla_put_failure; 9811 9812 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 9813 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 9814 goto nla_put_failure; 9815 9816 genlmsg_end(msg, hdr); 9817 return 0; 9818 9819 nla_put_failure: 9820 genlmsg_cancel(msg, hdr); 9821 return -EMSGSIZE; 9822 } 9823 9824 static int nl80211_get_reg_dump(struct sk_buff *skb, 9825 struct netlink_callback *cb) 9826 { 9827 const struct ieee80211_regdomain *regdom = NULL; 9828 struct cfg80211_registered_device *rdev; 9829 int err, reg_idx, start = cb->args[2]; 9830 9831 rcu_read_lock(); 9832 9833 if (cfg80211_regdomain && start == 0) { 9834 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 9835 NLM_F_MULTI, NULL, 9836 rcu_dereference(cfg80211_regdomain)); 9837 if (err < 0) 9838 goto out_err; 9839 } 9840 9841 /* the global regdom is idx 0 */ 9842 reg_idx = 1; 9843 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 9844 regdom = get_wiphy_regdom(&rdev->wiphy); 9845 if (!regdom) 9846 continue; 9847 9848 if (++reg_idx <= start) 9849 continue; 9850 9851 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 9852 NLM_F_MULTI, &rdev->wiphy, regdom); 9853 if (err < 0) { 9854 reg_idx--; 9855 break; 9856 } 9857 } 9858 9859 cb->args[2] = reg_idx; 9860 err = skb->len; 9861 out_err: 9862 rcu_read_unlock(); 9863 return err; 9864 } 9865 9866 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 9867 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = { 9868 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 }, 9869 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 }, 9870 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 }, 9871 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 }, 9872 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 }, 9873 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 }, 9874 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 }, 9875 }; 9876 9877 static int parse_reg_rule(struct nlattr *tb[], 9878 struct ieee80211_reg_rule *reg_rule) 9879 { 9880 struct ieee80211_freq_range *freq_range = ®_rule->freq_range; 9881 struct ieee80211_power_rule *power_rule = ®_rule->power_rule; 9882 9883 if (!tb[NL80211_ATTR_REG_RULE_FLAGS]) 9884 return -EINVAL; 9885 if (!tb[NL80211_ATTR_FREQ_RANGE_START]) 9886 return -EINVAL; 9887 if (!tb[NL80211_ATTR_FREQ_RANGE_END]) 9888 return -EINVAL; 9889 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]) 9890 return -EINVAL; 9891 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]) 9892 return -EINVAL; 9893 9894 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]); 9895 9896 freq_range->start_freq_khz = 9897 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]); 9898 freq_range->end_freq_khz = 9899 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]); 9900 freq_range->max_bandwidth_khz = 9901 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]); 9902 9903 power_rule->max_eirp = 9904 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]); 9905 9906 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]) 9907 power_rule->max_antenna_gain = 9908 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]); 9909 9910 if (tb[NL80211_ATTR_DFS_CAC_TIME]) 9911 reg_rule->dfs_cac_ms = 9912 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]); 9913 9914 return 0; 9915 } 9916 9917 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info) 9918 { 9919 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1]; 9920 struct nlattr *nl_reg_rule; 9921 char *alpha2; 9922 int rem_reg_rules, r; 9923 u32 num_rules = 0, rule_idx = 0; 9924 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET; 9925 struct ieee80211_regdomain *rd; 9926 9927 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 9928 return -EINVAL; 9929 9930 if (!info->attrs[NL80211_ATTR_REG_RULES]) 9931 return -EINVAL; 9932 9933 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 9934 9935 if (info->attrs[NL80211_ATTR_DFS_REGION]) 9936 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]); 9937 9938 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 9939 rem_reg_rules) { 9940 num_rules++; 9941 if (num_rules > NL80211_MAX_SUPP_REG_RULES) 9942 return -EINVAL; 9943 } 9944 9945 rtnl_lock(); 9946 if (!reg_is_valid_request(alpha2)) { 9947 r = -EINVAL; 9948 goto out; 9949 } 9950 9951 rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL); 9952 if (!rd) { 9953 r = -ENOMEM; 9954 goto out; 9955 } 9956 9957 rd->n_reg_rules = num_rules; 9958 rd->alpha2[0] = alpha2[0]; 9959 rd->alpha2[1] = alpha2[1]; 9960 9961 /* 9962 * Disable DFS master mode if the DFS region was 9963 * not supported or known on this kernel. 9964 */ 9965 if (reg_supported_dfs_region(dfs_region)) 9966 rd->dfs_region = dfs_region; 9967 9968 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 9969 rem_reg_rules) { 9970 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX, 9971 nl_reg_rule, reg_rule_policy, 9972 info->extack); 9973 if (r) 9974 goto bad_reg; 9975 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]); 9976 if (r) 9977 goto bad_reg; 9978 9979 rule_idx++; 9980 9981 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) { 9982 r = -EINVAL; 9983 goto bad_reg; 9984 } 9985 } 9986 9987 r = set_regdom(rd, REGD_SOURCE_CRDA); 9988 /* set_regdom takes ownership of rd */ 9989 rd = NULL; 9990 bad_reg: 9991 kfree(rd); 9992 out: 9993 rtnl_unlock(); 9994 return r; 9995 } 9996 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */ 9997 9998 static int validate_scan_freqs(struct nlattr *freqs) 9999 { 10000 struct nlattr *attr1, *attr2; 10001 int n_channels = 0, tmp1, tmp2; 10002 10003 nla_for_each_nested(attr1, freqs, tmp1) 10004 if (nla_len(attr1) != sizeof(u32)) 10005 return 0; 10006 10007 nla_for_each_nested(attr1, freqs, tmp1) { 10008 n_channels++; 10009 /* 10010 * Some hardware has a limited channel list for 10011 * scanning, and it is pretty much nonsensical 10012 * to scan for a channel twice, so disallow that 10013 * and don't require drivers to check that the 10014 * channel list they get isn't longer than what 10015 * they can scan, as long as they can scan all 10016 * the channels they registered at once. 10017 */ 10018 nla_for_each_nested(attr2, freqs, tmp2) 10019 if (attr1 != attr2 && 10020 nla_get_u32(attr1) == nla_get_u32(attr2)) 10021 return 0; 10022 } 10023 10024 return n_channels; 10025 } 10026 10027 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b) 10028 { 10029 return b < NUM_NL80211_BANDS && wiphy->bands[b]; 10030 } 10031 10032 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy, 10033 struct cfg80211_bss_selection *bss_select) 10034 { 10035 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1]; 10036 struct nlattr *nest; 10037 int err; 10038 bool found = false; 10039 int i; 10040 10041 /* only process one nested attribute */ 10042 nest = nla_data(nla); 10043 if (!nla_ok(nest, nla_len(nest))) 10044 return -EINVAL; 10045 10046 err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX, 10047 nest, nl80211_bss_select_policy, 10048 NULL); 10049 if (err) 10050 return err; 10051 10052 /* only one attribute may be given */ 10053 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) { 10054 if (attr[i]) { 10055 if (found) 10056 return -EINVAL; 10057 found = true; 10058 } 10059 } 10060 10061 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID; 10062 10063 if (attr[NL80211_BSS_SELECT_ATTR_RSSI]) 10064 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI; 10065 10066 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) { 10067 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF; 10068 bss_select->param.band_pref = 10069 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]); 10070 if (!is_band_valid(wiphy, bss_select->param.band_pref)) 10071 return -EINVAL; 10072 } 10073 10074 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) { 10075 struct nl80211_bss_select_rssi_adjust *adj_param; 10076 10077 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]); 10078 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST; 10079 bss_select->param.adjust.band = adj_param->band; 10080 bss_select->param.adjust.delta = adj_param->delta; 10081 if (!is_band_valid(wiphy, bss_select->param.adjust.band)) 10082 return -EINVAL; 10083 } 10084 10085 /* user-space did not provide behaviour attribute */ 10086 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID) 10087 return -EINVAL; 10088 10089 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour))) 10090 return -EINVAL; 10091 10092 return 0; 10093 } 10094 10095 int nl80211_parse_random_mac(struct nlattr **attrs, 10096 u8 *mac_addr, u8 *mac_addr_mask) 10097 { 10098 int i; 10099 10100 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) { 10101 eth_zero_addr(mac_addr); 10102 eth_zero_addr(mac_addr_mask); 10103 mac_addr[0] = 0x2; 10104 mac_addr_mask[0] = 0x3; 10105 10106 return 0; 10107 } 10108 10109 /* need both or none */ 10110 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK]) 10111 return -EINVAL; 10112 10113 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN); 10114 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN); 10115 10116 /* don't allow or configure an mcast address */ 10117 if (!is_multicast_ether_addr(mac_addr_mask) || 10118 is_multicast_ether_addr(mac_addr)) 10119 return -EINVAL; 10120 10121 /* 10122 * allow users to pass a MAC address that has bits set outside 10123 * of the mask, but don't bother drivers with having to deal 10124 * with such bits 10125 */ 10126 for (i = 0; i < ETH_ALEN; i++) 10127 mac_addr[i] &= mac_addr_mask[i]; 10128 10129 return 0; 10130 } 10131 10132 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev, 10133 struct ieee80211_channel *chan) 10134 { 10135 unsigned int link_id; 10136 bool all_ok = true; 10137 int radio_idx; 10138 10139 lockdep_assert_wiphy(wdev->wiphy); 10140 10141 if (!cfg80211_wdev_channel_allowed(wdev, chan)) 10142 return false; 10143 10144 if (!cfg80211_beaconing_iface_active(wdev)) 10145 return true; 10146 10147 radio_idx = cfg80211_get_radio_idx_by_chan(wdev->wiphy, chan); 10148 10149 /* 10150 * FIXME: check if we have a free radio/link for chan 10151 * 10152 * This, as well as the FIXME below, requires knowing the link 10153 * capabilities of the hardware. 10154 */ 10155 10156 /* we cannot leave radar channels */ 10157 for_each_valid_link(wdev, link_id) { 10158 struct cfg80211_chan_def *chandef; 10159 int link_radio_idx; 10160 10161 chandef = wdev_chandef(wdev, link_id); 10162 if (!chandef || !chandef->chan) 10163 continue; 10164 10165 if (!(chandef->chan->flags & IEEE80211_CHAN_RADAR)) 10166 continue; 10167 10168 /* 10169 * chandef->chan is a radar channel. If the radio/link onto 10170 * which this radar channel falls is the same radio/link onto 10171 * which the input 'chan' falls, off-channel operation should 10172 * not be allowed. Hence, set 'all_ok' to false. 10173 */ 10174 10175 link_radio_idx = cfg80211_get_radio_idx_by_chan(wdev->wiphy, 10176 chandef->chan); 10177 if (link_radio_idx == radio_idx) { 10178 all_ok = false; 10179 break; 10180 } 10181 } 10182 10183 if (all_ok) 10184 return true; 10185 10186 return regulatory_pre_cac_allowed(wdev->wiphy); 10187 } 10188 10189 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag, 10190 enum nl80211_ext_feature_index feat) 10191 { 10192 if (!(flags & flag)) 10193 return true; 10194 if (wiphy_ext_feature_isset(wiphy, feat)) 10195 return true; 10196 return false; 10197 } 10198 10199 static int 10200 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev, 10201 struct nlattr **attrs, u8 *mac_addr, u8 *mac_addr_mask, 10202 u32 *flags, enum nl80211_feature_flags randomness_flag) 10203 { 10204 if (!attrs[NL80211_ATTR_SCAN_FLAGS]) 10205 return 0; 10206 10207 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]); 10208 10209 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) && 10210 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) || 10211 !nl80211_check_scan_feat(wiphy, *flags, 10212 NL80211_SCAN_FLAG_LOW_SPAN, 10213 NL80211_EXT_FEATURE_LOW_SPAN_SCAN) || 10214 !nl80211_check_scan_feat(wiphy, *flags, 10215 NL80211_SCAN_FLAG_LOW_POWER, 10216 NL80211_EXT_FEATURE_LOW_POWER_SCAN) || 10217 !nl80211_check_scan_feat(wiphy, *flags, 10218 NL80211_SCAN_FLAG_HIGH_ACCURACY, 10219 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) || 10220 !nl80211_check_scan_feat(wiphy, *flags, 10221 NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME, 10222 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) || 10223 !nl80211_check_scan_feat(wiphy, *flags, 10224 NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP, 10225 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) || 10226 !nl80211_check_scan_feat(wiphy, *flags, 10227 NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION, 10228 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) || 10229 !nl80211_check_scan_feat(wiphy, *flags, 10230 NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE, 10231 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) || 10232 !nl80211_check_scan_feat(wiphy, *flags, 10233 NL80211_SCAN_FLAG_RANDOM_SN, 10234 NL80211_EXT_FEATURE_SCAN_RANDOM_SN) || 10235 !nl80211_check_scan_feat(wiphy, *flags, 10236 NL80211_SCAN_FLAG_MIN_PREQ_CONTENT, 10237 NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT)) 10238 return -EOPNOTSUPP; 10239 10240 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { 10241 int err; 10242 10243 if (!(wiphy->features & randomness_flag) || 10244 (wdev && wdev->connected)) 10245 return -EOPNOTSUPP; 10246 10247 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask); 10248 if (err) 10249 return err; 10250 } 10251 10252 return 0; 10253 } 10254 10255 static int 10256 nl80211_check_scan_flags_sched(struct wiphy *wiphy, struct wireless_dev *wdev, 10257 struct nlattr **attrs, 10258 struct cfg80211_sched_scan_request *req) 10259 { 10260 return nl80211_check_scan_flags(wiphy, wdev, attrs, 10261 req->mac_addr, req->mac_addr_mask, 10262 &req->flags, 10263 wdev ? NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR : 10264 NL80211_FEATURE_ND_RANDOM_MAC_ADDR); 10265 } 10266 10267 static int 10268 nl80211_check_scan_flags_reg(struct wiphy *wiphy, struct wireless_dev *wdev, 10269 struct nlattr **attrs, 10270 struct cfg80211_scan_request_int *req) 10271 { 10272 return nl80211_check_scan_flags(wiphy, wdev, attrs, 10273 req->req.mac_addr, 10274 req->req.mac_addr_mask, 10275 &req->req.flags, 10276 NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR); 10277 } 10278 10279 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info) 10280 { 10281 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10282 struct wireless_dev *wdev = info->user_ptr[1]; 10283 struct cfg80211_scan_request_int *request; 10284 struct nlattr *scan_freqs = NULL; 10285 bool scan_freqs_khz = false; 10286 struct nlattr *attr; 10287 struct wiphy *wiphy; 10288 int err, tmp, n_ssids = 0, n_channels, i; 10289 size_t ie_len, size; 10290 size_t ssids_offset, ie_offset; 10291 10292 wiphy = &rdev->wiphy; 10293 10294 if (wdev->iftype == NL80211_IFTYPE_NAN) 10295 return -EOPNOTSUPP; 10296 10297 if (!rdev->ops->scan) 10298 return -EOPNOTSUPP; 10299 10300 if (rdev->scan_req || rdev->scan_msg) 10301 return -EBUSY; 10302 10303 if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) { 10304 if (!wiphy_ext_feature_isset(wiphy, 10305 NL80211_EXT_FEATURE_SCAN_FREQ_KHZ)) 10306 return -EOPNOTSUPP; 10307 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]; 10308 scan_freqs_khz = true; 10309 } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) 10310 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]; 10311 10312 if (scan_freqs) { 10313 n_channels = validate_scan_freqs(scan_freqs); 10314 if (!n_channels) 10315 return -EINVAL; 10316 } else { 10317 n_channels = ieee80211_get_num_supported_channels(wiphy); 10318 } 10319 10320 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) 10321 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) 10322 n_ssids++; 10323 10324 if (n_ssids > wiphy->max_scan_ssids) 10325 return -EINVAL; 10326 10327 if (info->attrs[NL80211_ATTR_IE]) 10328 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10329 else 10330 ie_len = 0; 10331 10332 if (ie_len > wiphy->max_scan_ie_len) 10333 return -EINVAL; 10334 10335 size = struct_size(request, req.channels, n_channels); 10336 ssids_offset = size; 10337 size = size_add(size, array_size(sizeof(*request->req.ssids), n_ssids)); 10338 ie_offset = size; 10339 size = size_add(size, ie_len); 10340 request = kzalloc(size, GFP_KERNEL); 10341 if (!request) 10342 return -ENOMEM; 10343 10344 if (n_ssids) 10345 request->req.ssids = (void *)request + ssids_offset; 10346 request->req.n_ssids = n_ssids; 10347 if (ie_len) 10348 request->req.ie = (void *)request + ie_offset; 10349 10350 i = 0; 10351 if (scan_freqs) { 10352 /* user specified, bail out if channel not found */ 10353 nla_for_each_nested(attr, scan_freqs, tmp) { 10354 struct ieee80211_channel *chan; 10355 int freq = nla_get_u32(attr); 10356 10357 if (!scan_freqs_khz) 10358 freq = MHZ_TO_KHZ(freq); 10359 10360 chan = ieee80211_get_channel_khz(wiphy, freq); 10361 if (!chan) { 10362 err = -EINVAL; 10363 goto out_free; 10364 } 10365 10366 /* ignore disabled channels */ 10367 if (chan->flags & IEEE80211_CHAN_DISABLED || 10368 !cfg80211_wdev_channel_allowed(wdev, chan)) 10369 continue; 10370 10371 request->req.channels[i] = chan; 10372 i++; 10373 } 10374 } else { 10375 enum nl80211_band band; 10376 10377 /* all channels */ 10378 for (band = 0; band < NUM_NL80211_BANDS; band++) { 10379 int j; 10380 10381 if (!wiphy->bands[band]) 10382 continue; 10383 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 10384 struct ieee80211_channel *chan; 10385 10386 chan = &wiphy->bands[band]->channels[j]; 10387 10388 if (chan->flags & IEEE80211_CHAN_DISABLED || 10389 !cfg80211_wdev_channel_allowed(wdev, chan)) 10390 continue; 10391 10392 request->req.channels[i] = chan; 10393 i++; 10394 } 10395 } 10396 } 10397 10398 if (!i) { 10399 err = -EINVAL; 10400 goto out_free; 10401 } 10402 10403 request->req.n_channels = i; 10404 10405 for (i = 0; i < request->req.n_channels; i++) { 10406 struct ieee80211_channel *chan = request->req.channels[i]; 10407 10408 /* if we can go off-channel to the target channel we're good */ 10409 if (cfg80211_off_channel_oper_allowed(wdev, chan)) 10410 continue; 10411 10412 if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) { 10413 err = -EBUSY; 10414 goto out_free; 10415 } 10416 } 10417 10418 i = 0; 10419 if (n_ssids) { 10420 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) { 10421 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 10422 err = -EINVAL; 10423 goto out_free; 10424 } 10425 request->req.ssids[i].ssid_len = nla_len(attr); 10426 memcpy(request->req.ssids[i].ssid, 10427 nla_data(attr), nla_len(attr)); 10428 i++; 10429 } 10430 } 10431 10432 if (info->attrs[NL80211_ATTR_IE]) { 10433 request->req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10434 memcpy((void *)request->req.ie, 10435 nla_data(info->attrs[NL80211_ATTR_IE]), 10436 request->req.ie_len); 10437 } 10438 10439 for (i = 0; i < NUM_NL80211_BANDS; i++) 10440 if (wiphy->bands[i]) 10441 request->req.rates[i] = 10442 (1 << wiphy->bands[i]->n_bitrates) - 1; 10443 10444 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) { 10445 nla_for_each_nested(attr, 10446 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES], 10447 tmp) { 10448 enum nl80211_band band = nla_type(attr); 10449 10450 if (band < 0 || band >= NUM_NL80211_BANDS) { 10451 err = -EINVAL; 10452 goto out_free; 10453 } 10454 10455 if (!wiphy->bands[band]) 10456 continue; 10457 10458 err = ieee80211_get_ratemask(wiphy->bands[band], 10459 nla_data(attr), 10460 nla_len(attr), 10461 &request->req.rates[band]); 10462 if (err) 10463 goto out_free; 10464 } 10465 } 10466 10467 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) { 10468 request->req.duration = 10469 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]); 10470 request->req.duration_mandatory = 10471 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]); 10472 } 10473 10474 err = nl80211_check_scan_flags_reg(wiphy, wdev, info->attrs, request); 10475 if (err) 10476 goto out_free; 10477 10478 request->req.no_cck = 10479 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 10480 10481 /* Initial implementation used NL80211_ATTR_MAC to set the specific 10482 * BSSID to scan for. This was problematic because that same attribute 10483 * was already used for another purpose (local random MAC address). The 10484 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards 10485 * compatibility with older userspace components, also use the 10486 * NL80211_ATTR_MAC value here if it can be determined to be used for 10487 * the specific BSSID use case instead of the random MAC address 10488 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use). 10489 */ 10490 if (info->attrs[NL80211_ATTR_BSSID]) 10491 memcpy(request->req.bssid, 10492 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN); 10493 else if (!(request->req.flags & NL80211_SCAN_FLAG_RANDOM_ADDR) && 10494 info->attrs[NL80211_ATTR_MAC]) 10495 memcpy(request->req.bssid, 10496 nla_data(info->attrs[NL80211_ATTR_MAC]), 10497 ETH_ALEN); 10498 else 10499 eth_broadcast_addr(request->req.bssid); 10500 10501 request->req.tsf_report_link_id = 10502 nl80211_link_id_or_invalid(info->attrs); 10503 request->req.wdev = wdev; 10504 request->req.wiphy = &rdev->wiphy; 10505 request->req.scan_start = jiffies; 10506 10507 rdev->scan_req = request; 10508 err = cfg80211_scan(rdev); 10509 10510 if (err) 10511 goto out_free; 10512 10513 nl80211_send_scan_start(rdev, wdev); 10514 dev_hold(wdev->netdev); 10515 10516 return 0; 10517 10518 out_free: 10519 rdev->scan_req = NULL; 10520 kfree(request); 10521 10522 return err; 10523 } 10524 10525 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info) 10526 { 10527 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10528 struct wireless_dev *wdev = info->user_ptr[1]; 10529 10530 if (!rdev->ops->abort_scan) 10531 return -EOPNOTSUPP; 10532 10533 if (rdev->scan_msg) 10534 return 0; 10535 10536 if (!rdev->scan_req) 10537 return -ENOENT; 10538 10539 rdev_abort_scan(rdev, wdev); 10540 return 0; 10541 } 10542 10543 static int 10544 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans, 10545 struct cfg80211_sched_scan_request *request, 10546 struct nlattr **attrs) 10547 { 10548 int tmp, err, i = 0; 10549 struct nlattr *attr; 10550 10551 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 10552 u32 interval; 10553 10554 /* 10555 * If scan plans are not specified, 10556 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this 10557 * case one scan plan will be set with the specified scan 10558 * interval and infinite number of iterations. 10559 */ 10560 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]); 10561 if (!interval) 10562 return -EINVAL; 10563 10564 request->scan_plans[0].interval = 10565 DIV_ROUND_UP(interval, MSEC_PER_SEC); 10566 if (!request->scan_plans[0].interval) 10567 return -EINVAL; 10568 10569 if (request->scan_plans[0].interval > 10570 wiphy->max_sched_scan_plan_interval) 10571 request->scan_plans[0].interval = 10572 wiphy->max_sched_scan_plan_interval; 10573 10574 return 0; 10575 } 10576 10577 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) { 10578 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1]; 10579 10580 if (WARN_ON(i >= n_plans)) 10581 return -EINVAL; 10582 10583 err = nla_parse_nested_deprecated(plan, 10584 NL80211_SCHED_SCAN_PLAN_MAX, 10585 attr, nl80211_plan_policy, 10586 NULL); 10587 if (err) 10588 return err; 10589 10590 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]) 10591 return -EINVAL; 10592 10593 request->scan_plans[i].interval = 10594 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]); 10595 if (!request->scan_plans[i].interval || 10596 request->scan_plans[i].interval > 10597 wiphy->max_sched_scan_plan_interval) 10598 return -EINVAL; 10599 10600 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) { 10601 request->scan_plans[i].iterations = 10602 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]); 10603 if (!request->scan_plans[i].iterations || 10604 (request->scan_plans[i].iterations > 10605 wiphy->max_sched_scan_plan_iterations)) 10606 return -EINVAL; 10607 } else if (i < n_plans - 1) { 10608 /* 10609 * All scan plans but the last one must specify 10610 * a finite number of iterations 10611 */ 10612 return -EINVAL; 10613 } 10614 10615 i++; 10616 } 10617 10618 /* 10619 * The last scan plan must not specify the number of 10620 * iterations, it is supposed to run infinitely 10621 */ 10622 if (request->scan_plans[n_plans - 1].iterations) 10623 return -EINVAL; 10624 10625 return 0; 10626 } 10627 10628 static struct cfg80211_sched_scan_request * 10629 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev, 10630 struct nlattr **attrs, int max_match_sets) 10631 { 10632 struct cfg80211_sched_scan_request *request; 10633 struct nlattr *attr; 10634 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0; 10635 enum nl80211_band band; 10636 size_t ie_len, size; 10637 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1]; 10638 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF; 10639 10640 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 10641 n_channels = validate_scan_freqs( 10642 attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 10643 if (!n_channels) 10644 return ERR_PTR(-EINVAL); 10645 } else { 10646 n_channels = ieee80211_get_num_supported_channels(wiphy); 10647 } 10648 10649 if (attrs[NL80211_ATTR_SCAN_SSIDS]) 10650 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 10651 tmp) 10652 n_ssids++; 10653 10654 if (n_ssids > wiphy->max_sched_scan_ssids) 10655 return ERR_PTR(-EINVAL); 10656 10657 /* 10658 * First, count the number of 'real' matchsets. Due to an issue with 10659 * the old implementation, matchsets containing only the RSSI attribute 10660 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default' 10661 * RSSI for all matchsets, rather than their own matchset for reporting 10662 * all APs with a strong RSSI. This is needed to be compatible with 10663 * older userspace that treated a matchset with only the RSSI as the 10664 * global RSSI for all other matchsets - if there are other matchsets. 10665 */ 10666 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 10667 nla_for_each_nested(attr, 10668 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 10669 tmp) { 10670 struct nlattr *rssi; 10671 10672 err = nla_parse_nested_deprecated(tb, 10673 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 10674 attr, 10675 nl80211_match_policy, 10676 NULL); 10677 if (err) 10678 return ERR_PTR(err); 10679 10680 /* SSID and BSSID are mutually exclusive */ 10681 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] && 10682 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) 10683 return ERR_PTR(-EINVAL); 10684 10685 /* add other standalone attributes here */ 10686 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] || 10687 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) { 10688 n_match_sets++; 10689 continue; 10690 } 10691 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 10692 if (rssi) 10693 default_match_rssi = nla_get_s32(rssi); 10694 } 10695 } 10696 10697 /* However, if there's no other matchset, add the RSSI one */ 10698 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF) 10699 n_match_sets = 1; 10700 10701 if (n_match_sets > max_match_sets) 10702 return ERR_PTR(-EINVAL); 10703 10704 if (attrs[NL80211_ATTR_IE]) 10705 ie_len = nla_len(attrs[NL80211_ATTR_IE]); 10706 else 10707 ie_len = 0; 10708 10709 if (ie_len > wiphy->max_sched_scan_ie_len) 10710 return ERR_PTR(-EINVAL); 10711 10712 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 10713 /* 10714 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since 10715 * each scan plan already specifies its own interval 10716 */ 10717 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 10718 return ERR_PTR(-EINVAL); 10719 10720 nla_for_each_nested(attr, 10721 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) 10722 n_plans++; 10723 } else { 10724 /* 10725 * The scan interval attribute is kept for backward 10726 * compatibility. If no scan plans are specified and sched scan 10727 * interval is specified, one scan plan will be set with this 10728 * scan interval and infinite number of iterations. 10729 */ 10730 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 10731 return ERR_PTR(-EINVAL); 10732 10733 n_plans = 1; 10734 } 10735 10736 if (!n_plans || n_plans > wiphy->max_sched_scan_plans) 10737 return ERR_PTR(-EINVAL); 10738 10739 if (!wiphy_ext_feature_isset( 10740 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) && 10741 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] || 10742 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST])) 10743 return ERR_PTR(-EINVAL); 10744 10745 size = struct_size(request, channels, n_channels); 10746 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 10747 size = size_add(size, array_size(sizeof(*request->match_sets), 10748 n_match_sets)); 10749 size = size_add(size, array_size(sizeof(*request->scan_plans), 10750 n_plans)); 10751 size = size_add(size, ie_len); 10752 request = kzalloc(size, GFP_KERNEL); 10753 if (!request) 10754 return ERR_PTR(-ENOMEM); 10755 request->n_channels = n_channels; 10756 10757 if (n_ssids) 10758 request->ssids = (void *)request + 10759 struct_size(request, channels, n_channels); 10760 request->n_ssids = n_ssids; 10761 if (ie_len) { 10762 if (n_ssids) 10763 request->ie = (void *)(request->ssids + n_ssids); 10764 else 10765 request->ie = (void *)(request->channels + n_channels); 10766 } 10767 10768 if (n_match_sets) { 10769 if (request->ie) 10770 request->match_sets = (void *)(request->ie + ie_len); 10771 else if (n_ssids) 10772 request->match_sets = 10773 (void *)(request->ssids + n_ssids); 10774 else 10775 request->match_sets = 10776 (void *)(request->channels + n_channels); 10777 } 10778 request->n_match_sets = n_match_sets; 10779 10780 if (n_match_sets) 10781 request->scan_plans = (void *)(request->match_sets + 10782 n_match_sets); 10783 else if (request->ie) 10784 request->scan_plans = (void *)(request->ie + ie_len); 10785 else if (n_ssids) 10786 request->scan_plans = (void *)(request->ssids + n_ssids); 10787 else 10788 request->scan_plans = (void *)(request->channels + n_channels); 10789 10790 request->n_scan_plans = n_plans; 10791 10792 i = 0; 10793 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 10794 /* user specified, bail out if channel not found */ 10795 nla_for_each_nested(attr, 10796 attrs[NL80211_ATTR_SCAN_FREQUENCIES], 10797 tmp) { 10798 struct ieee80211_channel *chan; 10799 10800 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 10801 10802 if (!chan) { 10803 err = -EINVAL; 10804 goto out_free; 10805 } 10806 10807 /* ignore disabled channels */ 10808 if (chan->flags & IEEE80211_CHAN_DISABLED) 10809 continue; 10810 10811 request->channels[i] = chan; 10812 i++; 10813 } 10814 } else { 10815 /* all channels */ 10816 for (band = 0; band < NUM_NL80211_BANDS; band++) { 10817 int j; 10818 10819 if (!wiphy->bands[band]) 10820 continue; 10821 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 10822 struct ieee80211_channel *chan; 10823 10824 chan = &wiphy->bands[band]->channels[j]; 10825 10826 if (chan->flags & IEEE80211_CHAN_DISABLED) 10827 continue; 10828 10829 request->channels[i] = chan; 10830 i++; 10831 } 10832 } 10833 } 10834 10835 if (!i) { 10836 err = -EINVAL; 10837 goto out_free; 10838 } 10839 10840 request->n_channels = i; 10841 10842 i = 0; 10843 if (n_ssids) { 10844 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 10845 tmp) { 10846 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 10847 err = -EINVAL; 10848 goto out_free; 10849 } 10850 request->ssids[i].ssid_len = nla_len(attr); 10851 memcpy(request->ssids[i].ssid, nla_data(attr), 10852 nla_len(attr)); 10853 i++; 10854 } 10855 } 10856 10857 i = 0; 10858 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 10859 nla_for_each_nested(attr, 10860 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 10861 tmp) { 10862 struct nlattr *ssid, *bssid, *rssi; 10863 10864 err = nla_parse_nested_deprecated(tb, 10865 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 10866 attr, 10867 nl80211_match_policy, 10868 NULL); 10869 if (err) 10870 goto out_free; 10871 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]; 10872 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]; 10873 10874 if (!ssid && !bssid) { 10875 i++; 10876 continue; 10877 } 10878 10879 if (WARN_ON(i >= n_match_sets)) { 10880 /* this indicates a programming error, 10881 * the loop above should have verified 10882 * things properly 10883 */ 10884 err = -EINVAL; 10885 goto out_free; 10886 } 10887 10888 if (ssid) { 10889 memcpy(request->match_sets[i].ssid.ssid, 10890 nla_data(ssid), nla_len(ssid)); 10891 request->match_sets[i].ssid.ssid_len = 10892 nla_len(ssid); 10893 } 10894 if (bssid) 10895 memcpy(request->match_sets[i].bssid, 10896 nla_data(bssid), ETH_ALEN); 10897 10898 /* special attribute - old implementation w/a */ 10899 request->match_sets[i].rssi_thold = default_match_rssi; 10900 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 10901 if (rssi) 10902 request->match_sets[i].rssi_thold = 10903 nla_get_s32(rssi); 10904 i++; 10905 } 10906 10907 /* there was no other matchset, so the RSSI one is alone */ 10908 if (i == 0 && n_match_sets) 10909 request->match_sets[0].rssi_thold = default_match_rssi; 10910 10911 request->min_rssi_thold = INT_MAX; 10912 for (i = 0; i < n_match_sets; i++) 10913 request->min_rssi_thold = 10914 min(request->match_sets[i].rssi_thold, 10915 request->min_rssi_thold); 10916 } else { 10917 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF; 10918 } 10919 10920 if (ie_len) { 10921 request->ie_len = ie_len; 10922 memcpy((void *)request->ie, 10923 nla_data(attrs[NL80211_ATTR_IE]), 10924 request->ie_len); 10925 } 10926 10927 err = nl80211_check_scan_flags_sched(wiphy, wdev, attrs, request); 10928 if (err) 10929 goto out_free; 10930 10931 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY]) 10932 request->delay = 10933 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]); 10934 10935 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) { 10936 request->relative_rssi = nla_get_s8( 10937 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]); 10938 request->relative_rssi_set = true; 10939 } 10940 10941 if (request->relative_rssi_set && 10942 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) { 10943 struct nl80211_bss_select_rssi_adjust *rssi_adjust; 10944 10945 rssi_adjust = nla_data( 10946 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]); 10947 request->rssi_adjust.band = rssi_adjust->band; 10948 request->rssi_adjust.delta = rssi_adjust->delta; 10949 if (!is_band_valid(wiphy, request->rssi_adjust.band)) { 10950 err = -EINVAL; 10951 goto out_free; 10952 } 10953 } 10954 10955 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs); 10956 if (err) 10957 goto out_free; 10958 10959 request->scan_start = jiffies; 10960 10961 return request; 10962 10963 out_free: 10964 kfree(request); 10965 return ERR_PTR(err); 10966 } 10967 10968 static int nl80211_start_sched_scan(struct sk_buff *skb, 10969 struct genl_info *info) 10970 { 10971 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10972 struct net_device *dev = info->user_ptr[1]; 10973 struct wireless_dev *wdev = dev->ieee80211_ptr; 10974 struct cfg80211_sched_scan_request *sched_scan_req; 10975 bool want_multi; 10976 int err; 10977 10978 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start) 10979 return -EOPNOTSUPP; 10980 10981 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI]; 10982 err = cfg80211_sched_scan_req_possible(rdev, want_multi); 10983 if (err) 10984 return err; 10985 10986 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev, 10987 info->attrs, 10988 rdev->wiphy.max_match_sets); 10989 10990 err = PTR_ERR_OR_ZERO(sched_scan_req); 10991 if (err) 10992 goto out_err; 10993 10994 /* leave request id zero for legacy request 10995 * or if driver does not support multi-scheduled scan 10996 */ 10997 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) 10998 sched_scan_req->reqid = cfg80211_assign_cookie(rdev); 10999 11000 err = rdev_sched_scan_start(rdev, dev, sched_scan_req); 11001 if (err) 11002 goto out_free; 11003 11004 sched_scan_req->dev = dev; 11005 sched_scan_req->wiphy = &rdev->wiphy; 11006 11007 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 11008 sched_scan_req->owner_nlportid = info->snd_portid; 11009 11010 cfg80211_add_sched_scan_req(rdev, sched_scan_req); 11011 11012 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN); 11013 return 0; 11014 11015 out_free: 11016 kfree(sched_scan_req); 11017 out_err: 11018 return err; 11019 } 11020 11021 static int nl80211_stop_sched_scan(struct sk_buff *skb, 11022 struct genl_info *info) 11023 { 11024 struct cfg80211_sched_scan_request *req; 11025 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11026 u64 cookie; 11027 11028 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop) 11029 return -EOPNOTSUPP; 11030 11031 if (info->attrs[NL80211_ATTR_COOKIE]) { 11032 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 11033 return __cfg80211_stop_sched_scan(rdev, cookie, false); 11034 } 11035 11036 req = list_first_or_null_rcu(&rdev->sched_scan_req_list, 11037 struct cfg80211_sched_scan_request, 11038 list); 11039 if (!req || req->reqid || 11040 (req->owner_nlportid && 11041 req->owner_nlportid != info->snd_portid)) 11042 return -ENOENT; 11043 11044 return cfg80211_stop_sched_scan_req(rdev, req, false); 11045 } 11046 11047 static int nl80211_start_radar_detection(struct sk_buff *skb, 11048 struct genl_info *info) 11049 { 11050 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11051 struct net_device *dev = info->user_ptr[1]; 11052 struct wireless_dev *wdev = dev->ieee80211_ptr; 11053 int link_id = nl80211_link_id(info->attrs); 11054 struct wiphy *wiphy = wdev->wiphy; 11055 struct cfg80211_chan_def chandef; 11056 enum nl80211_dfs_regions dfs_region; 11057 unsigned int cac_time_ms; 11058 int err; 11059 11060 flush_delayed_work(&rdev->dfs_update_channels_wk); 11061 11062 switch (wdev->iftype) { 11063 case NL80211_IFTYPE_AP: 11064 case NL80211_IFTYPE_P2P_GO: 11065 case NL80211_IFTYPE_MESH_POINT: 11066 case NL80211_IFTYPE_ADHOC: 11067 break; 11068 default: 11069 /* caution - see cfg80211_beaconing_iface_active() below */ 11070 return -EINVAL; 11071 } 11072 11073 guard(wiphy)(wiphy); 11074 11075 dfs_region = reg_get_dfs_region(wiphy); 11076 if (dfs_region == NL80211_DFS_UNSET) 11077 return -EINVAL; 11078 11079 err = nl80211_parse_chandef(rdev, info, &chandef); 11080 if (err) 11081 return err; 11082 11083 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 11084 if (err < 0) 11085 return err; 11086 11087 if (err == 0) 11088 return -EINVAL; 11089 11090 if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) 11091 return -EINVAL; 11092 11093 if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) 11094 return cfg80211_start_background_radar_detection(rdev, wdev, 11095 &chandef); 11096 11097 if (cfg80211_beaconing_iface_active(wdev)) { 11098 /* During MLO other link(s) can beacon, only the current link 11099 * can not already beacon 11100 */ 11101 if (wdev->valid_links && 11102 !wdev->links[link_id].ap.beacon_interval) { 11103 /* nothing */ 11104 } else { 11105 return -EBUSY; 11106 } 11107 } 11108 11109 if (wdev->links[link_id].cac_started) 11110 return -EBUSY; 11111 11112 /* CAC start is offloaded to HW and can't be started manually */ 11113 if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) 11114 return -EOPNOTSUPP; 11115 11116 if (!rdev->ops->start_radar_detection) 11117 return -EOPNOTSUPP; 11118 11119 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef); 11120 if (WARN_ON(!cac_time_ms)) 11121 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS; 11122 11123 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms, 11124 link_id); 11125 if (err) 11126 return err; 11127 11128 switch (wdev->iftype) { 11129 case NL80211_IFTYPE_AP: 11130 case NL80211_IFTYPE_P2P_GO: 11131 wdev->links[link_id].ap.chandef = chandef; 11132 break; 11133 case NL80211_IFTYPE_ADHOC: 11134 wdev->u.ibss.chandef = chandef; 11135 break; 11136 case NL80211_IFTYPE_MESH_POINT: 11137 wdev->u.mesh.chandef = chandef; 11138 break; 11139 default: 11140 break; 11141 } 11142 wdev->links[link_id].cac_started = true; 11143 wdev->links[link_id].cac_start_time = jiffies; 11144 wdev->links[link_id].cac_time_ms = cac_time_ms; 11145 11146 return 0; 11147 } 11148 11149 static int nl80211_notify_radar_detection(struct sk_buff *skb, 11150 struct genl_info *info) 11151 { 11152 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11153 struct net_device *dev = info->user_ptr[1]; 11154 struct wireless_dev *wdev = dev->ieee80211_ptr; 11155 struct wiphy *wiphy = wdev->wiphy; 11156 struct cfg80211_chan_def chandef; 11157 enum nl80211_dfs_regions dfs_region; 11158 int err; 11159 11160 dfs_region = reg_get_dfs_region(wiphy); 11161 if (dfs_region == NL80211_DFS_UNSET) { 11162 GENL_SET_ERR_MSG(info, 11163 "DFS Region is not set. Unexpected Radar indication"); 11164 return -EINVAL; 11165 } 11166 11167 err = nl80211_parse_chandef(rdev, info, &chandef); 11168 if (err) { 11169 GENL_SET_ERR_MSG(info, "Unable to extract chandef info"); 11170 return err; 11171 } 11172 11173 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 11174 if (err < 0) { 11175 GENL_SET_ERR_MSG(info, "chandef is invalid"); 11176 return err; 11177 } 11178 11179 if (err == 0) { 11180 GENL_SET_ERR_MSG(info, 11181 "Unexpected Radar indication for chandef/iftype"); 11182 return -EINVAL; 11183 } 11184 11185 /* Do not process this notification if radar is already detected 11186 * by kernel on this channel, and return success. 11187 */ 11188 if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE) 11189 return 0; 11190 11191 cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE); 11192 11193 cfg80211_sched_dfs_chan_update(rdev); 11194 11195 rdev->radar_chandef = chandef; 11196 11197 /* Propagate this notification to other radios as well */ 11198 queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk); 11199 11200 return 0; 11201 } 11202 11203 static int nl80211_parse_counter_offsets(struct cfg80211_registered_device *rdev, 11204 const u8 *data, size_t datalen, 11205 int first_count, struct nlattr *attr, 11206 const u16 **offsets, unsigned int *n_offsets) 11207 { 11208 int i; 11209 11210 *n_offsets = 0; 11211 11212 if (!attr) 11213 return 0; 11214 11215 if (!nla_len(attr) || (nla_len(attr) % sizeof(u16))) 11216 return -EINVAL; 11217 11218 *n_offsets = nla_len(attr) / sizeof(u16); 11219 if (rdev->wiphy.max_num_csa_counters && 11220 (*n_offsets > rdev->wiphy.max_num_csa_counters)) 11221 return -EINVAL; 11222 11223 *offsets = nla_data(attr); 11224 11225 /* sanity checks - counters should fit and be the same */ 11226 for (i = 0; i < *n_offsets; i++) { 11227 u16 offset = (*offsets)[i]; 11228 11229 if (offset >= datalen) 11230 return -EINVAL; 11231 11232 if (first_count != -1 && data[offset] != first_count) 11233 return -EINVAL; 11234 } 11235 11236 return 0; 11237 } 11238 11239 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info) 11240 { 11241 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11242 unsigned int link_id = nl80211_link_id(info->attrs); 11243 struct net_device *dev = info->user_ptr[1]; 11244 struct wireless_dev *wdev = dev->ieee80211_ptr; 11245 struct cfg80211_csa_settings params; 11246 struct nlattr **csa_attrs = NULL; 11247 int err; 11248 bool need_new_beacon = false; 11249 bool need_handle_dfs_flag = true; 11250 u32 cs_count; 11251 11252 if (!rdev->ops->channel_switch || 11253 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 11254 return -EOPNOTSUPP; 11255 11256 switch (dev->ieee80211_ptr->iftype) { 11257 case NL80211_IFTYPE_AP: 11258 case NL80211_IFTYPE_P2P_GO: 11259 need_new_beacon = true; 11260 /* For all modes except AP the handle_dfs flag needs to be 11261 * supplied to tell the kernel that userspace will handle radar 11262 * events when they happen. Otherwise a switch to a channel 11263 * requiring DFS will be rejected. 11264 */ 11265 need_handle_dfs_flag = false; 11266 11267 /* useless if AP is not running */ 11268 if (!wdev->links[link_id].ap.beacon_interval) 11269 return -ENOTCONN; 11270 break; 11271 case NL80211_IFTYPE_ADHOC: 11272 if (!wdev->u.ibss.ssid_len) 11273 return -ENOTCONN; 11274 break; 11275 case NL80211_IFTYPE_MESH_POINT: 11276 if (!wdev->u.mesh.id_len) 11277 return -ENOTCONN; 11278 break; 11279 default: 11280 return -EOPNOTSUPP; 11281 } 11282 11283 memset(¶ms, 0, sizeof(params)); 11284 params.beacon_csa.ftm_responder = -1; 11285 11286 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 11287 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]) 11288 return -EINVAL; 11289 11290 /* only important for AP, IBSS and mesh create IEs internally */ 11291 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES]) 11292 return -EINVAL; 11293 11294 /* Even though the attribute is u32, the specification says 11295 * u8, so let's make sure we don't overflow. 11296 */ 11297 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]); 11298 if (cs_count > 255) 11299 return -EINVAL; 11300 11301 params.count = cs_count; 11302 11303 if (!need_new_beacon) 11304 goto skip_beacons; 11305 11306 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_after, 11307 info->extack); 11308 if (err) 11309 goto free; 11310 11311 csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs), 11312 GFP_KERNEL); 11313 if (!csa_attrs) { 11314 err = -ENOMEM; 11315 goto free; 11316 } 11317 11318 err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX, 11319 info->attrs[NL80211_ATTR_CSA_IES], 11320 nl80211_policy, info->extack); 11321 if (err) 11322 goto free; 11323 11324 err = nl80211_parse_beacon(rdev, csa_attrs, ¶ms.beacon_csa, 11325 info->extack); 11326 if (err) 11327 goto free; 11328 11329 if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 11330 err = -EINVAL; 11331 goto free; 11332 } 11333 11334 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.tail, 11335 params.beacon_csa.tail_len, 11336 params.count, 11337 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON], 11338 ¶ms.counter_offsets_beacon, 11339 ¶ms.n_counter_offsets_beacon); 11340 if (err) 11341 goto free; 11342 11343 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.probe_resp, 11344 params.beacon_csa.probe_resp_len, 11345 params.count, 11346 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP], 11347 ¶ms.counter_offsets_presp, 11348 ¶ms.n_counter_offsets_presp); 11349 if (err) 11350 goto free; 11351 11352 skip_beacons: 11353 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 11354 if (err) 11355 goto free; 11356 11357 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 11358 wdev->iftype)) { 11359 err = -EINVAL; 11360 goto free; 11361 } 11362 11363 err = cfg80211_chandef_dfs_required(wdev->wiphy, 11364 ¶ms.chandef, 11365 wdev->iftype); 11366 if (err < 0) 11367 goto free; 11368 11369 if (err > 0) { 11370 params.radar_required = true; 11371 if (need_handle_dfs_flag && 11372 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) { 11373 err = -EINVAL; 11374 goto free; 11375 } 11376 } 11377 11378 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX]) 11379 params.block_tx = true; 11380 11381 if ((wdev->iftype == NL80211_IFTYPE_AP || 11382 wdev->iftype == NL80211_IFTYPE_P2P_GO) && 11383 info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 11384 err = nl80211_parse_unsol_bcast_probe_resp( 11385 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 11386 ¶ms.unsol_bcast_probe_resp); 11387 if (err) 11388 goto free; 11389 } 11390 11391 params.link_id = link_id; 11392 err = rdev_channel_switch(rdev, dev, ¶ms); 11393 11394 free: 11395 kfree(params.beacon_after.mbssid_ies); 11396 kfree(params.beacon_csa.mbssid_ies); 11397 kfree(params.beacon_after.rnr_ies); 11398 kfree(params.beacon_csa.rnr_ies); 11399 kfree(csa_attrs); 11400 return err; 11401 } 11402 11403 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb, 11404 u32 seq, int flags, 11405 struct cfg80211_registered_device *rdev, 11406 struct wireless_dev *wdev, 11407 struct cfg80211_internal_bss *intbss) 11408 { 11409 struct cfg80211_bss *res = &intbss->pub; 11410 const struct cfg80211_bss_ies *ies; 11411 unsigned int link_id; 11412 void *hdr; 11413 struct nlattr *bss; 11414 11415 lockdep_assert_wiphy(wdev->wiphy); 11416 11417 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 11418 NL80211_CMD_NEW_SCAN_RESULTS); 11419 if (!hdr) 11420 return -1; 11421 11422 genl_dump_check_consistent(cb, hdr); 11423 11424 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation)) 11425 goto nla_put_failure; 11426 if (wdev->netdev && 11427 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex)) 11428 goto nla_put_failure; 11429 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 11430 NL80211_ATTR_PAD)) 11431 goto nla_put_failure; 11432 11433 bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS); 11434 if (!bss) 11435 goto nla_put_failure; 11436 if ((!is_zero_ether_addr(res->bssid) && 11437 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid))) 11438 goto nla_put_failure; 11439 11440 rcu_read_lock(); 11441 /* indicate whether we have probe response data or not */ 11442 if (rcu_access_pointer(res->proberesp_ies) && 11443 nla_put_flag(msg, NL80211_BSS_PRESP_DATA)) 11444 goto fail_unlock_rcu; 11445 11446 /* this pointer prefers to be pointed to probe response data 11447 * but is always valid 11448 */ 11449 ies = rcu_dereference(res->ies); 11450 if (ies) { 11451 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf, 11452 NL80211_BSS_PAD)) 11453 goto fail_unlock_rcu; 11454 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS, 11455 ies->len, ies->data)) 11456 goto fail_unlock_rcu; 11457 } 11458 11459 /* and this pointer is always (unless driver didn't know) beacon data */ 11460 ies = rcu_dereference(res->beacon_ies); 11461 if (ies && ies->from_beacon) { 11462 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf, 11463 NL80211_BSS_PAD)) 11464 goto fail_unlock_rcu; 11465 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES, 11466 ies->len, ies->data)) 11467 goto fail_unlock_rcu; 11468 } 11469 rcu_read_unlock(); 11470 11471 if (res->beacon_interval && 11472 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval)) 11473 goto nla_put_failure; 11474 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) || 11475 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) || 11476 nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET, 11477 res->channel->freq_offset) || 11478 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO, 11479 jiffies_to_msecs(jiffies - intbss->ts))) 11480 goto nla_put_failure; 11481 11482 if (intbss->parent_tsf && 11483 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF, 11484 intbss->parent_tsf, NL80211_BSS_PAD) || 11485 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN, 11486 intbss->parent_bssid))) 11487 goto nla_put_failure; 11488 11489 if (res->ts_boottime && 11490 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME, 11491 res->ts_boottime, NL80211_BSS_PAD)) 11492 goto nla_put_failure; 11493 11494 if (!nl80211_put_signal(msg, intbss->pub.chains, 11495 intbss->pub.chain_signal, 11496 NL80211_BSS_CHAIN_SIGNAL)) 11497 goto nla_put_failure; 11498 11499 if (intbss->bss_source != BSS_SOURCE_STA_PROFILE) { 11500 switch (rdev->wiphy.signal_type) { 11501 case CFG80211_SIGNAL_TYPE_MBM: 11502 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, 11503 res->signal)) 11504 goto nla_put_failure; 11505 break; 11506 case CFG80211_SIGNAL_TYPE_UNSPEC: 11507 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, 11508 res->signal)) 11509 goto nla_put_failure; 11510 break; 11511 default: 11512 break; 11513 } 11514 } 11515 11516 switch (wdev->iftype) { 11517 case NL80211_IFTYPE_P2P_CLIENT: 11518 case NL80211_IFTYPE_STATION: 11519 for_each_valid_link(wdev, link_id) { 11520 if (intbss == wdev->links[link_id].client.current_bss && 11521 (nla_put_u32(msg, NL80211_BSS_STATUS, 11522 NL80211_BSS_STATUS_ASSOCIATED) || 11523 (wdev->valid_links && 11524 (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID, 11525 link_id) || 11526 nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN, 11527 wdev->u.client.connected_addr))))) 11528 goto nla_put_failure; 11529 } 11530 break; 11531 case NL80211_IFTYPE_ADHOC: 11532 if (intbss == wdev->u.ibss.current_bss && 11533 nla_put_u32(msg, NL80211_BSS_STATUS, 11534 NL80211_BSS_STATUS_IBSS_JOINED)) 11535 goto nla_put_failure; 11536 break; 11537 default: 11538 break; 11539 } 11540 11541 if (nla_put_u32(msg, NL80211_BSS_USE_FOR, res->use_for)) 11542 goto nla_put_failure; 11543 11544 if (res->cannot_use_reasons && 11545 nla_put_u64_64bit(msg, NL80211_BSS_CANNOT_USE_REASONS, 11546 res->cannot_use_reasons, 11547 NL80211_BSS_PAD)) 11548 goto nla_put_failure; 11549 11550 nla_nest_end(msg, bss); 11551 11552 genlmsg_end(msg, hdr); 11553 return 0; 11554 11555 fail_unlock_rcu: 11556 rcu_read_unlock(); 11557 nla_put_failure: 11558 genlmsg_cancel(msg, hdr); 11559 return -EMSGSIZE; 11560 } 11561 11562 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb) 11563 { 11564 struct cfg80211_registered_device *rdev; 11565 struct cfg80211_internal_bss *scan; 11566 struct wireless_dev *wdev; 11567 struct nlattr **attrbuf; 11568 int start = cb->args[2], idx = 0; 11569 bool dump_include_use_data; 11570 int err; 11571 11572 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 11573 if (!attrbuf) 11574 return -ENOMEM; 11575 11576 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 11577 if (err) { 11578 kfree(attrbuf); 11579 return err; 11580 } 11581 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 11582 __acquire(&rdev->wiphy.mtx); 11583 11584 dump_include_use_data = 11585 attrbuf[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA]; 11586 kfree(attrbuf); 11587 11588 spin_lock_bh(&rdev->bss_lock); 11589 11590 /* 11591 * dump_scan will be called multiple times to break up the scan results 11592 * into multiple messages. It is unlikely that any more bss-es will be 11593 * expired after the first call, so only call only call this on the 11594 * first dump_scan invocation. 11595 */ 11596 if (start == 0) 11597 cfg80211_bss_expire(rdev); 11598 11599 cb->seq = rdev->bss_generation; 11600 11601 list_for_each_entry(scan, &rdev->bss_list, list) { 11602 if (++idx <= start) 11603 continue; 11604 if (!dump_include_use_data && 11605 !(scan->pub.use_for & NL80211_BSS_USE_FOR_NORMAL)) 11606 continue; 11607 if (nl80211_send_bss(skb, cb, 11608 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11609 rdev, wdev, scan) < 0) { 11610 idx--; 11611 break; 11612 } 11613 } 11614 11615 spin_unlock_bh(&rdev->bss_lock); 11616 11617 cb->args[2] = idx; 11618 wiphy_unlock(&rdev->wiphy); 11619 11620 return skb->len; 11621 } 11622 11623 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq, 11624 int flags, struct net_device *dev, 11625 bool allow_radio_stats, 11626 struct survey_info *survey) 11627 { 11628 void *hdr; 11629 struct nlattr *infoattr; 11630 11631 /* skip radio stats if userspace didn't request them */ 11632 if (!survey->channel && !allow_radio_stats) 11633 return 0; 11634 11635 hdr = nl80211hdr_put(msg, portid, seq, flags, 11636 NL80211_CMD_NEW_SURVEY_RESULTS); 11637 if (!hdr) 11638 return -ENOMEM; 11639 11640 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 11641 goto nla_put_failure; 11642 11643 infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO); 11644 if (!infoattr) 11645 goto nla_put_failure; 11646 11647 if (survey->channel && 11648 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY, 11649 survey->channel->center_freq)) 11650 goto nla_put_failure; 11651 11652 if (survey->channel && survey->channel->freq_offset && 11653 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET, 11654 survey->channel->freq_offset)) 11655 goto nla_put_failure; 11656 11657 if ((survey->filled & SURVEY_INFO_NOISE_DBM) && 11658 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise)) 11659 goto nla_put_failure; 11660 if ((survey->filled & SURVEY_INFO_IN_USE) && 11661 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE)) 11662 goto nla_put_failure; 11663 if ((survey->filled & SURVEY_INFO_TIME) && 11664 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME, 11665 survey->time, NL80211_SURVEY_INFO_PAD)) 11666 goto nla_put_failure; 11667 if ((survey->filled & SURVEY_INFO_TIME_BUSY) && 11668 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY, 11669 survey->time_busy, NL80211_SURVEY_INFO_PAD)) 11670 goto nla_put_failure; 11671 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) && 11672 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY, 11673 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD)) 11674 goto nla_put_failure; 11675 if ((survey->filled & SURVEY_INFO_TIME_RX) && 11676 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX, 11677 survey->time_rx, NL80211_SURVEY_INFO_PAD)) 11678 goto nla_put_failure; 11679 if ((survey->filled & SURVEY_INFO_TIME_TX) && 11680 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX, 11681 survey->time_tx, NL80211_SURVEY_INFO_PAD)) 11682 goto nla_put_failure; 11683 if ((survey->filled & SURVEY_INFO_TIME_SCAN) && 11684 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN, 11685 survey->time_scan, NL80211_SURVEY_INFO_PAD)) 11686 goto nla_put_failure; 11687 if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) && 11688 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX, 11689 survey->time_bss_rx, NL80211_SURVEY_INFO_PAD)) 11690 goto nla_put_failure; 11691 11692 nla_nest_end(msg, infoattr); 11693 11694 genlmsg_end(msg, hdr); 11695 return 0; 11696 11697 nla_put_failure: 11698 genlmsg_cancel(msg, hdr); 11699 return -EMSGSIZE; 11700 } 11701 11702 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb) 11703 { 11704 struct nlattr **attrbuf; 11705 struct survey_info survey; 11706 struct cfg80211_registered_device *rdev; 11707 struct wireless_dev *wdev; 11708 int survey_idx = cb->args[2]; 11709 int res; 11710 bool radio_stats; 11711 11712 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 11713 if (!attrbuf) 11714 return -ENOMEM; 11715 11716 res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 11717 if (res) { 11718 kfree(attrbuf); 11719 return res; 11720 } 11721 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 11722 __acquire(&rdev->wiphy.mtx); 11723 11724 /* prepare_wdev_dump parsed the attributes */ 11725 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS]; 11726 11727 if (!wdev->netdev) { 11728 res = -EINVAL; 11729 goto out_err; 11730 } 11731 11732 if (!rdev->ops->dump_survey) { 11733 res = -EOPNOTSUPP; 11734 goto out_err; 11735 } 11736 11737 while (1) { 11738 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey); 11739 if (res == -ENOENT) 11740 break; 11741 if (res) 11742 goto out_err; 11743 11744 /* don't send disabled channels, but do send non-channel data */ 11745 if (survey.channel && 11746 survey.channel->flags & IEEE80211_CHAN_DISABLED) { 11747 survey_idx++; 11748 continue; 11749 } 11750 11751 if (nl80211_send_survey(skb, 11752 NETLINK_CB(cb->skb).portid, 11753 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11754 wdev->netdev, radio_stats, &survey) < 0) 11755 goto out; 11756 survey_idx++; 11757 } 11758 11759 out: 11760 cb->args[2] = survey_idx; 11761 res = skb->len; 11762 out_err: 11763 kfree(attrbuf); 11764 wiphy_unlock(&rdev->wiphy); 11765 return res; 11766 } 11767 11768 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info) 11769 { 11770 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11771 struct net_device *dev = info->user_ptr[1]; 11772 struct ieee80211_channel *chan; 11773 const u8 *bssid, *ssid; 11774 int err, ssid_len; 11775 enum nl80211_auth_type auth_type; 11776 struct key_parse key; 11777 bool local_state_change; 11778 struct cfg80211_auth_request req = {}; 11779 u32 freq; 11780 11781 if (!info->attrs[NL80211_ATTR_MAC]) 11782 return -EINVAL; 11783 11784 if (!info->attrs[NL80211_ATTR_AUTH_TYPE]) 11785 return -EINVAL; 11786 11787 if (!info->attrs[NL80211_ATTR_SSID]) 11788 return -EINVAL; 11789 11790 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 11791 return -EINVAL; 11792 11793 err = nl80211_parse_key(info, &key); 11794 if (err) 11795 return err; 11796 11797 if (key.idx >= 0) { 11798 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP) 11799 return -EINVAL; 11800 if (!key.p.key || !key.p.key_len) 11801 return -EINVAL; 11802 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 || 11803 key.p.key_len != WLAN_KEY_LEN_WEP40) && 11804 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 || 11805 key.p.key_len != WLAN_KEY_LEN_WEP104)) 11806 return -EINVAL; 11807 if (key.idx > 3) 11808 return -EINVAL; 11809 } else { 11810 key.p.key_len = 0; 11811 key.p.key = NULL; 11812 } 11813 11814 if (key.idx >= 0) { 11815 int i; 11816 bool ok = false; 11817 11818 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) { 11819 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) { 11820 ok = true; 11821 break; 11822 } 11823 } 11824 if (!ok) 11825 return -EINVAL; 11826 } 11827 11828 if (!rdev->ops->auth) 11829 return -EOPNOTSUPP; 11830 11831 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11832 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11833 return -EOPNOTSUPP; 11834 11835 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11836 freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 11837 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 11838 freq += 11839 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 11840 11841 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 11842 if (!chan) 11843 return -EINVAL; 11844 11845 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11846 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11847 11848 if (info->attrs[NL80211_ATTR_IE]) { 11849 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11850 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11851 } 11852 11853 if (info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]) { 11854 req.supported_selectors = 11855 nla_data(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 11856 req.supported_selectors_len = 11857 nla_len(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 11858 } 11859 11860 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 11861 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE)) 11862 return -EINVAL; 11863 11864 if ((auth_type == NL80211_AUTHTYPE_SAE || 11865 auth_type == NL80211_AUTHTYPE_FILS_SK || 11866 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 11867 auth_type == NL80211_AUTHTYPE_FILS_PK) && 11868 !info->attrs[NL80211_ATTR_AUTH_DATA]) 11869 return -EINVAL; 11870 11871 if (info->attrs[NL80211_ATTR_AUTH_DATA]) { 11872 if (auth_type != NL80211_AUTHTYPE_SAE && 11873 auth_type != NL80211_AUTHTYPE_FILS_SK && 11874 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS && 11875 auth_type != NL80211_AUTHTYPE_FILS_PK) 11876 return -EINVAL; 11877 req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]); 11878 req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]); 11879 } 11880 11881 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11882 11883 /* 11884 * Since we no longer track auth state, ignore 11885 * requests to only change local state. 11886 */ 11887 if (local_state_change) 11888 return 0; 11889 11890 req.auth_type = auth_type; 11891 req.key = key.p.key; 11892 req.key_len = key.p.key_len; 11893 req.key_idx = key.idx; 11894 req.link_id = nl80211_link_id_or_invalid(info->attrs); 11895 if (req.link_id >= 0) { 11896 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 11897 return -EINVAL; 11898 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 11899 return -EINVAL; 11900 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 11901 if (!is_valid_ether_addr(req.ap_mld_addr)) 11902 return -EINVAL; 11903 } 11904 11905 req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, 11906 IEEE80211_BSS_TYPE_ESS, 11907 IEEE80211_PRIVACY_ANY); 11908 if (!req.bss) 11909 return -ENOENT; 11910 11911 err = cfg80211_mlme_auth(rdev, dev, &req); 11912 11913 cfg80211_put_bss(&rdev->wiphy, req.bss); 11914 11915 return err; 11916 } 11917 11918 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev, 11919 struct genl_info *info) 11920 { 11921 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 11922 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set"); 11923 return -EINVAL; 11924 } 11925 11926 if (!rdev->ops->tx_control_port || 11927 !wiphy_ext_feature_isset(&rdev->wiphy, 11928 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 11929 return -EOPNOTSUPP; 11930 11931 return 0; 11932 } 11933 11934 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 11935 struct genl_info *info, 11936 struct cfg80211_crypto_settings *settings, 11937 int cipher_limit) 11938 { 11939 memset(settings, 0, sizeof(*settings)); 11940 11941 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT]; 11942 11943 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 11944 u16 proto; 11945 11946 proto = nla_get_u16( 11947 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 11948 settings->control_port_ethertype = cpu_to_be16(proto); 11949 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 11950 proto != ETH_P_PAE) 11951 return -EINVAL; 11952 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]) 11953 settings->control_port_no_encrypt = true; 11954 } else 11955 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE); 11956 11957 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 11958 int r = validate_pae_over_nl80211(rdev, info); 11959 11960 if (r < 0) 11961 return r; 11962 11963 settings->control_port_over_nl80211 = true; 11964 11965 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH]) 11966 settings->control_port_no_preauth = true; 11967 } 11968 11969 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) { 11970 void *data; 11971 int len, i; 11972 11973 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 11974 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 11975 settings->n_ciphers_pairwise = len / sizeof(u32); 11976 11977 if (len % sizeof(u32)) 11978 return -EINVAL; 11979 11980 if (settings->n_ciphers_pairwise > cipher_limit) 11981 return -EINVAL; 11982 11983 memcpy(settings->ciphers_pairwise, data, len); 11984 11985 for (i = 0; i < settings->n_ciphers_pairwise; i++) 11986 if (!cfg80211_supported_cipher_suite( 11987 &rdev->wiphy, 11988 settings->ciphers_pairwise[i])) 11989 return -EINVAL; 11990 } 11991 11992 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) { 11993 settings->cipher_group = 11994 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]); 11995 if (!cfg80211_supported_cipher_suite(&rdev->wiphy, 11996 settings->cipher_group)) 11997 return -EINVAL; 11998 } 11999 12000 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) 12001 settings->wpa_versions = 12002 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]); 12003 12004 if (info->attrs[NL80211_ATTR_AKM_SUITES]) { 12005 void *data; 12006 int len; 12007 12008 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]); 12009 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]); 12010 settings->n_akm_suites = len / sizeof(u32); 12011 12012 if (len % sizeof(u32)) 12013 return -EINVAL; 12014 12015 if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites) 12016 return -EINVAL; 12017 12018 memcpy(settings->akm_suites, data, len); 12019 } 12020 12021 if (info->attrs[NL80211_ATTR_PMK]) { 12022 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN) 12023 return -EINVAL; 12024 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12025 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) && 12026 !wiphy_ext_feature_isset(&rdev->wiphy, 12027 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK)) 12028 return -EINVAL; 12029 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]); 12030 } 12031 12032 if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) { 12033 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12034 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 12035 !wiphy_ext_feature_isset(&rdev->wiphy, 12036 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP)) 12037 return -EINVAL; 12038 settings->sae_pwd = 12039 nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 12040 settings->sae_pwd_len = 12041 nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 12042 } 12043 12044 settings->sae_pwe = 12045 nla_get_u8_default(info->attrs[NL80211_ATTR_SAE_PWE], 12046 NL80211_SAE_PWE_UNSPECIFIED); 12047 12048 return 0; 12049 } 12050 12051 static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev, 12052 const u8 *ssid, int ssid_len, 12053 struct nlattr **attrs, 12054 int assoc_link_id, int link_id) 12055 { 12056 struct ieee80211_channel *chan; 12057 struct cfg80211_bss *bss; 12058 const u8 *bssid; 12059 u32 freq, use_for = 0; 12060 12061 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ]) 12062 return ERR_PTR(-EINVAL); 12063 12064 bssid = nla_data(attrs[NL80211_ATTR_MAC]); 12065 12066 freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ])); 12067 if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 12068 freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 12069 12070 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 12071 if (!chan) 12072 return ERR_PTR(-EINVAL); 12073 12074 if (assoc_link_id >= 0) 12075 use_for = NL80211_BSS_USE_FOR_MLD_LINK; 12076 if (assoc_link_id == link_id) 12077 use_for |= NL80211_BSS_USE_FOR_NORMAL; 12078 12079 bss = __cfg80211_get_bss(&rdev->wiphy, chan, bssid, 12080 ssid, ssid_len, 12081 IEEE80211_BSS_TYPE_ESS, 12082 IEEE80211_PRIVACY_ANY, 12083 use_for); 12084 if (!bss) 12085 return ERR_PTR(-ENOENT); 12086 12087 return bss; 12088 } 12089 12090 static int nl80211_process_links(struct cfg80211_registered_device *rdev, 12091 struct cfg80211_assoc_link *links, 12092 int assoc_link_id, 12093 const u8 *ssid, int ssid_len, 12094 struct genl_info *info) 12095 { 12096 unsigned int attrsize = NUM_NL80211_ATTR * sizeof(struct nlattr *); 12097 struct nlattr **attrs __free(kfree) = kzalloc(attrsize, GFP_KERNEL); 12098 struct nlattr *link; 12099 unsigned int link_id; 12100 int rem, err; 12101 12102 if (!attrs) 12103 return -ENOMEM; 12104 12105 nla_for_each_nested(link, info->attrs[NL80211_ATTR_MLO_LINKS], rem) { 12106 memset(attrs, 0, attrsize); 12107 12108 nla_parse_nested(attrs, NL80211_ATTR_MAX, link, NULL, NULL); 12109 12110 if (!attrs[NL80211_ATTR_MLO_LINK_ID]) { 12111 NL_SET_BAD_ATTR(info->extack, link); 12112 return -EINVAL; 12113 } 12114 12115 link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]); 12116 /* cannot use the same link ID again */ 12117 if (links[link_id].bss) { 12118 NL_SET_BAD_ATTR(info->extack, link); 12119 return -EINVAL; 12120 } 12121 links[link_id].bss = 12122 nl80211_assoc_bss(rdev, ssid, ssid_len, attrs, 12123 assoc_link_id, link_id); 12124 if (IS_ERR(links[link_id].bss)) { 12125 err = PTR_ERR(links[link_id].bss); 12126 links[link_id].bss = NULL; 12127 NL_SET_ERR_MSG_ATTR(info->extack, link, 12128 "Error fetching BSS for link"); 12129 return err; 12130 } 12131 12132 if (attrs[NL80211_ATTR_IE]) { 12133 links[link_id].elems = nla_data(attrs[NL80211_ATTR_IE]); 12134 links[link_id].elems_len = 12135 nla_len(attrs[NL80211_ATTR_IE]); 12136 12137 if (cfg80211_find_elem(WLAN_EID_FRAGMENT, 12138 links[link_id].elems, 12139 links[link_id].elems_len)) { 12140 NL_SET_ERR_MSG_ATTR(info->extack, 12141 attrs[NL80211_ATTR_IE], 12142 "cannot deal with fragmentation"); 12143 return -EINVAL; 12144 } 12145 12146 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 12147 links[link_id].elems, 12148 links[link_id].elems_len)) { 12149 NL_SET_ERR_MSG_ATTR(info->extack, 12150 attrs[NL80211_ATTR_IE], 12151 "cannot deal with non-inheritance"); 12152 return -EINVAL; 12153 } 12154 } 12155 12156 links[link_id].disabled = 12157 nla_get_flag(attrs[NL80211_ATTR_MLO_LINK_DISABLED]); 12158 } 12159 12160 return 0; 12161 } 12162 12163 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info) 12164 { 12165 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12166 struct net_device *dev = info->user_ptr[1]; 12167 struct cfg80211_assoc_request req = {}; 12168 const u8 *ap_addr, *ssid; 12169 unsigned int link_id; 12170 int err, ssid_len; 12171 12172 if (dev->ieee80211_ptr->conn_owner_nlportid && 12173 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12174 return -EPERM; 12175 12176 if (!info->attrs[NL80211_ATTR_SSID]) 12177 return -EINVAL; 12178 12179 if (!rdev->ops->assoc) 12180 return -EOPNOTSUPP; 12181 12182 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12183 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12184 return -EOPNOTSUPP; 12185 12186 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12187 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12188 12189 if (info->attrs[NL80211_ATTR_IE]) { 12190 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12191 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12192 12193 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 12194 req.ie, req.ie_len)) { 12195 NL_SET_ERR_MSG_ATTR(info->extack, 12196 info->attrs[NL80211_ATTR_IE], 12197 "non-inheritance makes no sense"); 12198 return -EINVAL; 12199 } 12200 } 12201 12202 if (info->attrs[NL80211_ATTR_USE_MFP]) { 12203 enum nl80211_mfp mfp = 12204 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 12205 if (mfp == NL80211_MFP_REQUIRED) 12206 req.use_mfp = true; 12207 else if (mfp != NL80211_MFP_NO) 12208 return -EINVAL; 12209 } 12210 12211 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 12212 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 12213 12214 if (info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]) { 12215 req.supported_selectors = 12216 nla_data(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 12217 req.supported_selectors_len = 12218 nla_len(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 12219 } 12220 12221 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 12222 req.flags |= ASSOC_REQ_DISABLE_HT; 12223 12224 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12225 memcpy(&req.ht_capa_mask, 12226 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 12227 sizeof(req.ht_capa_mask)); 12228 12229 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 12230 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12231 return -EINVAL; 12232 memcpy(&req.ht_capa, 12233 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 12234 sizeof(req.ht_capa)); 12235 } 12236 12237 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 12238 req.flags |= ASSOC_REQ_DISABLE_VHT; 12239 12240 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 12241 req.flags |= ASSOC_REQ_DISABLE_HE; 12242 12243 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 12244 req.flags |= ASSOC_REQ_DISABLE_EHT; 12245 12246 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 12247 memcpy(&req.vht_capa_mask, 12248 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 12249 sizeof(req.vht_capa_mask)); 12250 12251 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 12252 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 12253 return -EINVAL; 12254 memcpy(&req.vht_capa, 12255 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 12256 sizeof(req.vht_capa)); 12257 } 12258 12259 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 12260 if (!((rdev->wiphy.features & 12261 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 12262 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 12263 !wiphy_ext_feature_isset(&rdev->wiphy, 12264 NL80211_EXT_FEATURE_RRM)) 12265 return -EINVAL; 12266 req.flags |= ASSOC_REQ_USE_RRM; 12267 } 12268 12269 if (info->attrs[NL80211_ATTR_FILS_KEK]) { 12270 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 12271 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 12272 if (!info->attrs[NL80211_ATTR_FILS_NONCES]) 12273 return -EINVAL; 12274 req.fils_nonces = 12275 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 12276 } 12277 12278 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) { 12279 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 12280 return -EINVAL; 12281 memcpy(&req.s1g_capa_mask, 12282 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]), 12283 sizeof(req.s1g_capa_mask)); 12284 } 12285 12286 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) { 12287 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) 12288 return -EINVAL; 12289 memcpy(&req.s1g_capa, 12290 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]), 12291 sizeof(req.s1g_capa)); 12292 } 12293 12294 if (nla_get_flag(info->attrs[NL80211_ATTR_ASSOC_SPP_AMSDU])) { 12295 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12296 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT)) { 12297 GENL_SET_ERR_MSG(info, "SPP A-MSDUs not supported"); 12298 return -EINVAL; 12299 } 12300 req.flags |= ASSOC_REQ_SPP_AMSDU; 12301 } 12302 12303 req.link_id = nl80211_link_id_or_invalid(info->attrs); 12304 12305 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 12306 if (req.link_id < 0) 12307 return -EINVAL; 12308 12309 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 12310 return -EINVAL; 12311 12312 if (info->attrs[NL80211_ATTR_MAC] || 12313 info->attrs[NL80211_ATTR_WIPHY_FREQ] || 12314 !info->attrs[NL80211_ATTR_MLD_ADDR]) 12315 return -EINVAL; 12316 12317 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 12318 ap_addr = req.ap_mld_addr; 12319 12320 err = nl80211_process_links(rdev, req.links, req.link_id, 12321 ssid, ssid_len, info); 12322 if (err) 12323 goto free; 12324 12325 if (!req.links[req.link_id].bss) { 12326 err = -EINVAL; 12327 goto free; 12328 } 12329 12330 if (req.links[req.link_id].elems_len) { 12331 GENL_SET_ERR_MSG(info, 12332 "cannot have per-link elems on assoc link"); 12333 err = -EINVAL; 12334 goto free; 12335 } 12336 12337 if (req.links[req.link_id].disabled) { 12338 GENL_SET_ERR_MSG(info, 12339 "cannot have assoc link disabled"); 12340 err = -EINVAL; 12341 goto free; 12342 } 12343 12344 if (info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]) 12345 req.ext_mld_capa_ops = 12346 nla_get_u16(info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]); 12347 } else { 12348 if (req.link_id >= 0) 12349 return -EINVAL; 12350 12351 req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs, 12352 -1, -1); 12353 if (IS_ERR(req.bss)) 12354 return PTR_ERR(req.bss); 12355 ap_addr = req.bss->bssid; 12356 12357 if (info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]) 12358 return -EINVAL; 12359 } 12360 12361 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1); 12362 if (!err) { 12363 struct nlattr *link; 12364 int rem = 0; 12365 12366 err = cfg80211_mlme_assoc(rdev, dev, &req, 12367 info->extack); 12368 12369 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12370 dev->ieee80211_ptr->conn_owner_nlportid = 12371 info->snd_portid; 12372 memcpy(dev->ieee80211_ptr->disconnect_bssid, 12373 ap_addr, ETH_ALEN); 12374 } 12375 12376 /* Report error from first problematic link */ 12377 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 12378 nla_for_each_nested(link, 12379 info->attrs[NL80211_ATTR_MLO_LINKS], 12380 rem) { 12381 struct nlattr *link_id_attr = 12382 nla_find_nested(link, NL80211_ATTR_MLO_LINK_ID); 12383 12384 if (!link_id_attr) 12385 continue; 12386 12387 link_id = nla_get_u8(link_id_attr); 12388 12389 if (link_id == req.link_id) 12390 continue; 12391 12392 if (!req.links[link_id].error || 12393 WARN_ON(req.links[link_id].error > 0)) 12394 continue; 12395 12396 WARN_ON(err >= 0); 12397 12398 NL_SET_BAD_ATTR(info->extack, link); 12399 err = req.links[link_id].error; 12400 break; 12401 } 12402 } 12403 } 12404 12405 free: 12406 for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++) 12407 cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss); 12408 cfg80211_put_bss(&rdev->wiphy, req.bss); 12409 12410 return err; 12411 } 12412 12413 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info) 12414 { 12415 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12416 struct net_device *dev = info->user_ptr[1]; 12417 const u8 *ie = NULL, *bssid; 12418 int ie_len = 0; 12419 u16 reason_code; 12420 bool local_state_change; 12421 12422 if (dev->ieee80211_ptr->conn_owner_nlportid && 12423 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12424 return -EPERM; 12425 12426 if (!info->attrs[NL80211_ATTR_MAC]) 12427 return -EINVAL; 12428 12429 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 12430 return -EINVAL; 12431 12432 if (!rdev->ops->deauth) 12433 return -EOPNOTSUPP; 12434 12435 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12436 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12437 return -EOPNOTSUPP; 12438 12439 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12440 12441 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 12442 if (reason_code == 0) { 12443 /* Reason Code 0 is reserved */ 12444 return -EINVAL; 12445 } 12446 12447 if (info->attrs[NL80211_ATTR_IE]) { 12448 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12449 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12450 } 12451 12452 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 12453 12454 return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code, 12455 local_state_change); 12456 } 12457 12458 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info) 12459 { 12460 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12461 struct net_device *dev = info->user_ptr[1]; 12462 const u8 *ie = NULL, *bssid; 12463 int ie_len = 0; 12464 u16 reason_code; 12465 bool local_state_change; 12466 12467 if (dev->ieee80211_ptr->conn_owner_nlportid && 12468 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12469 return -EPERM; 12470 12471 if (!info->attrs[NL80211_ATTR_MAC]) 12472 return -EINVAL; 12473 12474 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 12475 return -EINVAL; 12476 12477 if (!rdev->ops->disassoc) 12478 return -EOPNOTSUPP; 12479 12480 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12481 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12482 return -EOPNOTSUPP; 12483 12484 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12485 12486 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 12487 if (reason_code == 0) { 12488 /* Reason Code 0 is reserved */ 12489 return -EINVAL; 12490 } 12491 12492 if (info->attrs[NL80211_ATTR_IE]) { 12493 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12494 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12495 } 12496 12497 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 12498 12499 return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code, 12500 local_state_change); 12501 } 12502 12503 static bool 12504 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev, 12505 int mcast_rate[NUM_NL80211_BANDS], 12506 int rateval) 12507 { 12508 struct wiphy *wiphy = &rdev->wiphy; 12509 bool found = false; 12510 int band, i; 12511 12512 for (band = 0; band < NUM_NL80211_BANDS; band++) { 12513 struct ieee80211_supported_band *sband; 12514 12515 sband = wiphy->bands[band]; 12516 if (!sband) 12517 continue; 12518 12519 for (i = 0; i < sband->n_bitrates; i++) { 12520 if (sband->bitrates[i].bitrate == rateval) { 12521 mcast_rate[band] = i + 1; 12522 found = true; 12523 break; 12524 } 12525 } 12526 } 12527 12528 return found; 12529 } 12530 12531 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info) 12532 { 12533 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12534 struct net_device *dev = info->user_ptr[1]; 12535 struct cfg80211_ibss_params ibss; 12536 struct wiphy *wiphy; 12537 struct cfg80211_cached_keys *connkeys = NULL; 12538 int err; 12539 12540 memset(&ibss, 0, sizeof(ibss)); 12541 12542 if (!info->attrs[NL80211_ATTR_SSID] || 12543 !nla_len(info->attrs[NL80211_ATTR_SSID])) 12544 return -EINVAL; 12545 12546 ibss.beacon_interval = 100; 12547 12548 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) 12549 ibss.beacon_interval = 12550 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 12551 12552 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC, 12553 ibss.beacon_interval); 12554 if (err) 12555 return err; 12556 12557 if (!rdev->ops->join_ibss) 12558 return -EOPNOTSUPP; 12559 12560 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 12561 return -EOPNOTSUPP; 12562 12563 wiphy = &rdev->wiphy; 12564 12565 if (info->attrs[NL80211_ATTR_MAC]) { 12566 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12567 12568 if (!is_valid_ether_addr(ibss.bssid)) 12569 return -EINVAL; 12570 } 12571 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12572 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12573 12574 if (info->attrs[NL80211_ATTR_IE]) { 12575 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12576 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12577 } 12578 12579 err = nl80211_parse_chandef(rdev, info, &ibss.chandef); 12580 if (err) 12581 return err; 12582 12583 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef, 12584 NL80211_IFTYPE_ADHOC)) 12585 return -EINVAL; 12586 12587 switch (ibss.chandef.width) { 12588 case NL80211_CHAN_WIDTH_5: 12589 case NL80211_CHAN_WIDTH_10: 12590 case NL80211_CHAN_WIDTH_20_NOHT: 12591 break; 12592 case NL80211_CHAN_WIDTH_20: 12593 case NL80211_CHAN_WIDTH_40: 12594 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 12595 return -EINVAL; 12596 break; 12597 case NL80211_CHAN_WIDTH_80: 12598 case NL80211_CHAN_WIDTH_80P80: 12599 case NL80211_CHAN_WIDTH_160: 12600 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 12601 return -EINVAL; 12602 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12603 NL80211_EXT_FEATURE_VHT_IBSS)) 12604 return -EINVAL; 12605 break; 12606 case NL80211_CHAN_WIDTH_320: 12607 return -EINVAL; 12608 default: 12609 return -EINVAL; 12610 } 12611 12612 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED]; 12613 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 12614 12615 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 12616 u8 *rates = 12617 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 12618 int n_rates = 12619 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 12620 struct ieee80211_supported_band *sband = 12621 wiphy->bands[ibss.chandef.chan->band]; 12622 12623 err = ieee80211_get_ratemask(sband, rates, n_rates, 12624 &ibss.basic_rates); 12625 if (err) 12626 return err; 12627 } 12628 12629 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12630 memcpy(&ibss.ht_capa_mask, 12631 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 12632 sizeof(ibss.ht_capa_mask)); 12633 12634 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 12635 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12636 return -EINVAL; 12637 memcpy(&ibss.ht_capa, 12638 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 12639 sizeof(ibss.ht_capa)); 12640 } 12641 12642 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 12643 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate, 12644 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 12645 return -EINVAL; 12646 12647 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) { 12648 bool no_ht = false; 12649 12650 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht); 12651 if (IS_ERR(connkeys)) 12652 return PTR_ERR(connkeys); 12653 12654 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) && 12655 no_ht) { 12656 kfree_sensitive(connkeys); 12657 return -EINVAL; 12658 } 12659 } 12660 12661 ibss.control_port = 12662 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]); 12663 12664 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 12665 int r = validate_pae_over_nl80211(rdev, info); 12666 12667 if (r < 0) { 12668 kfree_sensitive(connkeys); 12669 return r; 12670 } 12671 12672 ibss.control_port_over_nl80211 = true; 12673 } 12674 12675 ibss.userspace_handles_dfs = 12676 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 12677 12678 err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys); 12679 if (err) 12680 kfree_sensitive(connkeys); 12681 else if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 12682 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 12683 12684 return err; 12685 } 12686 12687 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info) 12688 { 12689 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12690 struct net_device *dev = info->user_ptr[1]; 12691 12692 if (!rdev->ops->leave_ibss) 12693 return -EOPNOTSUPP; 12694 12695 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 12696 return -EOPNOTSUPP; 12697 12698 return cfg80211_leave_ibss(rdev, dev, false); 12699 } 12700 12701 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info) 12702 { 12703 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12704 struct net_device *dev = info->user_ptr[1]; 12705 int mcast_rate[NUM_NL80211_BANDS]; 12706 u32 nla_rate; 12707 12708 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC && 12709 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 12710 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB) 12711 return -EOPNOTSUPP; 12712 12713 if (!rdev->ops->set_mcast_rate) 12714 return -EOPNOTSUPP; 12715 12716 memset(mcast_rate, 0, sizeof(mcast_rate)); 12717 12718 if (!info->attrs[NL80211_ATTR_MCAST_RATE]) 12719 return -EINVAL; 12720 12721 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]); 12722 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate)) 12723 return -EINVAL; 12724 12725 return rdev_set_mcast_rate(rdev, dev, mcast_rate); 12726 } 12727 12728 static struct sk_buff * 12729 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev, 12730 struct wireless_dev *wdev, int approxlen, 12731 u32 portid, u32 seq, enum nl80211_commands cmd, 12732 enum nl80211_attrs attr, 12733 const struct nl80211_vendor_cmd_info *info, 12734 gfp_t gfp) 12735 { 12736 struct sk_buff *skb; 12737 void *hdr; 12738 struct nlattr *data; 12739 12740 skb = nlmsg_new(approxlen + 100, gfp); 12741 if (!skb) 12742 return NULL; 12743 12744 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd); 12745 if (!hdr) { 12746 kfree_skb(skb); 12747 return NULL; 12748 } 12749 12750 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 12751 goto nla_put_failure; 12752 12753 if (info) { 12754 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID, 12755 info->vendor_id)) 12756 goto nla_put_failure; 12757 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD, 12758 info->subcmd)) 12759 goto nla_put_failure; 12760 } 12761 12762 if (wdev) { 12763 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 12764 wdev_id(wdev), NL80211_ATTR_PAD)) 12765 goto nla_put_failure; 12766 if (wdev->netdev && 12767 nla_put_u32(skb, NL80211_ATTR_IFINDEX, 12768 wdev->netdev->ifindex)) 12769 goto nla_put_failure; 12770 } 12771 12772 data = nla_nest_start_noflag(skb, attr); 12773 if (!data) 12774 goto nla_put_failure; 12775 12776 ((void **)skb->cb)[0] = rdev; 12777 ((void **)skb->cb)[1] = hdr; 12778 ((void **)skb->cb)[2] = data; 12779 12780 return skb; 12781 12782 nla_put_failure: 12783 kfree_skb(skb); 12784 return NULL; 12785 } 12786 12787 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy, 12788 struct wireless_dev *wdev, 12789 enum nl80211_commands cmd, 12790 enum nl80211_attrs attr, 12791 unsigned int portid, 12792 int vendor_event_idx, 12793 int approxlen, gfp_t gfp) 12794 { 12795 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 12796 const struct nl80211_vendor_cmd_info *info; 12797 12798 switch (cmd) { 12799 case NL80211_CMD_TESTMODE: 12800 if (WARN_ON(vendor_event_idx != -1)) 12801 return NULL; 12802 info = NULL; 12803 break; 12804 case NL80211_CMD_VENDOR: 12805 if (WARN_ON(vendor_event_idx < 0 || 12806 vendor_event_idx >= wiphy->n_vendor_events)) 12807 return NULL; 12808 info = &wiphy->vendor_events[vendor_event_idx]; 12809 break; 12810 default: 12811 WARN_ON(1); 12812 return NULL; 12813 } 12814 12815 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0, 12816 cmd, attr, info, gfp); 12817 } 12818 EXPORT_SYMBOL(__cfg80211_alloc_event_skb); 12819 12820 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp) 12821 { 12822 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 12823 void *hdr = ((void **)skb->cb)[1]; 12824 struct nlmsghdr *nlhdr = nlmsg_hdr(skb); 12825 struct nlattr *data = ((void **)skb->cb)[2]; 12826 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE; 12827 12828 /* clear CB data for netlink core to own from now on */ 12829 memset(skb->cb, 0, sizeof(skb->cb)); 12830 12831 nla_nest_end(skb, data); 12832 genlmsg_end(skb, hdr); 12833 12834 if (nlhdr->nlmsg_pid) { 12835 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb, 12836 nlhdr->nlmsg_pid); 12837 } else { 12838 if (data->nla_type == NL80211_ATTR_VENDOR_DATA) 12839 mcgrp = NL80211_MCGRP_VENDOR; 12840 12841 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 12842 skb, 0, mcgrp, gfp); 12843 } 12844 } 12845 EXPORT_SYMBOL(__cfg80211_send_event_skb); 12846 12847 #ifdef CONFIG_NL80211_TESTMODE 12848 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info) 12849 { 12850 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12851 struct wireless_dev *wdev; 12852 int err; 12853 12854 lockdep_assert_held(&rdev->wiphy.mtx); 12855 12856 wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 12857 info->attrs); 12858 12859 if (!rdev->ops->testmode_cmd) 12860 return -EOPNOTSUPP; 12861 12862 if (IS_ERR(wdev)) { 12863 err = PTR_ERR(wdev); 12864 if (err != -EINVAL) 12865 return err; 12866 wdev = NULL; 12867 } else if (wdev->wiphy != &rdev->wiphy) { 12868 return -EINVAL; 12869 } 12870 12871 if (!info->attrs[NL80211_ATTR_TESTDATA]) 12872 return -EINVAL; 12873 12874 rdev->cur_cmd_info = info; 12875 err = rdev_testmode_cmd(rdev, wdev, 12876 nla_data(info->attrs[NL80211_ATTR_TESTDATA]), 12877 nla_len(info->attrs[NL80211_ATTR_TESTDATA])); 12878 rdev->cur_cmd_info = NULL; 12879 12880 return err; 12881 } 12882 12883 static int nl80211_testmode_dump(struct sk_buff *skb, 12884 struct netlink_callback *cb) 12885 { 12886 struct cfg80211_registered_device *rdev; 12887 struct nlattr **attrbuf = NULL; 12888 int err; 12889 long phy_idx; 12890 void *data = NULL; 12891 int data_len = 0; 12892 12893 rtnl_lock(); 12894 12895 if (cb->args[0]) { 12896 /* 12897 * 0 is a valid index, but not valid for args[0], 12898 * so we need to offset by 1. 12899 */ 12900 phy_idx = cb->args[0] - 1; 12901 12902 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx); 12903 if (!rdev) { 12904 err = -ENOENT; 12905 goto out_err; 12906 } 12907 } else { 12908 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 12909 GFP_KERNEL); 12910 if (!attrbuf) { 12911 err = -ENOMEM; 12912 goto out_err; 12913 } 12914 12915 err = nlmsg_parse_deprecated(cb->nlh, 12916 GENL_HDRLEN + nl80211_fam.hdrsize, 12917 attrbuf, nl80211_fam.maxattr, 12918 nl80211_policy, NULL); 12919 if (err) 12920 goto out_err; 12921 12922 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 12923 if (IS_ERR(rdev)) { 12924 err = PTR_ERR(rdev); 12925 goto out_err; 12926 } 12927 phy_idx = rdev->wiphy_idx; 12928 12929 if (attrbuf[NL80211_ATTR_TESTDATA]) 12930 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA]; 12931 } 12932 12933 if (cb->args[1]) { 12934 data = nla_data((void *)cb->args[1]); 12935 data_len = nla_len((void *)cb->args[1]); 12936 } 12937 12938 if (!rdev->ops->testmode_dump) { 12939 err = -EOPNOTSUPP; 12940 goto out_err; 12941 } 12942 12943 while (1) { 12944 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 12945 cb->nlh->nlmsg_seq, NLM_F_MULTI, 12946 NL80211_CMD_TESTMODE); 12947 struct nlattr *tmdata; 12948 12949 if (!hdr) 12950 break; 12951 12952 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) { 12953 genlmsg_cancel(skb, hdr); 12954 break; 12955 } 12956 12957 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA); 12958 if (!tmdata) { 12959 genlmsg_cancel(skb, hdr); 12960 break; 12961 } 12962 err = rdev_testmode_dump(rdev, skb, cb, data, data_len); 12963 nla_nest_end(skb, tmdata); 12964 12965 if (err == -ENOBUFS || err == -ENOENT) { 12966 genlmsg_cancel(skb, hdr); 12967 break; 12968 } else if (err) { 12969 genlmsg_cancel(skb, hdr); 12970 goto out_err; 12971 } 12972 12973 genlmsg_end(skb, hdr); 12974 } 12975 12976 err = skb->len; 12977 /* see above */ 12978 cb->args[0] = phy_idx + 1; 12979 out_err: 12980 kfree(attrbuf); 12981 rtnl_unlock(); 12982 return err; 12983 } 12984 #endif 12985 12986 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info) 12987 { 12988 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12989 struct net_device *dev = info->user_ptr[1]; 12990 struct cfg80211_connect_params connect; 12991 struct wiphy *wiphy; 12992 struct cfg80211_cached_keys *connkeys = NULL; 12993 u32 freq = 0; 12994 int err; 12995 12996 memset(&connect, 0, sizeof(connect)); 12997 12998 if (!info->attrs[NL80211_ATTR_SSID] || 12999 !nla_len(info->attrs[NL80211_ATTR_SSID])) 13000 return -EINVAL; 13001 13002 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 13003 connect.auth_type = 13004 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 13005 if (!nl80211_valid_auth_type(rdev, connect.auth_type, 13006 NL80211_CMD_CONNECT)) 13007 return -EINVAL; 13008 } else 13009 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 13010 13011 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY]; 13012 13013 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] && 13014 !wiphy_ext_feature_isset(&rdev->wiphy, 13015 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 13016 return -EINVAL; 13017 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS]; 13018 13019 err = nl80211_crypto_settings(rdev, info, &connect.crypto, 13020 NL80211_MAX_NR_CIPHER_SUITES); 13021 if (err) 13022 return err; 13023 13024 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13025 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 13026 return -EOPNOTSUPP; 13027 13028 wiphy = &rdev->wiphy; 13029 13030 connect.bg_scan_period = -1; 13031 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] && 13032 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) { 13033 connect.bg_scan_period = 13034 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]); 13035 } 13036 13037 if (info->attrs[NL80211_ATTR_MAC]) 13038 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 13039 else if (info->attrs[NL80211_ATTR_MAC_HINT]) 13040 connect.bssid_hint = 13041 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]); 13042 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 13043 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 13044 13045 if (info->attrs[NL80211_ATTR_IE]) { 13046 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 13047 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 13048 } 13049 13050 if (info->attrs[NL80211_ATTR_USE_MFP]) { 13051 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 13052 if (connect.mfp == NL80211_MFP_OPTIONAL && 13053 !wiphy_ext_feature_isset(&rdev->wiphy, 13054 NL80211_EXT_FEATURE_MFP_OPTIONAL)) 13055 return -EOPNOTSUPP; 13056 } else { 13057 connect.mfp = NL80211_MFP_NO; 13058 } 13059 13060 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 13061 connect.prev_bssid = 13062 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 13063 13064 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) 13065 freq = MHZ_TO_KHZ(nla_get_u32( 13066 info->attrs[NL80211_ATTR_WIPHY_FREQ])); 13067 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 13068 freq += 13069 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 13070 13071 if (freq) { 13072 connect.channel = nl80211_get_valid_chan(wiphy, freq); 13073 if (!connect.channel) 13074 return -EINVAL; 13075 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) { 13076 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]); 13077 freq = MHZ_TO_KHZ(freq); 13078 connect.channel_hint = nl80211_get_valid_chan(wiphy, freq); 13079 if (!connect.channel_hint) 13080 return -EINVAL; 13081 } 13082 13083 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 13084 connect.edmg.channels = 13085 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 13086 13087 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 13088 connect.edmg.bw_config = 13089 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 13090 } 13091 13092 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) { 13093 connkeys = nl80211_parse_connkeys(rdev, info, NULL); 13094 if (IS_ERR(connkeys)) 13095 return PTR_ERR(connkeys); 13096 } 13097 13098 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 13099 connect.flags |= ASSOC_REQ_DISABLE_HT; 13100 13101 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 13102 memcpy(&connect.ht_capa_mask, 13103 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 13104 sizeof(connect.ht_capa_mask)); 13105 13106 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 13107 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) { 13108 kfree_sensitive(connkeys); 13109 return -EINVAL; 13110 } 13111 memcpy(&connect.ht_capa, 13112 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 13113 sizeof(connect.ht_capa)); 13114 } 13115 13116 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 13117 connect.flags |= ASSOC_REQ_DISABLE_VHT; 13118 13119 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 13120 connect.flags |= ASSOC_REQ_DISABLE_HE; 13121 13122 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 13123 connect.flags |= ASSOC_REQ_DISABLE_EHT; 13124 13125 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 13126 memcpy(&connect.vht_capa_mask, 13127 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 13128 sizeof(connect.vht_capa_mask)); 13129 13130 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 13131 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) { 13132 kfree_sensitive(connkeys); 13133 return -EINVAL; 13134 } 13135 memcpy(&connect.vht_capa, 13136 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 13137 sizeof(connect.vht_capa)); 13138 } 13139 13140 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 13141 if (!((rdev->wiphy.features & 13142 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 13143 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 13144 !wiphy_ext_feature_isset(&rdev->wiphy, 13145 NL80211_EXT_FEATURE_RRM)) { 13146 kfree_sensitive(connkeys); 13147 return -EINVAL; 13148 } 13149 connect.flags |= ASSOC_REQ_USE_RRM; 13150 } 13151 13152 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 13153 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 13154 kfree_sensitive(connkeys); 13155 return -EOPNOTSUPP; 13156 } 13157 13158 if (info->attrs[NL80211_ATTR_BSS_SELECT]) { 13159 /* bss selection makes no sense if bssid is set */ 13160 if (connect.bssid) { 13161 kfree_sensitive(connkeys); 13162 return -EINVAL; 13163 } 13164 13165 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT], 13166 wiphy, &connect.bss_select); 13167 if (err) { 13168 kfree_sensitive(connkeys); 13169 return err; 13170 } 13171 } 13172 13173 if (wiphy_ext_feature_isset(&rdev->wiphy, 13174 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 13175 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 13176 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 13177 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 13178 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13179 connect.fils_erp_username = 13180 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13181 connect.fils_erp_username_len = 13182 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13183 connect.fils_erp_realm = 13184 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13185 connect.fils_erp_realm_len = 13186 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13187 connect.fils_erp_next_seq_num = 13188 nla_get_u16( 13189 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 13190 connect.fils_erp_rrk = 13191 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13192 connect.fils_erp_rrk_len = 13193 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13194 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 13195 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 13196 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 13197 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13198 kfree_sensitive(connkeys); 13199 return -EINVAL; 13200 } 13201 13202 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) { 13203 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 13204 kfree_sensitive(connkeys); 13205 GENL_SET_ERR_MSG(info, 13206 "external auth requires connection ownership"); 13207 return -EINVAL; 13208 } 13209 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT; 13210 } 13211 13212 if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT])) 13213 connect.flags |= CONNECT_REQ_MLO_SUPPORT; 13214 13215 err = cfg80211_connect(rdev, dev, &connect, connkeys, 13216 connect.prev_bssid); 13217 if (err) 13218 kfree_sensitive(connkeys); 13219 13220 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 13221 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 13222 if (connect.bssid) 13223 memcpy(dev->ieee80211_ptr->disconnect_bssid, 13224 connect.bssid, ETH_ALEN); 13225 else 13226 eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid); 13227 } 13228 13229 return err; 13230 } 13231 13232 static int nl80211_update_connect_params(struct sk_buff *skb, 13233 struct genl_info *info) 13234 { 13235 struct cfg80211_connect_params connect = {}; 13236 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13237 struct net_device *dev = info->user_ptr[1]; 13238 struct wireless_dev *wdev = dev->ieee80211_ptr; 13239 bool fils_sk_offload; 13240 u32 auth_type; 13241 u32 changed = 0; 13242 13243 if (!rdev->ops->update_connect_params) 13244 return -EOPNOTSUPP; 13245 13246 if (info->attrs[NL80211_ATTR_IE]) { 13247 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 13248 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 13249 changed |= UPDATE_ASSOC_IES; 13250 } 13251 13252 fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy, 13253 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD); 13254 13255 /* 13256 * when driver supports fils-sk offload all attributes must be 13257 * provided. So the else covers "fils-sk-not-all" and 13258 * "no-fils-sk-any". 13259 */ 13260 if (fils_sk_offload && 13261 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 13262 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 13263 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 13264 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13265 connect.fils_erp_username = 13266 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13267 connect.fils_erp_username_len = 13268 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 13269 connect.fils_erp_realm = 13270 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13271 connect.fils_erp_realm_len = 13272 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 13273 connect.fils_erp_next_seq_num = 13274 nla_get_u16( 13275 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 13276 connect.fils_erp_rrk = 13277 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13278 connect.fils_erp_rrk_len = 13279 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 13280 changed |= UPDATE_FILS_ERP_INFO; 13281 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 13282 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 13283 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 13284 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 13285 return -EINVAL; 13286 } 13287 13288 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 13289 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 13290 if (!nl80211_valid_auth_type(rdev, auth_type, 13291 NL80211_CMD_CONNECT)) 13292 return -EINVAL; 13293 13294 if (auth_type == NL80211_AUTHTYPE_FILS_SK && 13295 fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO)) 13296 return -EINVAL; 13297 13298 connect.auth_type = auth_type; 13299 changed |= UPDATE_AUTH_TYPE; 13300 } 13301 13302 if (!wdev->connected) 13303 return -ENOLINK; 13304 13305 return rdev_update_connect_params(rdev, dev, &connect, changed); 13306 } 13307 13308 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info) 13309 { 13310 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13311 struct net_device *dev = info->user_ptr[1]; 13312 u16 reason; 13313 13314 if (dev->ieee80211_ptr->conn_owner_nlportid && 13315 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 13316 return -EPERM; 13317 13318 reason = nla_get_u16_default(info->attrs[NL80211_ATTR_REASON_CODE], 13319 WLAN_REASON_DEAUTH_LEAVING); 13320 13321 if (reason == 0) 13322 return -EINVAL; 13323 13324 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13325 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 13326 return -EOPNOTSUPP; 13327 13328 return cfg80211_disconnect(rdev, dev, reason, true); 13329 } 13330 13331 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info) 13332 { 13333 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13334 struct net *net; 13335 int err; 13336 13337 if (info->attrs[NL80211_ATTR_PID]) { 13338 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]); 13339 13340 net = get_net_ns_by_pid(pid); 13341 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) { 13342 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]); 13343 13344 net = get_net_ns_by_fd(fd); 13345 } else { 13346 return -EINVAL; 13347 } 13348 13349 if (IS_ERR(net)) 13350 return PTR_ERR(net); 13351 13352 err = 0; 13353 13354 /* check if anything to do */ 13355 if (!net_eq(wiphy_net(&rdev->wiphy), net)) 13356 err = cfg80211_switch_netns(rdev, net); 13357 13358 put_net(net); 13359 return err; 13360 } 13361 13362 static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info) 13363 { 13364 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13365 struct net_device *dev = info->user_ptr[1]; 13366 struct cfg80211_pmksa pmksa; 13367 bool ap_pmksa_caching_support = false; 13368 13369 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 13370 13371 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 13372 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 13373 13374 if (!info->attrs[NL80211_ATTR_PMKID]) 13375 return -EINVAL; 13376 13377 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 13378 13379 if (info->attrs[NL80211_ATTR_MAC]) { 13380 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 13381 } else if (info->attrs[NL80211_ATTR_SSID] && 13382 info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 13383 info->attrs[NL80211_ATTR_PMK]) { 13384 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 13385 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 13386 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 13387 } else { 13388 return -EINVAL; 13389 } 13390 13391 if (info->attrs[NL80211_ATTR_PMK]) { 13392 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 13393 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 13394 } 13395 13396 if (info->attrs[NL80211_ATTR_PMK_LIFETIME]) 13397 pmksa.pmk_lifetime = 13398 nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]); 13399 13400 if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]) 13401 pmksa.pmk_reauth_threshold = 13402 nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]); 13403 13404 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13405 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 13406 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 13407 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 13408 ap_pmksa_caching_support)) 13409 return -EOPNOTSUPP; 13410 13411 if (!rdev->ops->set_pmksa) 13412 return -EOPNOTSUPP; 13413 13414 return rdev_set_pmksa(rdev, dev, &pmksa); 13415 } 13416 13417 static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info) 13418 { 13419 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13420 struct net_device *dev = info->user_ptr[1]; 13421 struct cfg80211_pmksa pmksa; 13422 bool sae_offload_support = false; 13423 bool owe_offload_support = false; 13424 bool ap_pmksa_caching_support = false; 13425 13426 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 13427 13428 sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 13429 NL80211_EXT_FEATURE_SAE_OFFLOAD); 13430 owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 13431 NL80211_EXT_FEATURE_OWE_OFFLOAD); 13432 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 13433 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 13434 13435 if (info->attrs[NL80211_ATTR_PMKID]) 13436 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 13437 13438 if (info->attrs[NL80211_ATTR_MAC]) { 13439 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 13440 } else if (info->attrs[NL80211_ATTR_SSID]) { 13441 /* SSID based pmksa flush supported only for FILS, 13442 * OWE/SAE OFFLOAD cases 13443 */ 13444 if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 13445 info->attrs[NL80211_ATTR_PMK]) { 13446 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 13447 } else if (!sae_offload_support && !owe_offload_support) { 13448 return -EINVAL; 13449 } 13450 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 13451 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 13452 } else { 13453 return -EINVAL; 13454 } 13455 13456 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13457 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 13458 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 13459 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 13460 ap_pmksa_caching_support)) 13461 return -EOPNOTSUPP; 13462 13463 if (!rdev->ops->del_pmksa) 13464 return -EOPNOTSUPP; 13465 13466 return rdev_del_pmksa(rdev, dev, &pmksa); 13467 } 13468 13469 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info) 13470 { 13471 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13472 struct net_device *dev = info->user_ptr[1]; 13473 13474 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 13475 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 13476 return -EOPNOTSUPP; 13477 13478 if (!rdev->ops->flush_pmksa) 13479 return -EOPNOTSUPP; 13480 13481 return rdev_flush_pmksa(rdev, dev); 13482 } 13483 13484 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info) 13485 { 13486 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13487 struct net_device *dev = info->user_ptr[1]; 13488 u8 action_code, dialog_token; 13489 u32 peer_capability = 0; 13490 u16 status_code; 13491 u8 *peer; 13492 int link_id; 13493 bool initiator; 13494 13495 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 13496 !rdev->ops->tdls_mgmt) 13497 return -EOPNOTSUPP; 13498 13499 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] || 13500 !info->attrs[NL80211_ATTR_STATUS_CODE] || 13501 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] || 13502 !info->attrs[NL80211_ATTR_IE] || 13503 !info->attrs[NL80211_ATTR_MAC]) 13504 return -EINVAL; 13505 13506 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 13507 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]); 13508 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 13509 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]); 13510 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]); 13511 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]) 13512 peer_capability = 13513 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]); 13514 link_id = nl80211_link_id_or_invalid(info->attrs); 13515 13516 return rdev_tdls_mgmt(rdev, dev, peer, link_id, action_code, 13517 dialog_token, status_code, peer_capability, 13518 initiator, 13519 nla_data(info->attrs[NL80211_ATTR_IE]), 13520 nla_len(info->attrs[NL80211_ATTR_IE])); 13521 } 13522 13523 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info) 13524 { 13525 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13526 struct net_device *dev = info->user_ptr[1]; 13527 enum nl80211_tdls_operation operation; 13528 u8 *peer; 13529 13530 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 13531 !rdev->ops->tdls_oper) 13532 return -EOPNOTSUPP; 13533 13534 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] || 13535 !info->attrs[NL80211_ATTR_MAC]) 13536 return -EINVAL; 13537 13538 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]); 13539 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 13540 13541 return rdev_tdls_oper(rdev, dev, peer, operation); 13542 } 13543 13544 static int nl80211_remain_on_channel(struct sk_buff *skb, 13545 struct genl_info *info) 13546 { 13547 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13548 unsigned int link_id = nl80211_link_id(info->attrs); 13549 struct wireless_dev *wdev = info->user_ptr[1]; 13550 struct cfg80211_chan_def chandef; 13551 struct sk_buff *msg; 13552 void *hdr; 13553 u64 cookie; 13554 u32 duration; 13555 int err; 13556 13557 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 13558 !info->attrs[NL80211_ATTR_DURATION]) 13559 return -EINVAL; 13560 13561 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 13562 13563 if (!rdev->ops->remain_on_channel || 13564 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)) 13565 return -EOPNOTSUPP; 13566 13567 /* 13568 * We should be on that channel for at least a minimum amount of 13569 * time (10ms) but no longer than the driver supports. 13570 */ 13571 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 13572 duration > rdev->wiphy.max_remain_on_channel_duration) 13573 return -EINVAL; 13574 13575 err = nl80211_parse_chandef(rdev, info, &chandef); 13576 if (err) 13577 return err; 13578 13579 if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) { 13580 const struct cfg80211_chan_def *oper_chandef, *compat_chandef; 13581 13582 oper_chandef = wdev_chandef(wdev, link_id); 13583 13584 if (WARN_ON(!oper_chandef)) { 13585 /* cannot happen since we must beacon to get here */ 13586 WARN_ON(1); 13587 return -EBUSY; 13588 } 13589 13590 /* note: returns first one if identical chandefs */ 13591 compat_chandef = cfg80211_chandef_compatible(&chandef, 13592 oper_chandef); 13593 13594 if (compat_chandef != &chandef) 13595 return -EBUSY; 13596 } 13597 13598 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13599 if (!msg) 13600 return -ENOMEM; 13601 13602 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13603 NL80211_CMD_REMAIN_ON_CHANNEL); 13604 if (!hdr) { 13605 err = -ENOBUFS; 13606 goto free_msg; 13607 } 13608 13609 err = rdev_remain_on_channel(rdev, wdev, chandef.chan, 13610 duration, &cookie); 13611 13612 if (err) 13613 goto free_msg; 13614 13615 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 13616 NL80211_ATTR_PAD)) 13617 goto nla_put_failure; 13618 13619 genlmsg_end(msg, hdr); 13620 13621 return genlmsg_reply(msg, info); 13622 13623 nla_put_failure: 13624 err = -ENOBUFS; 13625 free_msg: 13626 nlmsg_free(msg); 13627 return err; 13628 } 13629 13630 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb, 13631 struct genl_info *info) 13632 { 13633 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13634 struct wireless_dev *wdev = info->user_ptr[1]; 13635 u64 cookie; 13636 13637 if (!info->attrs[NL80211_ATTR_COOKIE]) 13638 return -EINVAL; 13639 13640 if (!rdev->ops->cancel_remain_on_channel) 13641 return -EOPNOTSUPP; 13642 13643 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 13644 13645 return rdev_cancel_remain_on_channel(rdev, wdev, cookie); 13646 } 13647 13648 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb, 13649 struct genl_info *info) 13650 { 13651 struct cfg80211_bitrate_mask mask; 13652 unsigned int link_id = nl80211_link_id(info->attrs); 13653 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13654 struct net_device *dev = info->user_ptr[1]; 13655 int err; 13656 13657 if (!rdev->ops->set_bitrate_mask) 13658 return -EOPNOTSUPP; 13659 13660 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 13661 NL80211_ATTR_TX_RATES, &mask, 13662 dev, true, link_id); 13663 if (err) 13664 return err; 13665 13666 return rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask); 13667 } 13668 13669 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info) 13670 { 13671 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13672 struct wireless_dev *wdev = info->user_ptr[1]; 13673 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION; 13674 13675 if (!info->attrs[NL80211_ATTR_FRAME_MATCH]) 13676 return -EINVAL; 13677 13678 if (info->attrs[NL80211_ATTR_FRAME_TYPE]) 13679 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]); 13680 13681 switch (wdev->iftype) { 13682 case NL80211_IFTYPE_STATION: 13683 case NL80211_IFTYPE_ADHOC: 13684 case NL80211_IFTYPE_P2P_CLIENT: 13685 case NL80211_IFTYPE_AP: 13686 case NL80211_IFTYPE_AP_VLAN: 13687 case NL80211_IFTYPE_MESH_POINT: 13688 case NL80211_IFTYPE_P2P_GO: 13689 case NL80211_IFTYPE_P2P_DEVICE: 13690 break; 13691 case NL80211_IFTYPE_NAN: 13692 if (!wiphy_ext_feature_isset(wdev->wiphy, 13693 NL80211_EXT_FEATURE_SECURE_NAN)) 13694 return -EOPNOTSUPP; 13695 break; 13696 default: 13697 return -EOPNOTSUPP; 13698 } 13699 13700 /* not much point in registering if we can't reply */ 13701 if (!rdev->ops->mgmt_tx) 13702 return -EOPNOTSUPP; 13703 13704 if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] && 13705 !wiphy_ext_feature_isset(&rdev->wiphy, 13706 NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) { 13707 GENL_SET_ERR_MSG(info, 13708 "multicast RX registrations are not supported"); 13709 return -EOPNOTSUPP; 13710 } 13711 13712 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type, 13713 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]), 13714 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]), 13715 info->attrs[NL80211_ATTR_RECEIVE_MULTICAST], 13716 info->extack); 13717 } 13718 13719 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info) 13720 { 13721 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13722 struct wireless_dev *wdev = info->user_ptr[1]; 13723 struct cfg80211_chan_def chandef; 13724 int err; 13725 void *hdr = NULL; 13726 u64 cookie; 13727 struct sk_buff *msg = NULL; 13728 struct cfg80211_mgmt_tx_params params = { 13729 .dont_wait_for_ack = 13730 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK], 13731 }; 13732 13733 if (!info->attrs[NL80211_ATTR_FRAME]) 13734 return -EINVAL; 13735 13736 if (!rdev->ops->mgmt_tx) 13737 return -EOPNOTSUPP; 13738 13739 switch (wdev->iftype) { 13740 case NL80211_IFTYPE_P2P_DEVICE: 13741 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 13742 return -EINVAL; 13743 break; 13744 case NL80211_IFTYPE_STATION: 13745 case NL80211_IFTYPE_ADHOC: 13746 case NL80211_IFTYPE_P2P_CLIENT: 13747 case NL80211_IFTYPE_AP: 13748 case NL80211_IFTYPE_AP_VLAN: 13749 case NL80211_IFTYPE_MESH_POINT: 13750 case NL80211_IFTYPE_P2P_GO: 13751 break; 13752 case NL80211_IFTYPE_NAN: 13753 if (!wiphy_ext_feature_isset(wdev->wiphy, 13754 NL80211_EXT_FEATURE_SECURE_NAN)) 13755 return -EOPNOTSUPP; 13756 break; 13757 default: 13758 return -EOPNOTSUPP; 13759 } 13760 13761 if (info->attrs[NL80211_ATTR_DURATION]) { 13762 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 13763 return -EINVAL; 13764 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 13765 13766 /* 13767 * We should wait on the channel for at least a minimum amount 13768 * of time (10ms) but no longer than the driver supports. 13769 */ 13770 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 13771 params.wait > rdev->wiphy.max_remain_on_channel_duration) 13772 return -EINVAL; 13773 } 13774 13775 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK]; 13776 13777 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 13778 return -EINVAL; 13779 13780 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 13781 13782 /* get the channel if any has been specified, otherwise pass NULL to 13783 * the driver. The latter will use the current one 13784 */ 13785 chandef.chan = NULL; 13786 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 13787 err = nl80211_parse_chandef(rdev, info, &chandef); 13788 if (err) 13789 return err; 13790 } 13791 13792 if (!chandef.chan && params.offchan) 13793 return -EINVAL; 13794 13795 if (params.offchan && 13796 !cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) 13797 return -EBUSY; 13798 13799 params.link_id = nl80211_link_id_or_invalid(info->attrs); 13800 /* 13801 * This now races due to the unlock, but we cannot check 13802 * the valid links for the _station_ anyway, so that's up 13803 * to the driver. 13804 */ 13805 if (params.link_id >= 0 && 13806 !(wdev->valid_links & BIT(params.link_id))) 13807 return -EINVAL; 13808 13809 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 13810 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 13811 13812 err = nl80211_parse_counter_offsets(rdev, NULL, params.len, -1, 13813 info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX], 13814 ¶ms.csa_offsets, 13815 ¶ms.n_csa_offsets); 13816 if (err) 13817 return err; 13818 13819 if (!params.dont_wait_for_ack) { 13820 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13821 if (!msg) 13822 return -ENOMEM; 13823 13824 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13825 NL80211_CMD_FRAME); 13826 if (!hdr) { 13827 err = -ENOBUFS; 13828 goto free_msg; 13829 } 13830 } 13831 13832 params.chan = chandef.chan; 13833 err = cfg80211_mlme_mgmt_tx(rdev, wdev, ¶ms, &cookie); 13834 if (err) 13835 goto free_msg; 13836 13837 if (msg) { 13838 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 13839 NL80211_ATTR_PAD)) 13840 goto nla_put_failure; 13841 13842 genlmsg_end(msg, hdr); 13843 return genlmsg_reply(msg, info); 13844 } 13845 13846 return 0; 13847 13848 nla_put_failure: 13849 err = -ENOBUFS; 13850 free_msg: 13851 nlmsg_free(msg); 13852 return err; 13853 } 13854 13855 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info) 13856 { 13857 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13858 struct wireless_dev *wdev = info->user_ptr[1]; 13859 u64 cookie; 13860 13861 if (!info->attrs[NL80211_ATTR_COOKIE]) 13862 return -EINVAL; 13863 13864 if (!rdev->ops->mgmt_tx_cancel_wait) 13865 return -EOPNOTSUPP; 13866 13867 switch (wdev->iftype) { 13868 case NL80211_IFTYPE_STATION: 13869 case NL80211_IFTYPE_ADHOC: 13870 case NL80211_IFTYPE_P2P_CLIENT: 13871 case NL80211_IFTYPE_AP: 13872 case NL80211_IFTYPE_AP_VLAN: 13873 case NL80211_IFTYPE_P2P_GO: 13874 case NL80211_IFTYPE_P2P_DEVICE: 13875 break; 13876 case NL80211_IFTYPE_NAN: 13877 if (!wiphy_ext_feature_isset(wdev->wiphy, 13878 NL80211_EXT_FEATURE_SECURE_NAN)) 13879 return -EOPNOTSUPP; 13880 break; 13881 default: 13882 return -EOPNOTSUPP; 13883 } 13884 13885 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 13886 13887 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie); 13888 } 13889 13890 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info) 13891 { 13892 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13893 struct wireless_dev *wdev; 13894 struct net_device *dev = info->user_ptr[1]; 13895 u8 ps_state; 13896 bool state; 13897 int err; 13898 13899 if (!info->attrs[NL80211_ATTR_PS_STATE]) 13900 return -EINVAL; 13901 13902 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]); 13903 13904 wdev = dev->ieee80211_ptr; 13905 13906 if (!rdev->ops->set_power_mgmt) 13907 return -EOPNOTSUPP; 13908 13909 state = (ps_state == NL80211_PS_ENABLED) ? true : false; 13910 13911 if (state == wdev->ps) 13912 return 0; 13913 13914 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout); 13915 if (!err) 13916 wdev->ps = state; 13917 return err; 13918 } 13919 13920 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info) 13921 { 13922 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13923 enum nl80211_ps_state ps_state; 13924 struct wireless_dev *wdev; 13925 struct net_device *dev = info->user_ptr[1]; 13926 struct sk_buff *msg; 13927 void *hdr; 13928 int err; 13929 13930 wdev = dev->ieee80211_ptr; 13931 13932 if (!rdev->ops->set_power_mgmt) 13933 return -EOPNOTSUPP; 13934 13935 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13936 if (!msg) 13937 return -ENOMEM; 13938 13939 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13940 NL80211_CMD_GET_POWER_SAVE); 13941 if (!hdr) { 13942 err = -ENOBUFS; 13943 goto free_msg; 13944 } 13945 13946 if (wdev->ps) 13947 ps_state = NL80211_PS_ENABLED; 13948 else 13949 ps_state = NL80211_PS_DISABLED; 13950 13951 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state)) 13952 goto nla_put_failure; 13953 13954 genlmsg_end(msg, hdr); 13955 return genlmsg_reply(msg, info); 13956 13957 nla_put_failure: 13958 err = -ENOBUFS; 13959 free_msg: 13960 nlmsg_free(msg); 13961 return err; 13962 } 13963 13964 static const struct nla_policy 13965 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = { 13966 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY }, 13967 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 }, 13968 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 }, 13969 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 }, 13970 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 }, 13971 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 }, 13972 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 }, 13973 }; 13974 13975 static int nl80211_set_cqm_txe(struct genl_info *info, 13976 u32 rate, u32 pkts, u32 intvl) 13977 { 13978 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13979 struct net_device *dev = info->user_ptr[1]; 13980 struct wireless_dev *wdev = dev->ieee80211_ptr; 13981 13982 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL) 13983 return -EINVAL; 13984 13985 if (!rdev->ops->set_cqm_txe_config) 13986 return -EOPNOTSUPP; 13987 13988 if (wdev->iftype != NL80211_IFTYPE_STATION && 13989 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 13990 return -EOPNOTSUPP; 13991 13992 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl); 13993 } 13994 13995 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev, 13996 struct net_device *dev, 13997 struct cfg80211_cqm_config *cqm_config) 13998 { 13999 struct wireless_dev *wdev = dev->ieee80211_ptr; 14000 s32 last, low, high; 14001 u32 hyst; 14002 int i, n, low_index; 14003 int err; 14004 14005 /* 14006 * Obtain current RSSI value if possible, if not and no RSSI threshold 14007 * event has been received yet, we should receive an event after a 14008 * connection is established and enough beacons received to calculate 14009 * the average. 14010 */ 14011 if (!cqm_config->last_rssi_event_value && 14012 wdev->links[0].client.current_bss && 14013 rdev->ops->get_station) { 14014 struct station_info sinfo = {}; 14015 u8 *mac_addr; 14016 14017 mac_addr = wdev->links[0].client.current_bss->pub.bssid; 14018 14019 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 14020 if (err) 14021 return err; 14022 14023 cfg80211_sinfo_release_content(&sinfo); 14024 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG)) 14025 cqm_config->last_rssi_event_value = 14026 (s8) sinfo.rx_beacon_signal_avg; 14027 } 14028 14029 last = cqm_config->last_rssi_event_value; 14030 hyst = cqm_config->rssi_hyst; 14031 n = cqm_config->n_rssi_thresholds; 14032 14033 for (i = 0; i < n; i++) { 14034 i = array_index_nospec(i, n); 14035 if (last < cqm_config->rssi_thresholds[i]) 14036 break; 14037 } 14038 14039 low_index = i - 1; 14040 if (low_index >= 0) { 14041 low_index = array_index_nospec(low_index, n); 14042 low = cqm_config->rssi_thresholds[low_index] - hyst; 14043 } else { 14044 low = S32_MIN; 14045 } 14046 if (i < n) { 14047 i = array_index_nospec(i, n); 14048 high = cqm_config->rssi_thresholds[i] + hyst - 1; 14049 } else { 14050 high = S32_MAX; 14051 } 14052 14053 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high); 14054 } 14055 14056 static int nl80211_set_cqm_rssi(struct genl_info *info, 14057 const s32 *thresholds, int n_thresholds, 14058 u32 hysteresis) 14059 { 14060 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14061 struct cfg80211_cqm_config *cqm_config = NULL, *old; 14062 struct net_device *dev = info->user_ptr[1]; 14063 struct wireless_dev *wdev = dev->ieee80211_ptr; 14064 s32 prev = S32_MIN; 14065 int i, err; 14066 14067 /* Check all values negative and sorted */ 14068 for (i = 0; i < n_thresholds; i++) { 14069 if (thresholds[i] > 0 || thresholds[i] <= prev) 14070 return -EINVAL; 14071 14072 prev = thresholds[i]; 14073 } 14074 14075 if (wdev->iftype != NL80211_IFTYPE_STATION && 14076 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 14077 return -EOPNOTSUPP; 14078 14079 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */ 14080 n_thresholds = 0; 14081 14082 old = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 14083 14084 /* if already disabled just succeed */ 14085 if (!n_thresholds && !old) 14086 return 0; 14087 14088 if (n_thresholds > 1) { 14089 if (!wiphy_ext_feature_isset(&rdev->wiphy, 14090 NL80211_EXT_FEATURE_CQM_RSSI_LIST) || 14091 !rdev->ops->set_cqm_rssi_range_config) 14092 return -EOPNOTSUPP; 14093 } else { 14094 if (!rdev->ops->set_cqm_rssi_config) 14095 return -EOPNOTSUPP; 14096 } 14097 14098 if (n_thresholds) { 14099 cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds, 14100 n_thresholds), 14101 GFP_KERNEL); 14102 if (!cqm_config) 14103 return -ENOMEM; 14104 14105 cqm_config->rssi_hyst = hysteresis; 14106 cqm_config->n_rssi_thresholds = n_thresholds; 14107 memcpy(cqm_config->rssi_thresholds, thresholds, 14108 flex_array_size(cqm_config, rssi_thresholds, 14109 n_thresholds)); 14110 cqm_config->use_range_api = n_thresholds > 1 || 14111 !rdev->ops->set_cqm_rssi_config; 14112 14113 rcu_assign_pointer(wdev->cqm_config, cqm_config); 14114 14115 if (cqm_config->use_range_api) 14116 err = cfg80211_cqm_rssi_update(rdev, dev, cqm_config); 14117 else 14118 err = rdev_set_cqm_rssi_config(rdev, dev, 14119 thresholds[0], 14120 hysteresis); 14121 } else { 14122 RCU_INIT_POINTER(wdev->cqm_config, NULL); 14123 /* if enabled as range also disable via range */ 14124 if (old->use_range_api) 14125 err = rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0); 14126 else 14127 err = rdev_set_cqm_rssi_config(rdev, dev, 0, 0); 14128 } 14129 14130 if (err) { 14131 rcu_assign_pointer(wdev->cqm_config, old); 14132 kfree_rcu(cqm_config, rcu_head); 14133 } else { 14134 kfree_rcu(old, rcu_head); 14135 } 14136 14137 return err; 14138 } 14139 14140 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info) 14141 { 14142 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1]; 14143 struct nlattr *cqm; 14144 int err; 14145 14146 cqm = info->attrs[NL80211_ATTR_CQM]; 14147 if (!cqm) 14148 return -EINVAL; 14149 14150 err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm, 14151 nl80211_attr_cqm_policy, 14152 info->extack); 14153 if (err) 14154 return err; 14155 14156 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] && 14157 attrs[NL80211_ATTR_CQM_RSSI_HYST]) { 14158 const s32 *thresholds = 14159 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 14160 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 14161 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]); 14162 14163 if (len % 4) 14164 return -EINVAL; 14165 14166 return nl80211_set_cqm_rssi(info, thresholds, len / 4, 14167 hysteresis); 14168 } 14169 14170 if (attrs[NL80211_ATTR_CQM_TXE_RATE] && 14171 attrs[NL80211_ATTR_CQM_TXE_PKTS] && 14172 attrs[NL80211_ATTR_CQM_TXE_INTVL]) { 14173 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]); 14174 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]); 14175 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]); 14176 14177 return nl80211_set_cqm_txe(info, rate, pkts, intvl); 14178 } 14179 14180 return -EINVAL; 14181 } 14182 14183 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info) 14184 { 14185 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14186 struct net_device *dev = info->user_ptr[1]; 14187 struct ocb_setup setup = {}; 14188 int err; 14189 14190 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 14191 if (err) 14192 return err; 14193 14194 return cfg80211_join_ocb(rdev, dev, &setup); 14195 } 14196 14197 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info) 14198 { 14199 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14200 struct net_device *dev = info->user_ptr[1]; 14201 14202 return cfg80211_leave_ocb(rdev, dev); 14203 } 14204 14205 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info) 14206 { 14207 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14208 struct net_device *dev = info->user_ptr[1]; 14209 struct mesh_config cfg; 14210 struct mesh_setup setup; 14211 int err; 14212 14213 /* start with default */ 14214 memcpy(&cfg, &default_mesh_config, sizeof(cfg)); 14215 memcpy(&setup, &default_mesh_setup, sizeof(setup)); 14216 14217 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) { 14218 /* and parse parameters if given */ 14219 err = nl80211_parse_mesh_config(info, &cfg, NULL); 14220 if (err) 14221 return err; 14222 } 14223 14224 if (!info->attrs[NL80211_ATTR_MESH_ID] || 14225 !nla_len(info->attrs[NL80211_ATTR_MESH_ID])) 14226 return -EINVAL; 14227 14228 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]); 14229 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 14230 14231 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 14232 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate, 14233 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 14234 return -EINVAL; 14235 14236 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) { 14237 setup.beacon_interval = 14238 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 14239 14240 err = cfg80211_validate_beacon_int(rdev, 14241 NL80211_IFTYPE_MESH_POINT, 14242 setup.beacon_interval); 14243 if (err) 14244 return err; 14245 } 14246 14247 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) { 14248 setup.dtim_period = 14249 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 14250 if (setup.dtim_period < 1 || setup.dtim_period > 100) 14251 return -EINVAL; 14252 } 14253 14254 if (info->attrs[NL80211_ATTR_MESH_SETUP]) { 14255 /* parse additional setup parameters if given */ 14256 err = nl80211_parse_mesh_setup(info, &setup); 14257 if (err) 14258 return err; 14259 } 14260 14261 if (setup.user_mpm) 14262 cfg.auto_open_plinks = false; 14263 14264 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 14265 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 14266 if (err) 14267 return err; 14268 } else { 14269 /* __cfg80211_join_mesh() will sort it out */ 14270 setup.chandef.chan = NULL; 14271 } 14272 14273 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 14274 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 14275 int n_rates = 14276 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 14277 struct ieee80211_supported_band *sband; 14278 14279 if (!setup.chandef.chan) 14280 return -EINVAL; 14281 14282 sband = rdev->wiphy.bands[setup.chandef.chan->band]; 14283 14284 err = ieee80211_get_ratemask(sband, rates, n_rates, 14285 &setup.basic_rates); 14286 if (err) 14287 return err; 14288 } 14289 14290 if (info->attrs[NL80211_ATTR_TX_RATES]) { 14291 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 14292 NL80211_ATTR_TX_RATES, 14293 &setup.beacon_rate, 14294 dev, false, 0); 14295 if (err) 14296 return err; 14297 14298 if (!setup.chandef.chan) 14299 return -EINVAL; 14300 14301 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band, 14302 &setup.beacon_rate); 14303 if (err) 14304 return err; 14305 } 14306 14307 setup.userspace_handles_dfs = 14308 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 14309 14310 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 14311 int r = validate_pae_over_nl80211(rdev, info); 14312 14313 if (r < 0) 14314 return r; 14315 14316 setup.control_port_over_nl80211 = true; 14317 } 14318 14319 err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg); 14320 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) 14321 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 14322 14323 return err; 14324 } 14325 14326 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info) 14327 { 14328 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14329 struct net_device *dev = info->user_ptr[1]; 14330 14331 return cfg80211_leave_mesh(rdev, dev); 14332 } 14333 14334 #ifdef CONFIG_PM 14335 static int nl80211_send_wowlan_patterns(struct sk_buff *msg, 14336 struct cfg80211_registered_device *rdev) 14337 { 14338 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config; 14339 struct nlattr *nl_pats, *nl_pat; 14340 int i, pat_len; 14341 14342 if (!wowlan->n_patterns) 14343 return 0; 14344 14345 nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN); 14346 if (!nl_pats) 14347 return -ENOBUFS; 14348 14349 for (i = 0; i < wowlan->n_patterns; i++) { 14350 nl_pat = nla_nest_start_noflag(msg, i + 1); 14351 if (!nl_pat) 14352 return -ENOBUFS; 14353 pat_len = wowlan->patterns[i].pattern_len; 14354 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8), 14355 wowlan->patterns[i].mask) || 14356 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 14357 wowlan->patterns[i].pattern) || 14358 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 14359 wowlan->patterns[i].pkt_offset)) 14360 return -ENOBUFS; 14361 nla_nest_end(msg, nl_pat); 14362 } 14363 nla_nest_end(msg, nl_pats); 14364 14365 return 0; 14366 } 14367 14368 static int nl80211_send_wowlan_tcp(struct sk_buff *msg, 14369 struct cfg80211_wowlan_tcp *tcp) 14370 { 14371 struct nlattr *nl_tcp; 14372 14373 if (!tcp) 14374 return 0; 14375 14376 nl_tcp = nla_nest_start_noflag(msg, 14377 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 14378 if (!nl_tcp) 14379 return -ENOBUFS; 14380 14381 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) || 14382 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) || 14383 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) || 14384 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) || 14385 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) || 14386 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 14387 tcp->payload_len, tcp->payload) || 14388 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 14389 tcp->data_interval) || 14390 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 14391 tcp->wake_len, tcp->wake_data) || 14392 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK, 14393 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask)) 14394 return -ENOBUFS; 14395 14396 if (tcp->payload_seq.len && 14397 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ, 14398 sizeof(tcp->payload_seq), &tcp->payload_seq)) 14399 return -ENOBUFS; 14400 14401 if (tcp->payload_tok.len && 14402 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 14403 sizeof(tcp->payload_tok) + tcp->tokens_size, 14404 &tcp->payload_tok)) 14405 return -ENOBUFS; 14406 14407 nla_nest_end(msg, nl_tcp); 14408 14409 return 0; 14410 } 14411 14412 static int nl80211_send_wowlan_nd(struct sk_buff *msg, 14413 struct cfg80211_sched_scan_request *req) 14414 { 14415 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan; 14416 int i; 14417 14418 if (!req) 14419 return 0; 14420 14421 nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT); 14422 if (!nd) 14423 return -ENOBUFS; 14424 14425 if (req->n_scan_plans == 1 && 14426 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL, 14427 req->scan_plans[0].interval * 1000)) 14428 return -ENOBUFS; 14429 14430 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay)) 14431 return -ENOBUFS; 14432 14433 if (req->relative_rssi_set) { 14434 struct nl80211_bss_select_rssi_adjust rssi_adjust; 14435 14436 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI, 14437 req->relative_rssi)) 14438 return -ENOBUFS; 14439 14440 rssi_adjust.band = req->rssi_adjust.band; 14441 rssi_adjust.delta = req->rssi_adjust.delta; 14442 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST, 14443 sizeof(rssi_adjust), &rssi_adjust)) 14444 return -ENOBUFS; 14445 } 14446 14447 freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 14448 if (!freqs) 14449 return -ENOBUFS; 14450 14451 for (i = 0; i < req->n_channels; i++) { 14452 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 14453 return -ENOBUFS; 14454 } 14455 14456 nla_nest_end(msg, freqs); 14457 14458 if (req->n_match_sets) { 14459 matches = nla_nest_start_noflag(msg, 14460 NL80211_ATTR_SCHED_SCAN_MATCH); 14461 if (!matches) 14462 return -ENOBUFS; 14463 14464 for (i = 0; i < req->n_match_sets; i++) { 14465 match = nla_nest_start_noflag(msg, i); 14466 if (!match) 14467 return -ENOBUFS; 14468 14469 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID, 14470 req->match_sets[i].ssid.ssid_len, 14471 req->match_sets[i].ssid.ssid)) 14472 return -ENOBUFS; 14473 nla_nest_end(msg, match); 14474 } 14475 nla_nest_end(msg, matches); 14476 } 14477 14478 scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS); 14479 if (!scan_plans) 14480 return -ENOBUFS; 14481 14482 for (i = 0; i < req->n_scan_plans; i++) { 14483 scan_plan = nla_nest_start_noflag(msg, i + 1); 14484 if (!scan_plan) 14485 return -ENOBUFS; 14486 14487 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL, 14488 req->scan_plans[i].interval) || 14489 (req->scan_plans[i].iterations && 14490 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS, 14491 req->scan_plans[i].iterations))) 14492 return -ENOBUFS; 14493 nla_nest_end(msg, scan_plan); 14494 } 14495 nla_nest_end(msg, scan_plans); 14496 14497 nla_nest_end(msg, nd); 14498 14499 return 0; 14500 } 14501 14502 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info) 14503 { 14504 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14505 struct sk_buff *msg; 14506 void *hdr; 14507 u32 size = NLMSG_DEFAULT_SIZE; 14508 14509 if (!rdev->wiphy.wowlan) 14510 return -EOPNOTSUPP; 14511 14512 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) { 14513 /* adjust size to have room for all the data */ 14514 size += rdev->wiphy.wowlan_config->tcp->tokens_size + 14515 rdev->wiphy.wowlan_config->tcp->payload_len + 14516 rdev->wiphy.wowlan_config->tcp->wake_len + 14517 rdev->wiphy.wowlan_config->tcp->wake_len / 8; 14518 } 14519 14520 msg = nlmsg_new(size, GFP_KERNEL); 14521 if (!msg) 14522 return -ENOMEM; 14523 14524 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14525 NL80211_CMD_GET_WOWLAN); 14526 if (!hdr) 14527 goto nla_put_failure; 14528 14529 if (rdev->wiphy.wowlan_config) { 14530 struct nlattr *nl_wowlan; 14531 14532 nl_wowlan = nla_nest_start_noflag(msg, 14533 NL80211_ATTR_WOWLAN_TRIGGERS); 14534 if (!nl_wowlan) 14535 goto nla_put_failure; 14536 14537 if ((rdev->wiphy.wowlan_config->any && 14538 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 14539 (rdev->wiphy.wowlan_config->disconnect && 14540 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 14541 (rdev->wiphy.wowlan_config->magic_pkt && 14542 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 14543 (rdev->wiphy.wowlan_config->gtk_rekey_failure && 14544 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 14545 (rdev->wiphy.wowlan_config->eap_identity_req && 14546 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 14547 (rdev->wiphy.wowlan_config->four_way_handshake && 14548 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 14549 (rdev->wiphy.wowlan_config->rfkill_release && 14550 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 14551 goto nla_put_failure; 14552 14553 if (nl80211_send_wowlan_patterns(msg, rdev)) 14554 goto nla_put_failure; 14555 14556 if (nl80211_send_wowlan_tcp(msg, 14557 rdev->wiphy.wowlan_config->tcp)) 14558 goto nla_put_failure; 14559 14560 if (nl80211_send_wowlan_nd( 14561 msg, 14562 rdev->wiphy.wowlan_config->nd_config)) 14563 goto nla_put_failure; 14564 14565 nla_nest_end(msg, nl_wowlan); 14566 } 14567 14568 genlmsg_end(msg, hdr); 14569 return genlmsg_reply(msg, info); 14570 14571 nla_put_failure: 14572 nlmsg_free(msg); 14573 return -ENOBUFS; 14574 } 14575 14576 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev, 14577 struct nlattr *attr, 14578 struct cfg80211_wowlan *trig) 14579 { 14580 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP]; 14581 struct cfg80211_wowlan_tcp *cfg; 14582 struct nl80211_wowlan_tcp_data_token *tok = NULL; 14583 struct nl80211_wowlan_tcp_data_seq *seq = NULL; 14584 u32 size; 14585 u32 data_size, wake_size, tokens_size = 0, wake_mask_size; 14586 int err, port; 14587 14588 if (!rdev->wiphy.wowlan->tcp) 14589 return -EINVAL; 14590 14591 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr, 14592 nl80211_wowlan_tcp_policy, NULL); 14593 if (err) 14594 return err; 14595 14596 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] || 14597 !tb[NL80211_WOWLAN_TCP_DST_IPV4] || 14598 !tb[NL80211_WOWLAN_TCP_DST_MAC] || 14599 !tb[NL80211_WOWLAN_TCP_DST_PORT] || 14600 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] || 14601 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] || 14602 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] || 14603 !tb[NL80211_WOWLAN_TCP_WAKE_MASK]) 14604 return -EINVAL; 14605 14606 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]); 14607 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max) 14608 return -EINVAL; 14609 14610 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) > 14611 rdev->wiphy.wowlan->tcp->data_interval_max || 14612 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0) 14613 return -EINVAL; 14614 14615 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]); 14616 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max) 14617 return -EINVAL; 14618 14619 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]); 14620 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8)) 14621 return -EINVAL; 14622 14623 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) { 14624 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 14625 14626 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 14627 tokens_size = tokln - sizeof(*tok); 14628 14629 if (!tok->len || tokens_size % tok->len) 14630 return -EINVAL; 14631 if (!rdev->wiphy.wowlan->tcp->tok) 14632 return -EINVAL; 14633 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len) 14634 return -EINVAL; 14635 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len) 14636 return -EINVAL; 14637 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize) 14638 return -EINVAL; 14639 if (tok->offset + tok->len > data_size) 14640 return -EINVAL; 14641 } 14642 14643 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) { 14644 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]); 14645 if (!rdev->wiphy.wowlan->tcp->seq) 14646 return -EINVAL; 14647 if (seq->len == 0 || seq->len > 4) 14648 return -EINVAL; 14649 if (seq->len + seq->offset > data_size) 14650 return -EINVAL; 14651 } 14652 14653 size = sizeof(*cfg); 14654 size += data_size; 14655 size += wake_size + wake_mask_size; 14656 size += tokens_size; 14657 14658 cfg = kzalloc(size, GFP_KERNEL); 14659 if (!cfg) 14660 return -ENOMEM; 14661 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]); 14662 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]); 14663 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]), 14664 ETH_ALEN); 14665 port = nla_get_u16_default(tb[NL80211_WOWLAN_TCP_SRC_PORT], 0); 14666 #ifdef CONFIG_INET 14667 /* allocate a socket and port for it and use it */ 14668 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM, 14669 IPPROTO_TCP, &cfg->sock, 1); 14670 if (err) { 14671 kfree(cfg); 14672 return err; 14673 } 14674 if (inet_csk_get_port(cfg->sock->sk, port)) { 14675 sock_release(cfg->sock); 14676 kfree(cfg); 14677 return -EADDRINUSE; 14678 } 14679 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num; 14680 #else 14681 if (!port) { 14682 kfree(cfg); 14683 return -EINVAL; 14684 } 14685 cfg->src_port = port; 14686 #endif 14687 14688 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]); 14689 cfg->payload_len = data_size; 14690 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size; 14691 memcpy((void *)cfg->payload, 14692 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]), 14693 data_size); 14694 if (seq) 14695 cfg->payload_seq = *seq; 14696 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]); 14697 cfg->wake_len = wake_size; 14698 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size; 14699 memcpy((void *)cfg->wake_data, 14700 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]), 14701 wake_size); 14702 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size + 14703 data_size + wake_size; 14704 memcpy((void *)cfg->wake_mask, 14705 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]), 14706 wake_mask_size); 14707 if (tok) { 14708 cfg->tokens_size = tokens_size; 14709 cfg->payload_tok = *tok; 14710 memcpy(cfg->payload_tok.token_stream, tok->token_stream, 14711 tokens_size); 14712 } 14713 14714 trig->tcp = cfg; 14715 14716 return 0; 14717 } 14718 14719 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev, 14720 const struct wiphy_wowlan_support *wowlan, 14721 struct nlattr *attr, 14722 struct cfg80211_wowlan *trig) 14723 { 14724 struct nlattr **tb; 14725 int err; 14726 14727 tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 14728 if (!tb) 14729 return -ENOMEM; 14730 14731 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) { 14732 err = -EOPNOTSUPP; 14733 goto out; 14734 } 14735 14736 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr, 14737 nl80211_policy, NULL); 14738 if (err) 14739 goto out; 14740 14741 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb, 14742 wowlan->max_nd_match_sets); 14743 err = PTR_ERR_OR_ZERO(trig->nd_config); 14744 if (err) 14745 trig->nd_config = NULL; 14746 14747 out: 14748 kfree(tb); 14749 return err; 14750 } 14751 14752 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info) 14753 { 14754 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14755 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG]; 14756 struct cfg80211_wowlan new_triggers = {}; 14757 struct cfg80211_wowlan *ntrig; 14758 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan; 14759 int err, i; 14760 bool prev_enabled = rdev->wiphy.wowlan_config; 14761 bool regular = false; 14762 14763 if (!wowlan) 14764 return -EOPNOTSUPP; 14765 14766 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) { 14767 cfg80211_rdev_free_wowlan(rdev); 14768 rdev->wiphy.wowlan_config = NULL; 14769 goto set_wakeup; 14770 } 14771 14772 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG, 14773 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS], 14774 nl80211_wowlan_policy, info->extack); 14775 if (err) 14776 return err; 14777 14778 if (tb[NL80211_WOWLAN_TRIG_ANY]) { 14779 if (!(wowlan->flags & WIPHY_WOWLAN_ANY)) 14780 return -EINVAL; 14781 new_triggers.any = true; 14782 } 14783 14784 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) { 14785 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT)) 14786 return -EINVAL; 14787 new_triggers.disconnect = true; 14788 regular = true; 14789 } 14790 14791 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) { 14792 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT)) 14793 return -EINVAL; 14794 new_triggers.magic_pkt = true; 14795 regular = true; 14796 } 14797 14798 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED]) 14799 return -EINVAL; 14800 14801 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) { 14802 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE)) 14803 return -EINVAL; 14804 new_triggers.gtk_rekey_failure = true; 14805 regular = true; 14806 } 14807 14808 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) { 14809 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ)) 14810 return -EINVAL; 14811 new_triggers.eap_identity_req = true; 14812 regular = true; 14813 } 14814 14815 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) { 14816 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE)) 14817 return -EINVAL; 14818 new_triggers.four_way_handshake = true; 14819 regular = true; 14820 } 14821 14822 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) { 14823 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE)) 14824 return -EINVAL; 14825 new_triggers.rfkill_release = true; 14826 regular = true; 14827 } 14828 14829 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) { 14830 struct nlattr *pat; 14831 int n_patterns = 0; 14832 int rem, pat_len, mask_len, pkt_offset; 14833 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 14834 14835 regular = true; 14836 14837 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 14838 rem) 14839 n_patterns++; 14840 if (n_patterns > wowlan->n_patterns) 14841 return -EINVAL; 14842 14843 new_triggers.patterns = kcalloc(n_patterns, 14844 sizeof(new_triggers.patterns[0]), 14845 GFP_KERNEL); 14846 if (!new_triggers.patterns) 14847 return -ENOMEM; 14848 14849 new_triggers.n_patterns = n_patterns; 14850 i = 0; 14851 14852 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 14853 rem) { 14854 u8 *mask_pat; 14855 14856 err = nla_parse_nested_deprecated(pat_tb, 14857 MAX_NL80211_PKTPAT, 14858 pat, 14859 nl80211_packet_pattern_policy, 14860 info->extack); 14861 if (err) 14862 goto error; 14863 14864 err = -EINVAL; 14865 if (!pat_tb[NL80211_PKTPAT_MASK] || 14866 !pat_tb[NL80211_PKTPAT_PATTERN]) 14867 goto error; 14868 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 14869 mask_len = DIV_ROUND_UP(pat_len, 8); 14870 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 14871 goto error; 14872 if (pat_len > wowlan->pattern_max_len || 14873 pat_len < wowlan->pattern_min_len) 14874 goto error; 14875 14876 pkt_offset = 14877 nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET], 14878 0); 14879 if (pkt_offset > wowlan->max_pkt_offset) 14880 goto error; 14881 new_triggers.patterns[i].pkt_offset = pkt_offset; 14882 14883 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 14884 if (!mask_pat) { 14885 err = -ENOMEM; 14886 goto error; 14887 } 14888 new_triggers.patterns[i].mask = mask_pat; 14889 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 14890 mask_len); 14891 mask_pat += mask_len; 14892 new_triggers.patterns[i].pattern = mask_pat; 14893 new_triggers.patterns[i].pattern_len = pat_len; 14894 memcpy(mask_pat, 14895 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 14896 pat_len); 14897 i++; 14898 } 14899 } 14900 14901 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) { 14902 regular = true; 14903 err = nl80211_parse_wowlan_tcp( 14904 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION], 14905 &new_triggers); 14906 if (err) 14907 goto error; 14908 } 14909 14910 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) { 14911 regular = true; 14912 err = nl80211_parse_wowlan_nd( 14913 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT], 14914 &new_triggers); 14915 if (err) 14916 goto error; 14917 } 14918 14919 /* The 'any' trigger means the device continues operating more or less 14920 * as in its normal operation mode and wakes up the host on most of the 14921 * normal interrupts (like packet RX, ...) 14922 * It therefore makes little sense to combine with the more constrained 14923 * wakeup trigger modes. 14924 */ 14925 if (new_triggers.any && regular) { 14926 err = -EINVAL; 14927 goto error; 14928 } 14929 14930 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL); 14931 if (!ntrig) { 14932 err = -ENOMEM; 14933 goto error; 14934 } 14935 cfg80211_rdev_free_wowlan(rdev); 14936 rdev->wiphy.wowlan_config = ntrig; 14937 14938 set_wakeup: 14939 if (rdev->ops->set_wakeup && 14940 prev_enabled != !!rdev->wiphy.wowlan_config) 14941 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config); 14942 14943 return 0; 14944 error: 14945 for (i = 0; i < new_triggers.n_patterns; i++) 14946 kfree(new_triggers.patterns[i].mask); 14947 kfree(new_triggers.patterns); 14948 if (new_triggers.tcp && new_triggers.tcp->sock) 14949 sock_release(new_triggers.tcp->sock); 14950 kfree(new_triggers.tcp); 14951 kfree(new_triggers.nd_config); 14952 return err; 14953 } 14954 #endif 14955 14956 static int nl80211_send_coalesce_rules(struct sk_buff *msg, 14957 struct cfg80211_registered_device *rdev) 14958 { 14959 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules; 14960 int i, j, pat_len; 14961 struct cfg80211_coalesce_rules *rule; 14962 14963 if (!rdev->coalesce->n_rules) 14964 return 0; 14965 14966 nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE); 14967 if (!nl_rules) 14968 return -ENOBUFS; 14969 14970 for (i = 0; i < rdev->coalesce->n_rules; i++) { 14971 nl_rule = nla_nest_start_noflag(msg, i + 1); 14972 if (!nl_rule) 14973 return -ENOBUFS; 14974 14975 rule = &rdev->coalesce->rules[i]; 14976 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY, 14977 rule->delay)) 14978 return -ENOBUFS; 14979 14980 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION, 14981 rule->condition)) 14982 return -ENOBUFS; 14983 14984 nl_pats = nla_nest_start_noflag(msg, 14985 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN); 14986 if (!nl_pats) 14987 return -ENOBUFS; 14988 14989 for (j = 0; j < rule->n_patterns; j++) { 14990 nl_pat = nla_nest_start_noflag(msg, j + 1); 14991 if (!nl_pat) 14992 return -ENOBUFS; 14993 pat_len = rule->patterns[j].pattern_len; 14994 if (nla_put(msg, NL80211_PKTPAT_MASK, 14995 DIV_ROUND_UP(pat_len, 8), 14996 rule->patterns[j].mask) || 14997 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 14998 rule->patterns[j].pattern) || 14999 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 15000 rule->patterns[j].pkt_offset)) 15001 return -ENOBUFS; 15002 nla_nest_end(msg, nl_pat); 15003 } 15004 nla_nest_end(msg, nl_pats); 15005 nla_nest_end(msg, nl_rule); 15006 } 15007 nla_nest_end(msg, nl_rules); 15008 15009 return 0; 15010 } 15011 15012 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info) 15013 { 15014 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15015 struct sk_buff *msg; 15016 void *hdr; 15017 15018 if (!rdev->wiphy.coalesce) 15019 return -EOPNOTSUPP; 15020 15021 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15022 if (!msg) 15023 return -ENOMEM; 15024 15025 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15026 NL80211_CMD_GET_COALESCE); 15027 if (!hdr) 15028 goto nla_put_failure; 15029 15030 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev)) 15031 goto nla_put_failure; 15032 15033 genlmsg_end(msg, hdr); 15034 return genlmsg_reply(msg, info); 15035 15036 nla_put_failure: 15037 nlmsg_free(msg); 15038 return -ENOBUFS; 15039 } 15040 15041 void cfg80211_free_coalesce(struct cfg80211_coalesce *coalesce) 15042 { 15043 int i, j; 15044 struct cfg80211_coalesce_rules *rule; 15045 15046 if (!coalesce) 15047 return; 15048 15049 for (i = 0; i < coalesce->n_rules; i++) { 15050 rule = &coalesce->rules[i]; 15051 for (j = 0; j < rule->n_patterns; j++) 15052 kfree(rule->patterns[j].mask); 15053 kfree(rule->patterns); 15054 } 15055 kfree(coalesce); 15056 } 15057 15058 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev, 15059 struct nlattr *rule, 15060 struct cfg80211_coalesce_rules *new_rule) 15061 { 15062 int err, i; 15063 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 15064 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat; 15065 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0; 15066 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 15067 15068 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX, 15069 rule, nl80211_coalesce_policy, NULL); 15070 if (err) 15071 return err; 15072 15073 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY]) 15074 new_rule->delay = 15075 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]); 15076 if (new_rule->delay > coalesce->max_delay) 15077 return -EINVAL; 15078 15079 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION]) 15080 new_rule->condition = 15081 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]); 15082 15083 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN]) 15084 return -EINVAL; 15085 15086 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 15087 rem) 15088 n_patterns++; 15089 if (n_patterns > coalesce->n_patterns) 15090 return -EINVAL; 15091 15092 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]), 15093 GFP_KERNEL); 15094 if (!new_rule->patterns) 15095 return -ENOMEM; 15096 15097 new_rule->n_patterns = n_patterns; 15098 i = 0; 15099 15100 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 15101 rem) { 15102 u8 *mask_pat; 15103 15104 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT, 15105 pat, 15106 nl80211_packet_pattern_policy, 15107 NULL); 15108 if (err) 15109 return err; 15110 15111 if (!pat_tb[NL80211_PKTPAT_MASK] || 15112 !pat_tb[NL80211_PKTPAT_PATTERN]) 15113 return -EINVAL; 15114 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 15115 mask_len = DIV_ROUND_UP(pat_len, 8); 15116 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 15117 return -EINVAL; 15118 if (pat_len > coalesce->pattern_max_len || 15119 pat_len < coalesce->pattern_min_len) 15120 return -EINVAL; 15121 15122 pkt_offset = nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET], 15123 0); 15124 if (pkt_offset > coalesce->max_pkt_offset) 15125 return -EINVAL; 15126 new_rule->patterns[i].pkt_offset = pkt_offset; 15127 15128 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 15129 if (!mask_pat) 15130 return -ENOMEM; 15131 15132 new_rule->patterns[i].mask = mask_pat; 15133 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 15134 mask_len); 15135 15136 mask_pat += mask_len; 15137 new_rule->patterns[i].pattern = mask_pat; 15138 new_rule->patterns[i].pattern_len = pat_len; 15139 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 15140 pat_len); 15141 i++; 15142 } 15143 15144 return 0; 15145 } 15146 15147 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info) 15148 { 15149 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15150 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 15151 struct cfg80211_coalesce *new_coalesce; 15152 int err, rem_rule, n_rules = 0, i; 15153 struct nlattr *rule; 15154 15155 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce) 15156 return -EOPNOTSUPP; 15157 15158 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) { 15159 cfg80211_free_coalesce(rdev->coalesce); 15160 rdev->coalesce = NULL; 15161 rdev_set_coalesce(rdev, NULL); 15162 return 0; 15163 } 15164 15165 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 15166 rem_rule) 15167 n_rules++; 15168 if (n_rules > coalesce->n_rules) 15169 return -EINVAL; 15170 15171 new_coalesce = kzalloc(struct_size(new_coalesce, rules, n_rules), 15172 GFP_KERNEL); 15173 if (!new_coalesce) 15174 return -ENOMEM; 15175 15176 new_coalesce->n_rules = n_rules; 15177 i = 0; 15178 15179 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 15180 rem_rule) { 15181 err = nl80211_parse_coalesce_rule(rdev, rule, 15182 &new_coalesce->rules[i]); 15183 if (err) 15184 goto error; 15185 15186 i++; 15187 } 15188 15189 err = rdev_set_coalesce(rdev, new_coalesce); 15190 if (err) 15191 goto error; 15192 15193 cfg80211_free_coalesce(rdev->coalesce); 15194 rdev->coalesce = new_coalesce; 15195 15196 return 0; 15197 error: 15198 cfg80211_free_coalesce(new_coalesce); 15199 15200 return err; 15201 } 15202 15203 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info) 15204 { 15205 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15206 struct net_device *dev = info->user_ptr[1]; 15207 struct wireless_dev *wdev = dev->ieee80211_ptr; 15208 struct nlattr *tb[NUM_NL80211_REKEY_DATA]; 15209 struct cfg80211_gtk_rekey_data rekey_data = {}; 15210 int err; 15211 15212 if (!info->attrs[NL80211_ATTR_REKEY_DATA]) 15213 return -EINVAL; 15214 15215 err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA, 15216 info->attrs[NL80211_ATTR_REKEY_DATA], 15217 nl80211_rekey_policy, info->extack); 15218 if (err) 15219 return err; 15220 15221 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] || 15222 !tb[NL80211_REKEY_DATA_KCK]) 15223 return -EINVAL; 15224 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN && 15225 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 15226 nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN)) 15227 return -ERANGE; 15228 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN && 15229 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 15230 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) && 15231 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 && 15232 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32)) 15233 return -ERANGE; 15234 15235 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]); 15236 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]); 15237 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]); 15238 rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]); 15239 rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]); 15240 if (tb[NL80211_REKEY_DATA_AKM]) 15241 rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]); 15242 15243 if (!wdev->connected) 15244 return -ENOTCONN; 15245 15246 if (!rdev->ops->set_rekey_data) 15247 return -EOPNOTSUPP; 15248 15249 return rdev_set_rekey_data(rdev, dev, &rekey_data); 15250 } 15251 15252 static int nl80211_register_unexpected_frame(struct sk_buff *skb, 15253 struct genl_info *info) 15254 { 15255 struct net_device *dev = info->user_ptr[1]; 15256 struct wireless_dev *wdev = dev->ieee80211_ptr; 15257 15258 if (wdev->iftype != NL80211_IFTYPE_AP && 15259 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15260 return -EINVAL; 15261 15262 if (wdev->ap_unexpected_nlportid) 15263 return -EBUSY; 15264 15265 wdev->ap_unexpected_nlportid = info->snd_portid; 15266 return 0; 15267 } 15268 15269 static int nl80211_probe_client(struct sk_buff *skb, 15270 struct genl_info *info) 15271 { 15272 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15273 struct net_device *dev = info->user_ptr[1]; 15274 struct wireless_dev *wdev = dev->ieee80211_ptr; 15275 struct sk_buff *msg; 15276 void *hdr; 15277 const u8 *addr; 15278 u64 cookie; 15279 int err; 15280 15281 if (wdev->iftype != NL80211_IFTYPE_AP && 15282 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15283 return -EOPNOTSUPP; 15284 15285 if (!info->attrs[NL80211_ATTR_MAC]) 15286 return -EINVAL; 15287 15288 if (!rdev->ops->probe_client) 15289 return -EOPNOTSUPP; 15290 15291 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15292 if (!msg) 15293 return -ENOMEM; 15294 15295 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15296 NL80211_CMD_PROBE_CLIENT); 15297 if (!hdr) { 15298 err = -ENOBUFS; 15299 goto free_msg; 15300 } 15301 15302 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15303 15304 err = rdev_probe_client(rdev, dev, addr, &cookie); 15305 if (err) 15306 goto free_msg; 15307 15308 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 15309 NL80211_ATTR_PAD)) 15310 goto nla_put_failure; 15311 15312 genlmsg_end(msg, hdr); 15313 15314 return genlmsg_reply(msg, info); 15315 15316 nla_put_failure: 15317 err = -ENOBUFS; 15318 free_msg: 15319 nlmsg_free(msg); 15320 return err; 15321 } 15322 15323 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info) 15324 { 15325 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15326 struct cfg80211_beacon_registration *reg, *nreg; 15327 int rv; 15328 15329 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS)) 15330 return -EOPNOTSUPP; 15331 15332 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL); 15333 if (!nreg) 15334 return -ENOMEM; 15335 15336 /* First, check if already registered. */ 15337 spin_lock_bh(&rdev->beacon_registrations_lock); 15338 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 15339 if (reg->nlportid == info->snd_portid) { 15340 rv = -EALREADY; 15341 goto out_err; 15342 } 15343 } 15344 /* Add it to the list */ 15345 nreg->nlportid = info->snd_portid; 15346 list_add(&nreg->list, &rdev->beacon_registrations); 15347 15348 spin_unlock_bh(&rdev->beacon_registrations_lock); 15349 15350 return 0; 15351 out_err: 15352 spin_unlock_bh(&rdev->beacon_registrations_lock); 15353 kfree(nreg); 15354 return rv; 15355 } 15356 15357 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info) 15358 { 15359 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15360 struct wireless_dev *wdev = info->user_ptr[1]; 15361 int err; 15362 15363 if (!rdev->ops->start_p2p_device) 15364 return -EOPNOTSUPP; 15365 15366 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 15367 return -EOPNOTSUPP; 15368 15369 if (wdev_running(wdev)) 15370 return 0; 15371 15372 if (rfkill_blocked(rdev->wiphy.rfkill)) 15373 return -ERFKILL; 15374 15375 err = rdev_start_p2p_device(rdev, wdev); 15376 if (err) 15377 return err; 15378 15379 wdev->is_running = true; 15380 rdev->opencount++; 15381 15382 return 0; 15383 } 15384 15385 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info) 15386 { 15387 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15388 struct wireless_dev *wdev = info->user_ptr[1]; 15389 15390 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 15391 return -EOPNOTSUPP; 15392 15393 if (!rdev->ops->stop_p2p_device) 15394 return -EOPNOTSUPP; 15395 15396 cfg80211_stop_p2p_device(rdev, wdev); 15397 15398 return 0; 15399 } 15400 15401 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info) 15402 { 15403 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15404 struct wireless_dev *wdev = info->user_ptr[1]; 15405 struct cfg80211_nan_conf conf = {}; 15406 int err; 15407 15408 if (wdev->iftype != NL80211_IFTYPE_NAN) 15409 return -EOPNOTSUPP; 15410 15411 if (wdev_running(wdev)) 15412 return -EEXIST; 15413 15414 if (rfkill_blocked(rdev->wiphy.rfkill)) 15415 return -ERFKILL; 15416 15417 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) 15418 return -EINVAL; 15419 15420 conf.master_pref = 15421 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 15422 15423 if (info->attrs[NL80211_ATTR_BANDS]) { 15424 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 15425 15426 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 15427 return -EOPNOTSUPP; 15428 15429 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 15430 return -EINVAL; 15431 15432 conf.bands = bands; 15433 } 15434 15435 err = rdev_start_nan(rdev, wdev, &conf); 15436 if (err) 15437 return err; 15438 15439 wdev->is_running = true; 15440 rdev->opencount++; 15441 15442 return 0; 15443 } 15444 15445 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info) 15446 { 15447 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15448 struct wireless_dev *wdev = info->user_ptr[1]; 15449 15450 if (wdev->iftype != NL80211_IFTYPE_NAN) 15451 return -EOPNOTSUPP; 15452 15453 cfg80211_stop_nan(rdev, wdev); 15454 15455 return 0; 15456 } 15457 15458 static int validate_nan_filter(struct nlattr *filter_attr) 15459 { 15460 struct nlattr *attr; 15461 int len = 0, n_entries = 0, rem; 15462 15463 nla_for_each_nested(attr, filter_attr, rem) { 15464 len += nla_len(attr); 15465 n_entries++; 15466 } 15467 15468 if (len >= U8_MAX) 15469 return -EINVAL; 15470 15471 return n_entries; 15472 } 15473 15474 static int handle_nan_filter(struct nlattr *attr_filter, 15475 struct cfg80211_nan_func *func, 15476 bool tx) 15477 { 15478 struct nlattr *attr; 15479 int n_entries, rem, i; 15480 struct cfg80211_nan_func_filter *filter; 15481 15482 n_entries = validate_nan_filter(attr_filter); 15483 if (n_entries < 0) 15484 return n_entries; 15485 15486 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters)); 15487 15488 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL); 15489 if (!filter) 15490 return -ENOMEM; 15491 15492 i = 0; 15493 nla_for_each_nested(attr, attr_filter, rem) { 15494 filter[i].filter = nla_memdup(attr, GFP_KERNEL); 15495 if (!filter[i].filter) 15496 goto err; 15497 15498 filter[i].len = nla_len(attr); 15499 i++; 15500 } 15501 if (tx) { 15502 func->num_tx_filters = n_entries; 15503 func->tx_filters = filter; 15504 } else { 15505 func->num_rx_filters = n_entries; 15506 func->rx_filters = filter; 15507 } 15508 15509 return 0; 15510 15511 err: 15512 i = 0; 15513 nla_for_each_nested(attr, attr_filter, rem) { 15514 kfree(filter[i].filter); 15515 i++; 15516 } 15517 kfree(filter); 15518 return -ENOMEM; 15519 } 15520 15521 static int nl80211_nan_add_func(struct sk_buff *skb, 15522 struct genl_info *info) 15523 { 15524 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15525 struct wireless_dev *wdev = info->user_ptr[1]; 15526 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr; 15527 struct cfg80211_nan_func *func; 15528 struct sk_buff *msg = NULL; 15529 void *hdr = NULL; 15530 int err = 0; 15531 15532 if (wdev->iftype != NL80211_IFTYPE_NAN) 15533 return -EOPNOTSUPP; 15534 15535 if (!wdev_running(wdev)) 15536 return -ENOTCONN; 15537 15538 if (!info->attrs[NL80211_ATTR_NAN_FUNC]) 15539 return -EINVAL; 15540 15541 err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX, 15542 info->attrs[NL80211_ATTR_NAN_FUNC], 15543 nl80211_nan_func_policy, 15544 info->extack); 15545 if (err) 15546 return err; 15547 15548 func = kzalloc(sizeof(*func), GFP_KERNEL); 15549 if (!func) 15550 return -ENOMEM; 15551 15552 func->cookie = cfg80211_assign_cookie(rdev); 15553 15554 if (!tb[NL80211_NAN_FUNC_TYPE]) { 15555 err = -EINVAL; 15556 goto out; 15557 } 15558 15559 15560 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]); 15561 15562 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) { 15563 err = -EINVAL; 15564 goto out; 15565 } 15566 15567 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]), 15568 sizeof(func->service_id)); 15569 15570 func->close_range = 15571 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]); 15572 15573 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) { 15574 func->serv_spec_info_len = 15575 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]); 15576 func->serv_spec_info = 15577 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]), 15578 func->serv_spec_info_len, 15579 GFP_KERNEL); 15580 if (!func->serv_spec_info) { 15581 err = -ENOMEM; 15582 goto out; 15583 } 15584 } 15585 15586 if (tb[NL80211_NAN_FUNC_TTL]) 15587 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]); 15588 15589 switch (func->type) { 15590 case NL80211_NAN_FUNC_PUBLISH: 15591 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) { 15592 err = -EINVAL; 15593 goto out; 15594 } 15595 15596 func->publish_type = 15597 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]); 15598 func->publish_bcast = 15599 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]); 15600 15601 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) && 15602 func->publish_bcast) { 15603 err = -EINVAL; 15604 goto out; 15605 } 15606 break; 15607 case NL80211_NAN_FUNC_SUBSCRIBE: 15608 func->subscribe_active = 15609 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]); 15610 break; 15611 case NL80211_NAN_FUNC_FOLLOW_UP: 15612 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] || 15613 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] || 15614 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) { 15615 err = -EINVAL; 15616 goto out; 15617 } 15618 15619 func->followup_id = 15620 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]); 15621 func->followup_reqid = 15622 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]); 15623 memcpy(func->followup_dest.addr, 15624 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]), 15625 sizeof(func->followup_dest.addr)); 15626 if (func->ttl) { 15627 err = -EINVAL; 15628 goto out; 15629 } 15630 break; 15631 default: 15632 err = -EINVAL; 15633 goto out; 15634 } 15635 15636 if (tb[NL80211_NAN_FUNC_SRF]) { 15637 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR]; 15638 15639 err = nla_parse_nested_deprecated(srf_tb, 15640 NL80211_NAN_SRF_ATTR_MAX, 15641 tb[NL80211_NAN_FUNC_SRF], 15642 nl80211_nan_srf_policy, 15643 info->extack); 15644 if (err) 15645 goto out; 15646 15647 func->srf_include = 15648 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]); 15649 15650 if (srf_tb[NL80211_NAN_SRF_BF]) { 15651 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] || 15652 !srf_tb[NL80211_NAN_SRF_BF_IDX]) { 15653 err = -EINVAL; 15654 goto out; 15655 } 15656 15657 func->srf_bf_len = 15658 nla_len(srf_tb[NL80211_NAN_SRF_BF]); 15659 func->srf_bf = 15660 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]), 15661 func->srf_bf_len, GFP_KERNEL); 15662 if (!func->srf_bf) { 15663 err = -ENOMEM; 15664 goto out; 15665 } 15666 15667 func->srf_bf_idx = 15668 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]); 15669 } else { 15670 struct nlattr *attr, *mac_attr = 15671 srf_tb[NL80211_NAN_SRF_MAC_ADDRS]; 15672 int n_entries, rem, i = 0; 15673 15674 if (!mac_attr) { 15675 err = -EINVAL; 15676 goto out; 15677 } 15678 15679 n_entries = validate_acl_mac_addrs(mac_attr); 15680 if (n_entries <= 0) { 15681 err = -EINVAL; 15682 goto out; 15683 } 15684 15685 func->srf_num_macs = n_entries; 15686 func->srf_macs = 15687 kcalloc(n_entries, sizeof(*func->srf_macs), 15688 GFP_KERNEL); 15689 if (!func->srf_macs) { 15690 err = -ENOMEM; 15691 goto out; 15692 } 15693 15694 nla_for_each_nested(attr, mac_attr, rem) 15695 memcpy(func->srf_macs[i++].addr, nla_data(attr), 15696 sizeof(*func->srf_macs)); 15697 } 15698 } 15699 15700 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) { 15701 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER], 15702 func, true); 15703 if (err) 15704 goto out; 15705 } 15706 15707 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) { 15708 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER], 15709 func, false); 15710 if (err) 15711 goto out; 15712 } 15713 15714 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15715 if (!msg) { 15716 err = -ENOMEM; 15717 goto out; 15718 } 15719 15720 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15721 NL80211_CMD_ADD_NAN_FUNCTION); 15722 /* This can't really happen - we just allocated 4KB */ 15723 if (WARN_ON(!hdr)) { 15724 err = -ENOMEM; 15725 goto out; 15726 } 15727 15728 err = rdev_add_nan_func(rdev, wdev, func); 15729 out: 15730 if (err < 0) { 15731 cfg80211_free_nan_func(func); 15732 nlmsg_free(msg); 15733 return err; 15734 } 15735 15736 /* propagate the instance id and cookie to userspace */ 15737 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie, 15738 NL80211_ATTR_PAD)) 15739 goto nla_put_failure; 15740 15741 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 15742 if (!func_attr) 15743 goto nla_put_failure; 15744 15745 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, 15746 func->instance_id)) 15747 goto nla_put_failure; 15748 15749 nla_nest_end(msg, func_attr); 15750 15751 genlmsg_end(msg, hdr); 15752 return genlmsg_reply(msg, info); 15753 15754 nla_put_failure: 15755 nlmsg_free(msg); 15756 return -ENOBUFS; 15757 } 15758 15759 static int nl80211_nan_del_func(struct sk_buff *skb, 15760 struct genl_info *info) 15761 { 15762 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15763 struct wireless_dev *wdev = info->user_ptr[1]; 15764 u64 cookie; 15765 15766 if (wdev->iftype != NL80211_IFTYPE_NAN) 15767 return -EOPNOTSUPP; 15768 15769 if (!wdev_running(wdev)) 15770 return -ENOTCONN; 15771 15772 if (!info->attrs[NL80211_ATTR_COOKIE]) 15773 return -EINVAL; 15774 15775 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 15776 15777 rdev_del_nan_func(rdev, wdev, cookie); 15778 15779 return 0; 15780 } 15781 15782 static int nl80211_nan_change_config(struct sk_buff *skb, 15783 struct genl_info *info) 15784 { 15785 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15786 struct wireless_dev *wdev = info->user_ptr[1]; 15787 struct cfg80211_nan_conf conf = {}; 15788 u32 changed = 0; 15789 15790 if (wdev->iftype != NL80211_IFTYPE_NAN) 15791 return -EOPNOTSUPP; 15792 15793 if (!wdev_running(wdev)) 15794 return -ENOTCONN; 15795 15796 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) { 15797 conf.master_pref = 15798 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 15799 if (conf.master_pref <= 1 || conf.master_pref == 255) 15800 return -EINVAL; 15801 15802 changed |= CFG80211_NAN_CONF_CHANGED_PREF; 15803 } 15804 15805 if (info->attrs[NL80211_ATTR_BANDS]) { 15806 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 15807 15808 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 15809 return -EOPNOTSUPP; 15810 15811 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 15812 return -EINVAL; 15813 15814 conf.bands = bands; 15815 changed |= CFG80211_NAN_CONF_CHANGED_BANDS; 15816 } 15817 15818 if (!changed) 15819 return -EINVAL; 15820 15821 return rdev_nan_change_conf(rdev, wdev, &conf, changed); 15822 } 15823 15824 void cfg80211_nan_match(struct wireless_dev *wdev, 15825 struct cfg80211_nan_match_params *match, gfp_t gfp) 15826 { 15827 struct wiphy *wiphy = wdev->wiphy; 15828 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15829 struct nlattr *match_attr, *local_func_attr, *peer_func_attr; 15830 struct sk_buff *msg; 15831 void *hdr; 15832 15833 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr)) 15834 return; 15835 15836 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15837 if (!msg) 15838 return; 15839 15840 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH); 15841 if (!hdr) { 15842 nlmsg_free(msg); 15843 return; 15844 } 15845 15846 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15847 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 15848 wdev->netdev->ifindex)) || 15849 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 15850 NL80211_ATTR_PAD)) 15851 goto nla_put_failure; 15852 15853 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie, 15854 NL80211_ATTR_PAD) || 15855 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr)) 15856 goto nla_put_failure; 15857 15858 match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH); 15859 if (!match_attr) 15860 goto nla_put_failure; 15861 15862 local_func_attr = nla_nest_start_noflag(msg, 15863 NL80211_NAN_MATCH_FUNC_LOCAL); 15864 if (!local_func_attr) 15865 goto nla_put_failure; 15866 15867 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id)) 15868 goto nla_put_failure; 15869 15870 nla_nest_end(msg, local_func_attr); 15871 15872 peer_func_attr = nla_nest_start_noflag(msg, 15873 NL80211_NAN_MATCH_FUNC_PEER); 15874 if (!peer_func_attr) 15875 goto nla_put_failure; 15876 15877 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) || 15878 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id)) 15879 goto nla_put_failure; 15880 15881 if (match->info && match->info_len && 15882 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len, 15883 match->info)) 15884 goto nla_put_failure; 15885 15886 nla_nest_end(msg, peer_func_attr); 15887 nla_nest_end(msg, match_attr); 15888 genlmsg_end(msg, hdr); 15889 15890 if (!wdev->owner_nlportid) 15891 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 15892 msg, 0, NL80211_MCGRP_NAN, gfp); 15893 else 15894 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 15895 wdev->owner_nlportid); 15896 15897 return; 15898 15899 nla_put_failure: 15900 nlmsg_free(msg); 15901 } 15902 EXPORT_SYMBOL(cfg80211_nan_match); 15903 15904 void cfg80211_nan_func_terminated(struct wireless_dev *wdev, 15905 u8 inst_id, 15906 enum nl80211_nan_func_term_reason reason, 15907 u64 cookie, gfp_t gfp) 15908 { 15909 struct wiphy *wiphy = wdev->wiphy; 15910 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15911 struct sk_buff *msg; 15912 struct nlattr *func_attr; 15913 void *hdr; 15914 15915 if (WARN_ON(!inst_id)) 15916 return; 15917 15918 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 15919 if (!msg) 15920 return; 15921 15922 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION); 15923 if (!hdr) { 15924 nlmsg_free(msg); 15925 return; 15926 } 15927 15928 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15929 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 15930 wdev->netdev->ifindex)) || 15931 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 15932 NL80211_ATTR_PAD)) 15933 goto nla_put_failure; 15934 15935 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 15936 NL80211_ATTR_PAD)) 15937 goto nla_put_failure; 15938 15939 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 15940 if (!func_attr) 15941 goto nla_put_failure; 15942 15943 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) || 15944 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason)) 15945 goto nla_put_failure; 15946 15947 nla_nest_end(msg, func_attr); 15948 genlmsg_end(msg, hdr); 15949 15950 if (!wdev->owner_nlportid) 15951 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 15952 msg, 0, NL80211_MCGRP_NAN, gfp); 15953 else 15954 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 15955 wdev->owner_nlportid); 15956 15957 return; 15958 15959 nla_put_failure: 15960 nlmsg_free(msg); 15961 } 15962 EXPORT_SYMBOL(cfg80211_nan_func_terminated); 15963 15964 static int nl80211_get_protocol_features(struct sk_buff *skb, 15965 struct genl_info *info) 15966 { 15967 void *hdr; 15968 struct sk_buff *msg; 15969 15970 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15971 if (!msg) 15972 return -ENOMEM; 15973 15974 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15975 NL80211_CMD_GET_PROTOCOL_FEATURES); 15976 if (!hdr) 15977 goto nla_put_failure; 15978 15979 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES, 15980 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP)) 15981 goto nla_put_failure; 15982 15983 genlmsg_end(msg, hdr); 15984 return genlmsg_reply(msg, info); 15985 15986 nla_put_failure: 15987 kfree_skb(msg); 15988 return -ENOBUFS; 15989 } 15990 15991 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info) 15992 { 15993 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15994 struct cfg80211_update_ft_ies_params ft_params; 15995 struct net_device *dev = info->user_ptr[1]; 15996 15997 if (!rdev->ops->update_ft_ies) 15998 return -EOPNOTSUPP; 15999 16000 if (!info->attrs[NL80211_ATTR_MDID] || 16001 !info->attrs[NL80211_ATTR_IE]) 16002 return -EINVAL; 16003 16004 memset(&ft_params, 0, sizeof(ft_params)); 16005 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]); 16006 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 16007 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 16008 16009 return rdev_update_ft_ies(rdev, dev, &ft_params); 16010 } 16011 16012 static int nl80211_crit_protocol_start(struct sk_buff *skb, 16013 struct genl_info *info) 16014 { 16015 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16016 struct wireless_dev *wdev = info->user_ptr[1]; 16017 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC; 16018 u16 duration; 16019 int ret; 16020 16021 if (!rdev->ops->crit_proto_start) 16022 return -EOPNOTSUPP; 16023 16024 if (WARN_ON(!rdev->ops->crit_proto_stop)) 16025 return -EINVAL; 16026 16027 if (rdev->crit_proto_nlportid) 16028 return -EBUSY; 16029 16030 /* determine protocol if provided */ 16031 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID]) 16032 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]); 16033 16034 if (proto >= NUM_NL80211_CRIT_PROTO) 16035 return -EINVAL; 16036 16037 /* timeout must be provided */ 16038 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]) 16039 return -EINVAL; 16040 16041 duration = 16042 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]); 16043 16044 ret = rdev_crit_proto_start(rdev, wdev, proto, duration); 16045 if (!ret) 16046 rdev->crit_proto_nlportid = info->snd_portid; 16047 16048 return ret; 16049 } 16050 16051 static int nl80211_crit_protocol_stop(struct sk_buff *skb, 16052 struct genl_info *info) 16053 { 16054 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16055 struct wireless_dev *wdev = info->user_ptr[1]; 16056 16057 if (!rdev->ops->crit_proto_stop) 16058 return -EOPNOTSUPP; 16059 16060 if (rdev->crit_proto_nlportid) { 16061 rdev->crit_proto_nlportid = 0; 16062 rdev_crit_proto_stop(rdev, wdev); 16063 } 16064 return 0; 16065 } 16066 16067 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd, 16068 struct nlattr *attr, 16069 struct netlink_ext_ack *extack) 16070 { 16071 if (vcmd->policy == VENDOR_CMD_RAW_DATA) { 16072 if (attr->nla_type & NLA_F_NESTED) { 16073 NL_SET_ERR_MSG_ATTR(extack, attr, 16074 "unexpected nested data"); 16075 return -EINVAL; 16076 } 16077 16078 return 0; 16079 } 16080 16081 if (!(attr->nla_type & NLA_F_NESTED)) { 16082 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data"); 16083 return -EINVAL; 16084 } 16085 16086 return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack); 16087 } 16088 16089 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info) 16090 { 16091 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16092 struct wireless_dev *wdev = 16093 __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 16094 info->attrs); 16095 int i, err; 16096 u32 vid, subcmd; 16097 16098 if (!rdev->wiphy.vendor_commands) 16099 return -EOPNOTSUPP; 16100 16101 if (IS_ERR(wdev)) { 16102 err = PTR_ERR(wdev); 16103 if (err != -EINVAL) 16104 return err; 16105 wdev = NULL; 16106 } else if (wdev->wiphy != &rdev->wiphy) { 16107 return -EINVAL; 16108 } 16109 16110 if (!info->attrs[NL80211_ATTR_VENDOR_ID] || 16111 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD]) 16112 return -EINVAL; 16113 16114 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]); 16115 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]); 16116 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 16117 const struct wiphy_vendor_command *vcmd; 16118 void *data = NULL; 16119 int len = 0; 16120 16121 vcmd = &rdev->wiphy.vendor_commands[i]; 16122 16123 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 16124 continue; 16125 16126 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 16127 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 16128 if (!wdev) 16129 return -EINVAL; 16130 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 16131 !wdev->netdev) 16132 return -EINVAL; 16133 16134 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 16135 if (!wdev_running(wdev)) 16136 return -ENETDOWN; 16137 } 16138 } else { 16139 wdev = NULL; 16140 } 16141 16142 if (!vcmd->doit) 16143 return -EOPNOTSUPP; 16144 16145 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) { 16146 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]); 16147 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]); 16148 16149 err = nl80211_vendor_check_policy(vcmd, 16150 info->attrs[NL80211_ATTR_VENDOR_DATA], 16151 info->extack); 16152 if (err) 16153 return err; 16154 } 16155 16156 rdev->cur_cmd_info = info; 16157 err = vcmd->doit(&rdev->wiphy, wdev, data, len); 16158 rdev->cur_cmd_info = NULL; 16159 return err; 16160 } 16161 16162 return -EOPNOTSUPP; 16163 } 16164 16165 static int nl80211_prepare_vendor_dump(struct sk_buff *skb, 16166 struct netlink_callback *cb, 16167 struct cfg80211_registered_device **rdev, 16168 struct wireless_dev **wdev) 16169 { 16170 struct nlattr **attrbuf; 16171 u32 vid, subcmd; 16172 unsigned int i; 16173 int vcmd_idx = -1; 16174 int err; 16175 void *data = NULL; 16176 unsigned int data_len = 0; 16177 16178 if (cb->args[0]) { 16179 /* subtract the 1 again here */ 16180 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 16181 struct wireless_dev *tmp; 16182 16183 if (!wiphy) 16184 return -ENODEV; 16185 *rdev = wiphy_to_rdev(wiphy); 16186 *wdev = NULL; 16187 16188 if (cb->args[1]) { 16189 list_for_each_entry(tmp, &wiphy->wdev_list, list) { 16190 if (tmp->identifier == cb->args[1] - 1) { 16191 *wdev = tmp; 16192 break; 16193 } 16194 } 16195 } 16196 16197 /* keep rtnl locked in successful case */ 16198 return 0; 16199 } 16200 16201 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 16202 if (!attrbuf) 16203 return -ENOMEM; 16204 16205 err = nlmsg_parse_deprecated(cb->nlh, 16206 GENL_HDRLEN + nl80211_fam.hdrsize, 16207 attrbuf, nl80211_fam.maxattr, 16208 nl80211_policy, NULL); 16209 if (err) 16210 goto out; 16211 16212 if (!attrbuf[NL80211_ATTR_VENDOR_ID] || 16213 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) { 16214 err = -EINVAL; 16215 goto out; 16216 } 16217 16218 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf); 16219 if (IS_ERR(*wdev)) 16220 *wdev = NULL; 16221 16222 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 16223 if (IS_ERR(*rdev)) { 16224 err = PTR_ERR(*rdev); 16225 goto out; 16226 } 16227 16228 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]); 16229 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]); 16230 16231 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) { 16232 const struct wiphy_vendor_command *vcmd; 16233 16234 vcmd = &(*rdev)->wiphy.vendor_commands[i]; 16235 16236 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 16237 continue; 16238 16239 if (!vcmd->dumpit) { 16240 err = -EOPNOTSUPP; 16241 goto out; 16242 } 16243 16244 vcmd_idx = i; 16245 break; 16246 } 16247 16248 if (vcmd_idx < 0) { 16249 err = -EOPNOTSUPP; 16250 goto out; 16251 } 16252 16253 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) { 16254 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]); 16255 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]); 16256 16257 err = nl80211_vendor_check_policy( 16258 &(*rdev)->wiphy.vendor_commands[vcmd_idx], 16259 attrbuf[NL80211_ATTR_VENDOR_DATA], 16260 cb->extack); 16261 if (err) 16262 goto out; 16263 } 16264 16265 /* 0 is the first index - add 1 to parse only once */ 16266 cb->args[0] = (*rdev)->wiphy_idx + 1; 16267 /* add 1 to know if it was NULL */ 16268 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0; 16269 cb->args[2] = vcmd_idx; 16270 cb->args[3] = (unsigned long)data; 16271 cb->args[4] = data_len; 16272 16273 /* keep rtnl locked in successful case */ 16274 err = 0; 16275 out: 16276 kfree(attrbuf); 16277 return err; 16278 } 16279 16280 static int nl80211_vendor_cmd_dump(struct sk_buff *skb, 16281 struct netlink_callback *cb) 16282 { 16283 struct cfg80211_registered_device *rdev; 16284 struct wireless_dev *wdev; 16285 unsigned int vcmd_idx; 16286 const struct wiphy_vendor_command *vcmd; 16287 void *data; 16288 int data_len; 16289 int err; 16290 struct nlattr *vendor_data; 16291 16292 rtnl_lock(); 16293 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev); 16294 if (err) 16295 goto out; 16296 16297 vcmd_idx = cb->args[2]; 16298 data = (void *)cb->args[3]; 16299 data_len = cb->args[4]; 16300 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx]; 16301 16302 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 16303 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 16304 if (!wdev) { 16305 err = -EINVAL; 16306 goto out; 16307 } 16308 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 16309 !wdev->netdev) { 16310 err = -EINVAL; 16311 goto out; 16312 } 16313 16314 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 16315 if (!wdev_running(wdev)) { 16316 err = -ENETDOWN; 16317 goto out; 16318 } 16319 } 16320 } 16321 16322 while (1) { 16323 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 16324 cb->nlh->nlmsg_seq, NLM_F_MULTI, 16325 NL80211_CMD_VENDOR); 16326 if (!hdr) 16327 break; 16328 16329 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 16330 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 16331 wdev_id(wdev), 16332 NL80211_ATTR_PAD))) { 16333 genlmsg_cancel(skb, hdr); 16334 break; 16335 } 16336 16337 vendor_data = nla_nest_start_noflag(skb, 16338 NL80211_ATTR_VENDOR_DATA); 16339 if (!vendor_data) { 16340 genlmsg_cancel(skb, hdr); 16341 break; 16342 } 16343 16344 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len, 16345 (unsigned long *)&cb->args[5]); 16346 nla_nest_end(skb, vendor_data); 16347 16348 if (err == -ENOBUFS || err == -ENOENT) { 16349 genlmsg_cancel(skb, hdr); 16350 break; 16351 } else if (err <= 0) { 16352 genlmsg_cancel(skb, hdr); 16353 goto out; 16354 } 16355 16356 genlmsg_end(skb, hdr); 16357 } 16358 16359 err = skb->len; 16360 out: 16361 rtnl_unlock(); 16362 return err; 16363 } 16364 16365 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy, 16366 enum nl80211_commands cmd, 16367 enum nl80211_attrs attr, 16368 int approxlen) 16369 { 16370 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16371 16372 if (WARN_ON(!rdev->cur_cmd_info)) 16373 return NULL; 16374 16375 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen, 16376 rdev->cur_cmd_info->snd_portid, 16377 rdev->cur_cmd_info->snd_seq, 16378 cmd, attr, NULL, GFP_KERNEL); 16379 } 16380 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb); 16381 16382 int cfg80211_vendor_cmd_reply(struct sk_buff *skb) 16383 { 16384 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 16385 void *hdr = ((void **)skb->cb)[1]; 16386 struct nlattr *data = ((void **)skb->cb)[2]; 16387 16388 /* clear CB data for netlink core to own from now on */ 16389 memset(skb->cb, 0, sizeof(skb->cb)); 16390 16391 if (WARN_ON(!rdev->cur_cmd_info)) { 16392 kfree_skb(skb); 16393 return -EINVAL; 16394 } 16395 16396 nla_nest_end(skb, data); 16397 genlmsg_end(skb, hdr); 16398 return genlmsg_reply(skb, rdev->cur_cmd_info); 16399 } 16400 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply); 16401 16402 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy) 16403 { 16404 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 16405 16406 if (WARN_ON(!rdev->cur_cmd_info)) 16407 return 0; 16408 16409 return rdev->cur_cmd_info->snd_portid; 16410 } 16411 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender); 16412 16413 static int nl80211_set_qos_map(struct sk_buff *skb, 16414 struct genl_info *info) 16415 { 16416 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16417 struct cfg80211_qos_map *qos_map = NULL; 16418 struct net_device *dev = info->user_ptr[1]; 16419 u8 *pos, len, num_des, des_len, des; 16420 int ret; 16421 16422 if (!rdev->ops->set_qos_map) 16423 return -EOPNOTSUPP; 16424 16425 if (info->attrs[NL80211_ATTR_QOS_MAP]) { 16426 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]); 16427 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]); 16428 16429 if (len % 2) 16430 return -EINVAL; 16431 16432 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL); 16433 if (!qos_map) 16434 return -ENOMEM; 16435 16436 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1; 16437 if (num_des) { 16438 des_len = num_des * 16439 sizeof(struct cfg80211_dscp_exception); 16440 memcpy(qos_map->dscp_exception, pos, des_len); 16441 qos_map->num_des = num_des; 16442 for (des = 0; des < num_des; des++) { 16443 if (qos_map->dscp_exception[des].up > 7) { 16444 kfree(qos_map); 16445 return -EINVAL; 16446 } 16447 } 16448 pos += des_len; 16449 } 16450 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN); 16451 } 16452 16453 ret = nl80211_key_allowed(dev->ieee80211_ptr); 16454 if (!ret) 16455 ret = rdev_set_qos_map(rdev, dev, qos_map); 16456 16457 kfree(qos_map); 16458 return ret; 16459 } 16460 16461 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info) 16462 { 16463 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16464 struct net_device *dev = info->user_ptr[1]; 16465 struct wireless_dev *wdev = dev->ieee80211_ptr; 16466 const u8 *peer; 16467 u8 tsid, up; 16468 u16 admitted_time = 0; 16469 16470 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)) 16471 return -EOPNOTSUPP; 16472 16473 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] || 16474 !info->attrs[NL80211_ATTR_USER_PRIO]) 16475 return -EINVAL; 16476 16477 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 16478 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]); 16479 16480 /* WMM uses TIDs 0-7 even for TSPEC */ 16481 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) { 16482 /* TODO: handle 802.11 TSPEC/admission control 16483 * need more attributes for that (e.g. BA session requirement); 16484 * change the WMM admission test above to allow both then 16485 */ 16486 return -EINVAL; 16487 } 16488 16489 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 16490 16491 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) { 16492 admitted_time = 16493 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]); 16494 if (!admitted_time) 16495 return -EINVAL; 16496 } 16497 16498 switch (wdev->iftype) { 16499 case NL80211_IFTYPE_STATION: 16500 case NL80211_IFTYPE_P2P_CLIENT: 16501 if (wdev->connected) 16502 break; 16503 return -ENOTCONN; 16504 default: 16505 return -EOPNOTSUPP; 16506 } 16507 16508 return rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time); 16509 } 16510 16511 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info) 16512 { 16513 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16514 struct net_device *dev = info->user_ptr[1]; 16515 const u8 *peer; 16516 u8 tsid; 16517 16518 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC]) 16519 return -EINVAL; 16520 16521 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 16522 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 16523 16524 return rdev_del_tx_ts(rdev, dev, tsid, peer); 16525 } 16526 16527 static int nl80211_tdls_channel_switch(struct sk_buff *skb, 16528 struct genl_info *info) 16529 { 16530 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16531 struct net_device *dev = info->user_ptr[1]; 16532 struct wireless_dev *wdev = dev->ieee80211_ptr; 16533 struct cfg80211_chan_def chandef = {}; 16534 const u8 *addr; 16535 u8 oper_class; 16536 int err; 16537 16538 if (!rdev->ops->tdls_channel_switch || 16539 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 16540 return -EOPNOTSUPP; 16541 16542 switch (dev->ieee80211_ptr->iftype) { 16543 case NL80211_IFTYPE_STATION: 16544 case NL80211_IFTYPE_P2P_CLIENT: 16545 break; 16546 default: 16547 return -EOPNOTSUPP; 16548 } 16549 16550 if (!info->attrs[NL80211_ATTR_MAC] || 16551 !info->attrs[NL80211_ATTR_OPER_CLASS]) 16552 return -EINVAL; 16553 16554 err = nl80211_parse_chandef(rdev, info, &chandef); 16555 if (err) 16556 return err; 16557 16558 /* 16559 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012 16560 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the 16561 * specification is not defined for them. 16562 */ 16563 if (chandef.chan->band == NL80211_BAND_2GHZ && 16564 chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 16565 chandef.width != NL80211_CHAN_WIDTH_20) 16566 return -EINVAL; 16567 16568 /* we will be active on the TDLS link */ 16569 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 16570 wdev->iftype)) 16571 return -EINVAL; 16572 16573 /* don't allow switching to DFS channels */ 16574 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype)) 16575 return -EINVAL; 16576 16577 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16578 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]); 16579 16580 return rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef); 16581 } 16582 16583 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb, 16584 struct genl_info *info) 16585 { 16586 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16587 struct net_device *dev = info->user_ptr[1]; 16588 const u8 *addr; 16589 16590 if (!rdev->ops->tdls_channel_switch || 16591 !rdev->ops->tdls_cancel_channel_switch || 16592 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 16593 return -EOPNOTSUPP; 16594 16595 switch (dev->ieee80211_ptr->iftype) { 16596 case NL80211_IFTYPE_STATION: 16597 case NL80211_IFTYPE_P2P_CLIENT: 16598 break; 16599 default: 16600 return -EOPNOTSUPP; 16601 } 16602 16603 if (!info->attrs[NL80211_ATTR_MAC]) 16604 return -EINVAL; 16605 16606 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16607 16608 rdev_tdls_cancel_channel_switch(rdev, dev, addr); 16609 16610 return 0; 16611 } 16612 16613 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb, 16614 struct genl_info *info) 16615 { 16616 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16617 struct net_device *dev = info->user_ptr[1]; 16618 struct wireless_dev *wdev = dev->ieee80211_ptr; 16619 const struct nlattr *nla; 16620 bool enabled; 16621 16622 if (!rdev->ops->set_multicast_to_unicast) 16623 return -EOPNOTSUPP; 16624 16625 if (wdev->iftype != NL80211_IFTYPE_AP && 16626 wdev->iftype != NL80211_IFTYPE_P2P_GO) 16627 return -EOPNOTSUPP; 16628 16629 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED]; 16630 enabled = nla_get_flag(nla); 16631 16632 return rdev_set_multicast_to_unicast(rdev, dev, enabled); 16633 } 16634 16635 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info) 16636 { 16637 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16638 struct net_device *dev = info->user_ptr[1]; 16639 struct wireless_dev *wdev = dev->ieee80211_ptr; 16640 struct cfg80211_pmk_conf pmk_conf = {}; 16641 16642 if (wdev->iftype != NL80211_IFTYPE_STATION && 16643 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16644 return -EOPNOTSUPP; 16645 16646 if (!wiphy_ext_feature_isset(&rdev->wiphy, 16647 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 16648 return -EOPNOTSUPP; 16649 16650 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK]) 16651 return -EINVAL; 16652 16653 if (!wdev->connected) 16654 return -ENOTCONN; 16655 16656 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 16657 if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN)) 16658 return -EINVAL; 16659 16660 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 16661 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 16662 if (pmk_conf.pmk_len != WLAN_PMK_LEN && 16663 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) 16664 return -EINVAL; 16665 16666 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) 16667 pmk_conf.pmk_r0_name = 16668 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]); 16669 16670 return rdev_set_pmk(rdev, dev, &pmk_conf); 16671 } 16672 16673 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info) 16674 { 16675 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16676 struct net_device *dev = info->user_ptr[1]; 16677 struct wireless_dev *wdev = dev->ieee80211_ptr; 16678 const u8 *aa; 16679 16680 if (wdev->iftype != NL80211_IFTYPE_STATION && 16681 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16682 return -EOPNOTSUPP; 16683 16684 if (!wiphy_ext_feature_isset(&rdev->wiphy, 16685 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 16686 return -EOPNOTSUPP; 16687 16688 if (!info->attrs[NL80211_ATTR_MAC]) 16689 return -EINVAL; 16690 16691 aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 16692 return rdev_del_pmk(rdev, dev, aa); 16693 } 16694 16695 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info) 16696 { 16697 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16698 struct net_device *dev = info->user_ptr[1]; 16699 struct cfg80211_external_auth_params params; 16700 16701 if (!rdev->ops->external_auth) 16702 return -EOPNOTSUPP; 16703 16704 if (!info->attrs[NL80211_ATTR_SSID] && 16705 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 16706 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 16707 return -EINVAL; 16708 16709 if (!info->attrs[NL80211_ATTR_BSSID]) 16710 return -EINVAL; 16711 16712 if (!info->attrs[NL80211_ATTR_STATUS_CODE]) 16713 return -EINVAL; 16714 16715 memset(¶ms, 0, sizeof(params)); 16716 16717 if (info->attrs[NL80211_ATTR_SSID]) { 16718 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 16719 if (params.ssid.ssid_len == 0) 16720 return -EINVAL; 16721 memcpy(params.ssid.ssid, 16722 nla_data(info->attrs[NL80211_ATTR_SSID]), 16723 params.ssid.ssid_len); 16724 } 16725 16726 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]), 16727 ETH_ALEN); 16728 16729 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 16730 16731 if (info->attrs[NL80211_ATTR_PMKID]) 16732 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 16733 16734 return rdev_external_auth(rdev, dev, ¶ms); 16735 } 16736 16737 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info) 16738 { 16739 bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK]; 16740 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16741 struct net_device *dev = info->user_ptr[1]; 16742 struct wireless_dev *wdev = dev->ieee80211_ptr; 16743 const u8 *buf; 16744 size_t len; 16745 u8 *dest; 16746 u16 proto; 16747 bool noencrypt; 16748 u64 cookie = 0; 16749 int link_id; 16750 int err; 16751 16752 if (!wiphy_ext_feature_isset(&rdev->wiphy, 16753 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 16754 return -EOPNOTSUPP; 16755 16756 if (!rdev->ops->tx_control_port) 16757 return -EOPNOTSUPP; 16758 16759 if (!info->attrs[NL80211_ATTR_FRAME] || 16760 !info->attrs[NL80211_ATTR_MAC] || 16761 !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 16762 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing"); 16763 return -EINVAL; 16764 } 16765 16766 switch (wdev->iftype) { 16767 case NL80211_IFTYPE_AP: 16768 case NL80211_IFTYPE_P2P_GO: 16769 case NL80211_IFTYPE_MESH_POINT: 16770 break; 16771 case NL80211_IFTYPE_ADHOC: 16772 if (wdev->u.ibss.current_bss) 16773 break; 16774 return -ENOTCONN; 16775 case NL80211_IFTYPE_STATION: 16776 case NL80211_IFTYPE_P2P_CLIENT: 16777 if (wdev->connected) 16778 break; 16779 return -ENOTCONN; 16780 default: 16781 return -EOPNOTSUPP; 16782 } 16783 16784 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 16785 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 16786 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 16787 proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 16788 noencrypt = 16789 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]); 16790 16791 link_id = nl80211_link_id_or_invalid(info->attrs); 16792 16793 err = rdev_tx_control_port(rdev, dev, buf, len, 16794 dest, cpu_to_be16(proto), noencrypt, link_id, 16795 dont_wait_for_ack ? NULL : &cookie); 16796 if (!err && !dont_wait_for_ack) 16797 nl_set_extack_cookie_u64(info->extack, cookie); 16798 return err; 16799 } 16800 16801 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb, 16802 struct genl_info *info) 16803 { 16804 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16805 struct net_device *dev = info->user_ptr[1]; 16806 struct wireless_dev *wdev = dev->ieee80211_ptr; 16807 struct cfg80211_ftm_responder_stats ftm_stats = {}; 16808 unsigned int link_id = nl80211_link_id(info->attrs); 16809 struct sk_buff *msg; 16810 void *hdr; 16811 struct nlattr *ftm_stats_attr; 16812 int err; 16813 16814 if (wdev->iftype != NL80211_IFTYPE_AP || 16815 !wdev->links[link_id].ap.beacon_interval) 16816 return -EOPNOTSUPP; 16817 16818 err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats); 16819 if (err) 16820 return err; 16821 16822 if (!ftm_stats.filled) 16823 return -ENODATA; 16824 16825 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 16826 if (!msg) 16827 return -ENOMEM; 16828 16829 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 16830 NL80211_CMD_GET_FTM_RESPONDER_STATS); 16831 if (!hdr) 16832 goto nla_put_failure; 16833 16834 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 16835 goto nla_put_failure; 16836 16837 ftm_stats_attr = nla_nest_start_noflag(msg, 16838 NL80211_ATTR_FTM_RESPONDER_STATS); 16839 if (!ftm_stats_attr) 16840 goto nla_put_failure; 16841 16842 #define SET_FTM(field, name, type) \ 16843 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 16844 nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \ 16845 ftm_stats.field)) \ 16846 goto nla_put_failure; } while (0) 16847 #define SET_FTM_U64(field, name) \ 16848 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 16849 nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \ 16850 ftm_stats.field, NL80211_FTM_STATS_PAD)) \ 16851 goto nla_put_failure; } while (0) 16852 16853 SET_FTM(success_num, SUCCESS_NUM, u32); 16854 SET_FTM(partial_num, PARTIAL_NUM, u32); 16855 SET_FTM(failed_num, FAILED_NUM, u32); 16856 SET_FTM(asap_num, ASAP_NUM, u32); 16857 SET_FTM(non_asap_num, NON_ASAP_NUM, u32); 16858 SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC); 16859 SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32); 16860 SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32); 16861 SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32); 16862 #undef SET_FTM 16863 16864 nla_nest_end(msg, ftm_stats_attr); 16865 16866 genlmsg_end(msg, hdr); 16867 return genlmsg_reply(msg, info); 16868 16869 nla_put_failure: 16870 nlmsg_free(msg); 16871 return -ENOBUFS; 16872 } 16873 16874 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info) 16875 { 16876 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16877 struct cfg80211_update_owe_info owe_info; 16878 struct net_device *dev = info->user_ptr[1]; 16879 16880 if (!rdev->ops->update_owe_info) 16881 return -EOPNOTSUPP; 16882 16883 if (!info->attrs[NL80211_ATTR_STATUS_CODE] || 16884 !info->attrs[NL80211_ATTR_MAC]) 16885 return -EINVAL; 16886 16887 memset(&owe_info, 0, sizeof(owe_info)); 16888 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 16889 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN); 16890 16891 if (info->attrs[NL80211_ATTR_IE]) { 16892 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 16893 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 16894 } 16895 16896 return rdev_update_owe_info(rdev, dev, &owe_info); 16897 } 16898 16899 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info) 16900 { 16901 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16902 struct net_device *dev = info->user_ptr[1]; 16903 struct wireless_dev *wdev = dev->ieee80211_ptr; 16904 struct station_info sinfo = {}; 16905 const u8 *buf; 16906 size_t len; 16907 u8 *dest; 16908 int err; 16909 16910 if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station) 16911 return -EOPNOTSUPP; 16912 16913 if (!info->attrs[NL80211_ATTR_MAC] || 16914 !info->attrs[NL80211_ATTR_FRAME]) { 16915 GENL_SET_ERR_MSG(info, "Frame or MAC missing"); 16916 return -EINVAL; 16917 } 16918 16919 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 16920 return -EOPNOTSUPP; 16921 16922 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 16923 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 16924 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 16925 16926 if (len < sizeof(struct ethhdr)) 16927 return -EINVAL; 16928 16929 if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) || 16930 !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr)) 16931 return -EINVAL; 16932 16933 err = rdev_get_station(rdev, dev, dest, &sinfo); 16934 if (err) 16935 return err; 16936 16937 cfg80211_sinfo_release_content(&sinfo); 16938 16939 return rdev_probe_mesh_link(rdev, dev, dest, buf, len); 16940 } 16941 16942 static int parse_tid_conf(struct cfg80211_registered_device *rdev, 16943 struct nlattr *attrs[], struct net_device *dev, 16944 struct cfg80211_tid_cfg *tid_conf, 16945 struct genl_info *info, const u8 *peer, 16946 unsigned int link_id) 16947 { 16948 struct netlink_ext_ack *extack = info->extack; 16949 u64 mask; 16950 int err; 16951 16952 if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS]) 16953 return -EINVAL; 16954 16955 tid_conf->config_override = 16956 nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]); 16957 tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]); 16958 16959 if (tid_conf->config_override) { 16960 if (rdev->ops->reset_tid_config) { 16961 err = rdev_reset_tid_config(rdev, dev, peer, 16962 tid_conf->tids); 16963 if (err) 16964 return err; 16965 } else { 16966 return -EINVAL; 16967 } 16968 } 16969 16970 if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) { 16971 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK); 16972 tid_conf->noack = 16973 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]); 16974 } 16975 16976 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) { 16977 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT); 16978 tid_conf->retry_short = 16979 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]); 16980 16981 if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count) 16982 return -EINVAL; 16983 } 16984 16985 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) { 16986 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG); 16987 tid_conf->retry_long = 16988 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]); 16989 16990 if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count) 16991 return -EINVAL; 16992 } 16993 16994 if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) { 16995 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL); 16996 tid_conf->ampdu = 16997 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]); 16998 } 16999 17000 if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) { 17001 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL); 17002 tid_conf->rtscts = 17003 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]); 17004 } 17005 17006 if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) { 17007 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL); 17008 tid_conf->amsdu = 17009 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]); 17010 } 17011 17012 if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) { 17013 u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr; 17014 17015 tid_conf->txrate_type = nla_get_u8(attrs[idx]); 17016 17017 if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) { 17018 attr = NL80211_TID_CONFIG_ATTR_TX_RATE; 17019 err = nl80211_parse_tx_bitrate_mask(info, attrs, attr, 17020 &tid_conf->txrate_mask, dev, 17021 true, link_id); 17022 if (err) 17023 return err; 17024 17025 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE); 17026 } 17027 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE); 17028 } 17029 17030 if (peer) 17031 mask = rdev->wiphy.tid_config_support.peer; 17032 else 17033 mask = rdev->wiphy.tid_config_support.vif; 17034 17035 if (tid_conf->mask & ~mask) { 17036 NL_SET_ERR_MSG(extack, "unsupported TID configuration"); 17037 return -EOPNOTSUPP; 17038 } 17039 17040 return 0; 17041 } 17042 17043 static int nl80211_set_tid_config(struct sk_buff *skb, 17044 struct genl_info *info) 17045 { 17046 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17047 struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1]; 17048 unsigned int link_id = nl80211_link_id(info->attrs); 17049 struct net_device *dev = info->user_ptr[1]; 17050 struct cfg80211_tid_config *tid_config; 17051 struct nlattr *tid; 17052 int conf_idx = 0, rem_conf; 17053 int ret = -EINVAL; 17054 u32 num_conf = 0; 17055 17056 if (!info->attrs[NL80211_ATTR_TID_CONFIG]) 17057 return -EINVAL; 17058 17059 if (!rdev->ops->set_tid_config) 17060 return -EOPNOTSUPP; 17061 17062 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 17063 rem_conf) 17064 num_conf++; 17065 17066 tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf), 17067 GFP_KERNEL); 17068 if (!tid_config) 17069 return -ENOMEM; 17070 17071 tid_config->n_tid_conf = num_conf; 17072 17073 if (info->attrs[NL80211_ATTR_MAC]) 17074 tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 17075 17076 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 17077 rem_conf) { 17078 ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX, 17079 tid, NULL, NULL); 17080 17081 if (ret) 17082 goto bad_tid_conf; 17083 17084 ret = parse_tid_conf(rdev, attrs, dev, 17085 &tid_config->tid_conf[conf_idx], 17086 info, tid_config->peer, link_id); 17087 if (ret) 17088 goto bad_tid_conf; 17089 17090 conf_idx++; 17091 } 17092 17093 ret = rdev_set_tid_config(rdev, dev, tid_config); 17094 17095 bad_tid_conf: 17096 kfree(tid_config); 17097 return ret; 17098 } 17099 17100 static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info) 17101 { 17102 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17103 struct cfg80211_color_change_settings params = {}; 17104 struct net_device *dev = info->user_ptr[1]; 17105 struct wireless_dev *wdev = dev->ieee80211_ptr; 17106 struct nlattr **tb; 17107 u16 offset; 17108 int err; 17109 17110 if (!rdev->ops->color_change) 17111 return -EOPNOTSUPP; 17112 17113 if (!wiphy_ext_feature_isset(&rdev->wiphy, 17114 NL80211_EXT_FEATURE_BSS_COLOR)) 17115 return -EOPNOTSUPP; 17116 17117 if (wdev->iftype != NL80211_IFTYPE_AP) 17118 return -EOPNOTSUPP; 17119 17120 if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] || 17121 !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] || 17122 !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS]) 17123 return -EINVAL; 17124 17125 params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]); 17126 params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]); 17127 17128 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_next, 17129 info->extack); 17130 if (err) 17131 return err; 17132 17133 tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL); 17134 if (!tb) 17135 return -ENOMEM; 17136 17137 err = nla_parse_nested(tb, NL80211_ATTR_MAX, 17138 info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS], 17139 nl80211_policy, info->extack); 17140 if (err) 17141 goto out; 17142 17143 err = nl80211_parse_beacon(rdev, tb, ¶ms.beacon_color_change, 17144 info->extack); 17145 if (err) 17146 goto out; 17147 17148 if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 17149 err = -EINVAL; 17150 goto out; 17151 } 17152 17153 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) { 17154 err = -EINVAL; 17155 goto out; 17156 } 17157 17158 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 17159 if (offset >= params.beacon_color_change.tail_len) { 17160 err = -EINVAL; 17161 goto out; 17162 } 17163 17164 if (params.beacon_color_change.tail[offset] != params.count) { 17165 err = -EINVAL; 17166 goto out; 17167 } 17168 17169 params.counter_offset_beacon = offset; 17170 17171 if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 17172 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) != 17173 sizeof(u16)) { 17174 err = -EINVAL; 17175 goto out; 17176 } 17177 17178 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 17179 if (offset >= params.beacon_color_change.probe_resp_len) { 17180 err = -EINVAL; 17181 goto out; 17182 } 17183 17184 if (params.beacon_color_change.probe_resp[offset] != 17185 params.count) { 17186 err = -EINVAL; 17187 goto out; 17188 } 17189 17190 params.counter_offset_presp = offset; 17191 } 17192 17193 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 17194 err = nl80211_parse_unsol_bcast_probe_resp( 17195 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 17196 ¶ms.unsol_bcast_probe_resp); 17197 if (err) 17198 goto out; 17199 } 17200 17201 params.link_id = nl80211_link_id(info->attrs); 17202 err = rdev_color_change(rdev, dev, ¶ms); 17203 17204 out: 17205 kfree(params.beacon_next.mbssid_ies); 17206 kfree(params.beacon_color_change.mbssid_ies); 17207 kfree(params.beacon_next.rnr_ies); 17208 kfree(params.beacon_color_change.rnr_ies); 17209 kfree(tb); 17210 return err; 17211 } 17212 17213 static int nl80211_set_fils_aad(struct sk_buff *skb, 17214 struct genl_info *info) 17215 { 17216 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17217 struct net_device *dev = info->user_ptr[1]; 17218 struct cfg80211_fils_aad fils_aad = {}; 17219 u8 *nonces; 17220 17221 if (!info->attrs[NL80211_ATTR_MAC] || 17222 !info->attrs[NL80211_ATTR_FILS_KEK] || 17223 !info->attrs[NL80211_ATTR_FILS_NONCES]) 17224 return -EINVAL; 17225 17226 fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 17227 fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 17228 fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 17229 nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 17230 fils_aad.snonce = nonces; 17231 fils_aad.anonce = nonces + FILS_NONCE_LEN; 17232 17233 return rdev_set_fils_aad(rdev, dev, &fils_aad); 17234 } 17235 17236 static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info) 17237 { 17238 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17239 unsigned int link_id = nl80211_link_id(info->attrs); 17240 struct net_device *dev = info->user_ptr[1]; 17241 struct wireless_dev *wdev = dev->ieee80211_ptr; 17242 int ret; 17243 17244 if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO)) 17245 return -EINVAL; 17246 17247 switch (wdev->iftype) { 17248 case NL80211_IFTYPE_AP: 17249 break; 17250 default: 17251 return -EINVAL; 17252 } 17253 17254 if (!info->attrs[NL80211_ATTR_MAC] || 17255 !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC]))) 17256 return -EINVAL; 17257 17258 wdev->valid_links |= BIT(link_id); 17259 ether_addr_copy(wdev->links[link_id].addr, 17260 nla_data(info->attrs[NL80211_ATTR_MAC])); 17261 17262 ret = rdev_add_intf_link(rdev, wdev, link_id); 17263 if (ret) { 17264 wdev->valid_links &= ~BIT(link_id); 17265 eth_zero_addr(wdev->links[link_id].addr); 17266 } 17267 17268 return ret; 17269 } 17270 17271 static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info) 17272 { 17273 unsigned int link_id = nl80211_link_id(info->attrs); 17274 struct net_device *dev = info->user_ptr[1]; 17275 struct wireless_dev *wdev = dev->ieee80211_ptr; 17276 17277 /* cannot remove if there's no link */ 17278 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 17279 return -EINVAL; 17280 17281 switch (wdev->iftype) { 17282 case NL80211_IFTYPE_AP: 17283 break; 17284 default: 17285 return -EINVAL; 17286 } 17287 17288 cfg80211_remove_link(wdev, link_id); 17289 17290 return 0; 17291 } 17292 17293 static int 17294 nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info, 17295 bool add) 17296 { 17297 struct link_station_parameters params = {}; 17298 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17299 struct net_device *dev = info->user_ptr[1]; 17300 int err; 17301 17302 if ((add && !rdev->ops->add_link_station) || 17303 (!add && !rdev->ops->mod_link_station)) 17304 return -EOPNOTSUPP; 17305 17306 if (add && !info->attrs[NL80211_ATTR_MAC]) 17307 return -EINVAL; 17308 17309 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 17310 return -EINVAL; 17311 17312 if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 17313 return -EINVAL; 17314 17315 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 17316 17317 if (info->attrs[NL80211_ATTR_MAC]) { 17318 params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 17319 if (!is_valid_ether_addr(params.link_mac)) 17320 return -EINVAL; 17321 } 17322 17323 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 17324 return -EINVAL; 17325 17326 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 17327 17328 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 17329 params.supported_rates = 17330 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 17331 params.supported_rates_len = 17332 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 17333 } 17334 17335 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 17336 params.ht_capa = 17337 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 17338 17339 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 17340 params.vht_capa = 17341 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 17342 17343 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 17344 params.he_capa = 17345 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 17346 params.he_capa_len = 17347 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 17348 17349 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 17350 params.eht_capa = 17351 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 17352 params.eht_capa_len = 17353 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 17354 17355 if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa, 17356 (const u8 *)params.eht_capa, 17357 params.eht_capa_len, 17358 false)) 17359 return -EINVAL; 17360 } 17361 } 17362 17363 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 17364 params.he_6ghz_capa = 17365 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 17366 17367 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 17368 params.opmode_notif_used = true; 17369 params.opmode_notif = 17370 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 17371 } 17372 17373 err = nl80211_parse_sta_txpower_setting(info, ¶ms.txpwr, 17374 ¶ms.txpwr_set); 17375 if (err) 17376 return err; 17377 17378 if (add) 17379 return rdev_add_link_station(rdev, dev, ¶ms); 17380 17381 return rdev_mod_link_station(rdev, dev, ¶ms); 17382 } 17383 17384 static int 17385 nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info) 17386 { 17387 return nl80211_add_mod_link_station(skb, info, true); 17388 } 17389 17390 static int 17391 nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info) 17392 { 17393 return nl80211_add_mod_link_station(skb, info, false); 17394 } 17395 17396 static int 17397 nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info) 17398 { 17399 struct link_station_del_parameters params = {}; 17400 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17401 struct net_device *dev = info->user_ptr[1]; 17402 17403 if (!rdev->ops->del_link_station) 17404 return -EOPNOTSUPP; 17405 17406 if (!info->attrs[NL80211_ATTR_MLD_ADDR] || 17407 !info->attrs[NL80211_ATTR_MLO_LINK_ID]) 17408 return -EINVAL; 17409 17410 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 17411 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 17412 17413 return rdev_del_link_station(rdev, dev, ¶ms); 17414 } 17415 17416 static int nl80211_set_hw_timestamp(struct sk_buff *skb, 17417 struct genl_info *info) 17418 { 17419 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17420 struct net_device *dev = info->user_ptr[1]; 17421 struct cfg80211_set_hw_timestamp hwts = {}; 17422 17423 if (!rdev->wiphy.hw_timestamp_max_peers) 17424 return -EOPNOTSUPP; 17425 17426 if (!info->attrs[NL80211_ATTR_MAC] && 17427 rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS) 17428 return -EOPNOTSUPP; 17429 17430 if (info->attrs[NL80211_ATTR_MAC]) 17431 hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 17432 17433 hwts.enable = 17434 nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]); 17435 17436 return rdev_set_hw_timestamp(rdev, dev, &hwts); 17437 } 17438 17439 static int 17440 nl80211_set_ttlm(struct sk_buff *skb, struct genl_info *info) 17441 { 17442 struct cfg80211_ttlm_params params = {}; 17443 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17444 struct net_device *dev = info->user_ptr[1]; 17445 struct wireless_dev *wdev = dev->ieee80211_ptr; 17446 17447 if (wdev->iftype != NL80211_IFTYPE_STATION && 17448 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 17449 return -EOPNOTSUPP; 17450 17451 if (!wdev->connected) 17452 return -ENOLINK; 17453 17454 if (!info->attrs[NL80211_ATTR_MLO_TTLM_DLINK] || 17455 !info->attrs[NL80211_ATTR_MLO_TTLM_ULINK]) 17456 return -EINVAL; 17457 17458 nla_memcpy(params.dlink, 17459 info->attrs[NL80211_ATTR_MLO_TTLM_DLINK], 17460 sizeof(params.dlink)); 17461 nla_memcpy(params.ulink, 17462 info->attrs[NL80211_ATTR_MLO_TTLM_ULINK], 17463 sizeof(params.ulink)); 17464 17465 return rdev_set_ttlm(rdev, dev, ¶ms); 17466 } 17467 17468 static int nl80211_assoc_ml_reconf(struct sk_buff *skb, struct genl_info *info) 17469 { 17470 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17471 struct net_device *dev = info->user_ptr[1]; 17472 struct wireless_dev *wdev = dev->ieee80211_ptr; 17473 struct cfg80211_ml_reconf_req req = {}; 17474 unsigned int link_id; 17475 u16 add_links; 17476 int err; 17477 17478 if (!wdev->valid_links) 17479 return -EINVAL; 17480 17481 if (dev->ieee80211_ptr->conn_owner_nlportid && 17482 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 17483 return -EPERM; 17484 17485 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 17486 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 17487 return -EOPNOTSUPP; 17488 17489 add_links = 0; 17490 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 17491 err = nl80211_process_links(rdev, req.add_links, 17492 /* mark as MLO, but not assoc */ 17493 IEEE80211_MLD_MAX_NUM_LINKS, 17494 NULL, 0, info); 17495 if (err) 17496 return err; 17497 17498 for (link_id = 0; link_id < IEEE80211_MLD_MAX_NUM_LINKS; 17499 link_id++) { 17500 if (!req.add_links[link_id].bss) 17501 continue; 17502 add_links |= BIT(link_id); 17503 } 17504 } 17505 17506 if (info->attrs[NL80211_ATTR_MLO_RECONF_REM_LINKS]) 17507 req.rem_links = 17508 nla_get_u16(info->attrs[NL80211_ATTR_MLO_RECONF_REM_LINKS]); 17509 17510 /* Validate that existing links are not added, removed links are valid 17511 * and don't allow adding and removing the same links 17512 */ 17513 if ((add_links & req.rem_links) || !(add_links | req.rem_links) || 17514 (wdev->valid_links & add_links) || 17515 ((wdev->valid_links & req.rem_links) != req.rem_links)) { 17516 err = -EINVAL; 17517 goto out; 17518 } 17519 17520 if (info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]) 17521 req.ext_mld_capa_ops = 17522 nla_get_u16(info->attrs[NL80211_ATTR_ASSOC_MLD_EXT_CAPA_OPS]); 17523 17524 err = cfg80211_assoc_ml_reconf(rdev, dev, &req); 17525 17526 out: 17527 for (link_id = 0; link_id < ARRAY_SIZE(req.add_links); link_id++) 17528 cfg80211_put_bss(&rdev->wiphy, req.add_links[link_id].bss); 17529 17530 return err; 17531 } 17532 17533 static int 17534 nl80211_epcs_cfg(struct sk_buff *skb, struct genl_info *info) 17535 { 17536 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17537 struct net_device *dev = info->user_ptr[1]; 17538 struct wireless_dev *wdev = dev->ieee80211_ptr; 17539 bool val; 17540 17541 if (wdev->iftype != NL80211_IFTYPE_STATION && 17542 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 17543 return -EOPNOTSUPP; 17544 17545 if (!wdev->connected) 17546 return -ENOLINK; 17547 17548 val = nla_get_flag(info->attrs[NL80211_ATTR_EPCS]); 17549 17550 return rdev_set_epcs(rdev, dev, val); 17551 } 17552 17553 #define NL80211_FLAG_NEED_WIPHY 0x01 17554 #define NL80211_FLAG_NEED_NETDEV 0x02 17555 #define NL80211_FLAG_NEED_RTNL 0x04 17556 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08 17557 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\ 17558 NL80211_FLAG_CHECK_NETDEV_UP) 17559 #define NL80211_FLAG_NEED_WDEV 0x10 17560 /* If a netdev is associated, it must be UP, P2P must be started */ 17561 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\ 17562 NL80211_FLAG_CHECK_NETDEV_UP) 17563 #define NL80211_FLAG_CLEAR_SKB 0x20 17564 #define NL80211_FLAG_NO_WIPHY_MTX 0x40 17565 #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80 17566 #define NL80211_FLAG_MLO_UNSUPPORTED 0x100 17567 17568 #define INTERNAL_FLAG_SELECTORS(__sel) \ 17569 SELECTOR(__sel, NONE, 0) /* must be first */ \ 17570 SELECTOR(__sel, WIPHY, \ 17571 NL80211_FLAG_NEED_WIPHY) \ 17572 SELECTOR(__sel, WDEV, \ 17573 NL80211_FLAG_NEED_WDEV) \ 17574 SELECTOR(__sel, NETDEV, \ 17575 NL80211_FLAG_NEED_NETDEV) \ 17576 SELECTOR(__sel, NETDEV_LINK, \ 17577 NL80211_FLAG_NEED_NETDEV | \ 17578 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17579 SELECTOR(__sel, NETDEV_NO_MLO, \ 17580 NL80211_FLAG_NEED_NETDEV | \ 17581 NL80211_FLAG_MLO_UNSUPPORTED) \ 17582 SELECTOR(__sel, WIPHY_RTNL, \ 17583 NL80211_FLAG_NEED_WIPHY | \ 17584 NL80211_FLAG_NEED_RTNL) \ 17585 SELECTOR(__sel, WIPHY_RTNL_NOMTX, \ 17586 NL80211_FLAG_NEED_WIPHY | \ 17587 NL80211_FLAG_NEED_RTNL | \ 17588 NL80211_FLAG_NO_WIPHY_MTX) \ 17589 SELECTOR(__sel, WDEV_RTNL, \ 17590 NL80211_FLAG_NEED_WDEV | \ 17591 NL80211_FLAG_NEED_RTNL) \ 17592 SELECTOR(__sel, NETDEV_RTNL, \ 17593 NL80211_FLAG_NEED_NETDEV | \ 17594 NL80211_FLAG_NEED_RTNL) \ 17595 SELECTOR(__sel, NETDEV_UP, \ 17596 NL80211_FLAG_NEED_NETDEV_UP) \ 17597 SELECTOR(__sel, NETDEV_UP_LINK, \ 17598 NL80211_FLAG_NEED_NETDEV_UP | \ 17599 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17600 SELECTOR(__sel, NETDEV_UP_NO_MLO, \ 17601 NL80211_FLAG_NEED_NETDEV_UP | \ 17602 NL80211_FLAG_MLO_UNSUPPORTED) \ 17603 SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \ 17604 NL80211_FLAG_NEED_NETDEV_UP | \ 17605 NL80211_FLAG_CLEAR_SKB | \ 17606 NL80211_FLAG_MLO_UNSUPPORTED) \ 17607 SELECTOR(__sel, NETDEV_UP_NOTMX, \ 17608 NL80211_FLAG_NEED_NETDEV_UP | \ 17609 NL80211_FLAG_NO_WIPHY_MTX) \ 17610 SELECTOR(__sel, NETDEV_UP_NOTMX_MLO, \ 17611 NL80211_FLAG_NEED_NETDEV_UP | \ 17612 NL80211_FLAG_NO_WIPHY_MTX | \ 17613 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17614 SELECTOR(__sel, NETDEV_UP_CLEAR, \ 17615 NL80211_FLAG_NEED_NETDEV_UP | \ 17616 NL80211_FLAG_CLEAR_SKB) \ 17617 SELECTOR(__sel, WDEV_UP, \ 17618 NL80211_FLAG_NEED_WDEV_UP) \ 17619 SELECTOR(__sel, WDEV_UP_LINK, \ 17620 NL80211_FLAG_NEED_WDEV_UP | \ 17621 NL80211_FLAG_MLO_VALID_LINK_ID) \ 17622 SELECTOR(__sel, WDEV_UP_RTNL, \ 17623 NL80211_FLAG_NEED_WDEV_UP | \ 17624 NL80211_FLAG_NEED_RTNL) \ 17625 SELECTOR(__sel, WIPHY_CLEAR, \ 17626 NL80211_FLAG_NEED_WIPHY | \ 17627 NL80211_FLAG_CLEAR_SKB) 17628 17629 enum nl80211_internal_flags_selector { 17630 #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name, 17631 INTERNAL_FLAG_SELECTORS(_) 17632 #undef SELECTOR 17633 }; 17634 17635 static u32 nl80211_internal_flags[] = { 17636 #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value, 17637 INTERNAL_FLAG_SELECTORS(_) 17638 #undef SELECTOR 17639 }; 17640 17641 static int nl80211_pre_doit(const struct genl_split_ops *ops, 17642 struct sk_buff *skb, 17643 struct genl_info *info) 17644 { 17645 struct cfg80211_registered_device *rdev = NULL; 17646 struct wireless_dev *wdev = NULL; 17647 struct net_device *dev = NULL; 17648 u32 internal_flags; 17649 int err; 17650 17651 if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags))) 17652 return -EINVAL; 17653 17654 internal_flags = nl80211_internal_flags[ops->internal_flags]; 17655 17656 rtnl_lock(); 17657 if (internal_flags & NL80211_FLAG_NEED_WIPHY) { 17658 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 17659 if (IS_ERR(rdev)) { 17660 err = PTR_ERR(rdev); 17661 goto out_unlock; 17662 } 17663 info->user_ptr[0] = rdev; 17664 } else if (internal_flags & NL80211_FLAG_NEED_NETDEV || 17665 internal_flags & NL80211_FLAG_NEED_WDEV) { 17666 wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info), 17667 info->attrs); 17668 if (IS_ERR(wdev)) { 17669 err = PTR_ERR(wdev); 17670 goto out_unlock; 17671 } 17672 17673 dev = wdev->netdev; 17674 dev_hold(dev); 17675 rdev = wiphy_to_rdev(wdev->wiphy); 17676 17677 if (internal_flags & NL80211_FLAG_NEED_NETDEV) { 17678 if (!dev) { 17679 err = -EINVAL; 17680 goto out_unlock; 17681 } 17682 17683 info->user_ptr[1] = dev; 17684 } else { 17685 info->user_ptr[1] = wdev; 17686 } 17687 17688 if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP && 17689 !wdev_running(wdev)) { 17690 err = -ENETDOWN; 17691 goto out_unlock; 17692 } 17693 17694 info->user_ptr[0] = rdev; 17695 } 17696 17697 if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) { 17698 struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID]; 17699 17700 if (!wdev) { 17701 err = -EINVAL; 17702 goto out_unlock; 17703 } 17704 17705 /* MLO -> require valid link ID */ 17706 if (wdev->valid_links && 17707 (!link_id || 17708 !(wdev->valid_links & BIT(nla_get_u8(link_id))))) { 17709 err = -EINVAL; 17710 goto out_unlock; 17711 } 17712 17713 /* non-MLO -> no link ID attribute accepted */ 17714 if (!wdev->valid_links && link_id) { 17715 err = -EINVAL; 17716 goto out_unlock; 17717 } 17718 } 17719 17720 if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) { 17721 if (info->attrs[NL80211_ATTR_MLO_LINK_ID] || 17722 (wdev && wdev->valid_links)) { 17723 err = -EINVAL; 17724 goto out_unlock; 17725 } 17726 } 17727 17728 if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 17729 wiphy_lock(&rdev->wiphy); 17730 /* we keep the mutex locked until post_doit */ 17731 __release(&rdev->wiphy.mtx); 17732 } 17733 if (!(internal_flags & NL80211_FLAG_NEED_RTNL)) 17734 rtnl_unlock(); 17735 17736 return 0; 17737 out_unlock: 17738 rtnl_unlock(); 17739 dev_put(dev); 17740 return err; 17741 } 17742 17743 static void nl80211_post_doit(const struct genl_split_ops *ops, 17744 struct sk_buff *skb, 17745 struct genl_info *info) 17746 { 17747 u32 internal_flags = nl80211_internal_flags[ops->internal_flags]; 17748 17749 if (info->user_ptr[1]) { 17750 if (internal_flags & NL80211_FLAG_NEED_WDEV) { 17751 struct wireless_dev *wdev = info->user_ptr[1]; 17752 17753 dev_put(wdev->netdev); 17754 } else { 17755 dev_put(info->user_ptr[1]); 17756 } 17757 } 17758 17759 if (info->user_ptr[0] && 17760 !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 17761 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17762 17763 /* we kept the mutex locked since pre_doit */ 17764 __acquire(&rdev->wiphy.mtx); 17765 wiphy_unlock(&rdev->wiphy); 17766 } 17767 17768 if (internal_flags & NL80211_FLAG_NEED_RTNL) 17769 rtnl_unlock(); 17770 17771 /* If needed, clear the netlink message payload from the SKB 17772 * as it might contain key data that shouldn't stick around on 17773 * the heap after the SKB is freed. The netlink message header 17774 * is still needed for further processing, so leave it intact. 17775 */ 17776 if (internal_flags & NL80211_FLAG_CLEAR_SKB) { 17777 struct nlmsghdr *nlh = nlmsg_hdr(skb); 17778 17779 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh)); 17780 } 17781 } 17782 17783 static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev, 17784 struct cfg80211_sar_specs *sar_specs, 17785 struct nlattr *spec[], int index) 17786 { 17787 u32 range_index, i; 17788 17789 if (!sar_specs || !spec) 17790 return -EINVAL; 17791 17792 if (!spec[NL80211_SAR_ATTR_SPECS_POWER] || 17793 !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]) 17794 return -EINVAL; 17795 17796 range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]); 17797 17798 /* check if range_index exceeds num_freq_ranges */ 17799 if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges) 17800 return -EINVAL; 17801 17802 /* check if range_index duplicates */ 17803 for (i = 0; i < index; i++) { 17804 if (sar_specs->sub_specs[i].freq_range_index == range_index) 17805 return -EINVAL; 17806 } 17807 17808 sar_specs->sub_specs[index].power = 17809 nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]); 17810 17811 sar_specs->sub_specs[index].freq_range_index = range_index; 17812 17813 return 0; 17814 } 17815 17816 static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info) 17817 { 17818 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 17819 struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1]; 17820 struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1]; 17821 struct cfg80211_sar_specs *sar_spec; 17822 enum nl80211_sar_type type; 17823 struct nlattr *spec_list; 17824 u32 specs; 17825 int rem, err; 17826 17827 if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs) 17828 return -EOPNOTSUPP; 17829 17830 if (!info->attrs[NL80211_ATTR_SAR_SPEC]) 17831 return -EINVAL; 17832 17833 nla_parse_nested(tb, NL80211_SAR_ATTR_MAX, 17834 info->attrs[NL80211_ATTR_SAR_SPEC], 17835 NULL, NULL); 17836 17837 if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS]) 17838 return -EINVAL; 17839 17840 type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]); 17841 if (type != rdev->wiphy.sar_capa->type) 17842 return -EINVAL; 17843 17844 specs = 0; 17845 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) 17846 specs++; 17847 17848 if (specs > rdev->wiphy.sar_capa->num_freq_ranges) 17849 return -EINVAL; 17850 17851 sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL); 17852 if (!sar_spec) 17853 return -ENOMEM; 17854 17855 sar_spec->num_sub_specs = specs; 17856 sar_spec->type = type; 17857 specs = 0; 17858 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) { 17859 nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX, 17860 spec_list, NULL, NULL); 17861 17862 switch (type) { 17863 case NL80211_SAR_TYPE_POWER: 17864 if (nl80211_set_sar_sub_specs(rdev, sar_spec, 17865 spec, specs)) { 17866 err = -EINVAL; 17867 goto error; 17868 } 17869 break; 17870 default: 17871 err = -EINVAL; 17872 goto error; 17873 } 17874 specs++; 17875 } 17876 17877 sar_spec->num_sub_specs = specs; 17878 17879 rdev->cur_cmd_info = info; 17880 err = rdev_set_sar_specs(rdev, sar_spec); 17881 rdev->cur_cmd_info = NULL; 17882 error: 17883 kfree(sar_spec); 17884 return err; 17885 } 17886 17887 #define SELECTOR(__sel, name, value) \ 17888 ((__sel) == (value)) ? NL80211_IFL_SEL_##name : 17889 int __missing_selector(void); 17890 #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector() 17891 17892 static const struct genl_ops nl80211_ops[] = { 17893 { 17894 .cmd = NL80211_CMD_GET_WIPHY, 17895 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17896 .doit = nl80211_get_wiphy, 17897 .dumpit = nl80211_dump_wiphy, 17898 .done = nl80211_dump_wiphy_done, 17899 /* can be retrieved by unprivileged users */ 17900 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17901 }, 17902 }; 17903 17904 static const struct genl_small_ops nl80211_small_ops[] = { 17905 { 17906 .cmd = NL80211_CMD_SET_WIPHY, 17907 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17908 .doit = nl80211_set_wiphy, 17909 .flags = GENL_UNS_ADMIN_PERM, 17910 }, 17911 { 17912 .cmd = NL80211_CMD_GET_INTERFACE, 17913 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17914 .doit = nl80211_get_interface, 17915 .dumpit = nl80211_dump_interface, 17916 /* can be retrieved by unprivileged users */ 17917 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 17918 }, 17919 { 17920 .cmd = NL80211_CMD_SET_INTERFACE, 17921 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17922 .doit = nl80211_set_interface, 17923 .flags = GENL_UNS_ADMIN_PERM, 17924 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17925 NL80211_FLAG_NEED_RTNL), 17926 }, 17927 { 17928 .cmd = NL80211_CMD_NEW_INTERFACE, 17929 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17930 .doit = nl80211_new_interface, 17931 .flags = GENL_UNS_ADMIN_PERM, 17932 .internal_flags = 17933 IFLAGS(NL80211_FLAG_NEED_WIPHY | 17934 NL80211_FLAG_NEED_RTNL | 17935 /* we take the wiphy mutex later ourselves */ 17936 NL80211_FLAG_NO_WIPHY_MTX), 17937 }, 17938 { 17939 .cmd = NL80211_CMD_DEL_INTERFACE, 17940 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17941 .doit = nl80211_del_interface, 17942 .flags = GENL_UNS_ADMIN_PERM, 17943 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17944 NL80211_FLAG_NEED_RTNL), 17945 }, 17946 { 17947 .cmd = NL80211_CMD_GET_KEY, 17948 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17949 .doit = nl80211_get_key, 17950 .flags = GENL_UNS_ADMIN_PERM, 17951 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17952 }, 17953 { 17954 .cmd = NL80211_CMD_SET_KEY, 17955 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17956 .doit = nl80211_set_key, 17957 .flags = GENL_UNS_ADMIN_PERM, 17958 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */ 17959 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17960 NL80211_FLAG_CLEAR_SKB), 17961 }, 17962 { 17963 .cmd = NL80211_CMD_NEW_KEY, 17964 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17965 .doit = nl80211_new_key, 17966 .flags = GENL_UNS_ADMIN_PERM, 17967 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17968 NL80211_FLAG_CLEAR_SKB), 17969 }, 17970 { 17971 .cmd = NL80211_CMD_DEL_KEY, 17972 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17973 .doit = nl80211_del_key, 17974 .flags = GENL_UNS_ADMIN_PERM, 17975 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17976 }, 17977 { 17978 .cmd = NL80211_CMD_SET_BEACON, 17979 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17980 .flags = GENL_UNS_ADMIN_PERM, 17981 .doit = nl80211_set_beacon, 17982 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17983 NL80211_FLAG_MLO_VALID_LINK_ID), 17984 }, 17985 { 17986 .cmd = NL80211_CMD_START_AP, 17987 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17988 .flags = GENL_UNS_ADMIN_PERM, 17989 .doit = nl80211_start_ap, 17990 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17991 NL80211_FLAG_MLO_VALID_LINK_ID), 17992 }, 17993 { 17994 .cmd = NL80211_CMD_STOP_AP, 17995 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17996 .flags = GENL_UNS_ADMIN_PERM, 17997 .doit = nl80211_stop_ap, 17998 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17999 NL80211_FLAG_MLO_VALID_LINK_ID), 18000 }, 18001 { 18002 .cmd = NL80211_CMD_GET_STATION, 18003 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18004 .doit = nl80211_get_station, 18005 .dumpit = nl80211_dump_station, 18006 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18007 }, 18008 { 18009 .cmd = NL80211_CMD_SET_STATION, 18010 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18011 .doit = nl80211_set_station, 18012 .flags = GENL_UNS_ADMIN_PERM, 18013 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18014 }, 18015 { 18016 .cmd = NL80211_CMD_NEW_STATION, 18017 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18018 .doit = nl80211_new_station, 18019 .flags = GENL_UNS_ADMIN_PERM, 18020 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18021 }, 18022 { 18023 .cmd = NL80211_CMD_DEL_STATION, 18024 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18025 .doit = nl80211_del_station, 18026 .flags = GENL_UNS_ADMIN_PERM, 18027 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on 18028 * whether MAC address is passed or not. If MAC address is 18029 * passed, then even during MLO, link ID is not required. 18030 */ 18031 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18032 }, 18033 { 18034 .cmd = NL80211_CMD_GET_MPATH, 18035 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18036 .doit = nl80211_get_mpath, 18037 .dumpit = nl80211_dump_mpath, 18038 .flags = GENL_UNS_ADMIN_PERM, 18039 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18040 }, 18041 { 18042 .cmd = NL80211_CMD_GET_MPP, 18043 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18044 .doit = nl80211_get_mpp, 18045 .dumpit = nl80211_dump_mpp, 18046 .flags = GENL_UNS_ADMIN_PERM, 18047 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18048 }, 18049 { 18050 .cmd = NL80211_CMD_SET_MPATH, 18051 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18052 .doit = nl80211_set_mpath, 18053 .flags = GENL_UNS_ADMIN_PERM, 18054 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18055 }, 18056 { 18057 .cmd = NL80211_CMD_NEW_MPATH, 18058 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18059 .doit = nl80211_new_mpath, 18060 .flags = GENL_UNS_ADMIN_PERM, 18061 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18062 }, 18063 { 18064 .cmd = NL80211_CMD_DEL_MPATH, 18065 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18066 .doit = nl80211_del_mpath, 18067 .flags = GENL_UNS_ADMIN_PERM, 18068 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18069 }, 18070 { 18071 .cmd = NL80211_CMD_SET_BSS, 18072 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18073 .doit = nl80211_set_bss, 18074 .flags = GENL_UNS_ADMIN_PERM, 18075 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18076 NL80211_FLAG_MLO_VALID_LINK_ID), 18077 }, 18078 { 18079 .cmd = NL80211_CMD_GET_REG, 18080 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18081 .doit = nl80211_get_reg_do, 18082 .dumpit = nl80211_get_reg_dump, 18083 /* can be retrieved by unprivileged users */ 18084 }, 18085 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 18086 { 18087 .cmd = NL80211_CMD_SET_REG, 18088 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18089 .doit = nl80211_set_reg, 18090 .flags = GENL_ADMIN_PERM, 18091 }, 18092 #endif 18093 { 18094 .cmd = NL80211_CMD_REQ_SET_REG, 18095 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18096 .doit = nl80211_req_set_reg, 18097 .flags = GENL_ADMIN_PERM, 18098 }, 18099 { 18100 .cmd = NL80211_CMD_RELOAD_REGDB, 18101 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18102 .doit = nl80211_reload_regdb, 18103 .flags = GENL_ADMIN_PERM, 18104 }, 18105 { 18106 .cmd = NL80211_CMD_GET_MESH_CONFIG, 18107 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18108 .doit = nl80211_get_mesh_config, 18109 /* can be retrieved by unprivileged users */ 18110 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18111 }, 18112 { 18113 .cmd = NL80211_CMD_SET_MESH_CONFIG, 18114 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18115 .doit = nl80211_update_mesh_config, 18116 .flags = GENL_UNS_ADMIN_PERM, 18117 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18118 }, 18119 { 18120 .cmd = NL80211_CMD_TRIGGER_SCAN, 18121 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18122 .doit = nl80211_trigger_scan, 18123 .flags = GENL_UNS_ADMIN_PERM, 18124 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18125 }, 18126 { 18127 .cmd = NL80211_CMD_ABORT_SCAN, 18128 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18129 .doit = nl80211_abort_scan, 18130 .flags = GENL_UNS_ADMIN_PERM, 18131 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18132 }, 18133 { 18134 .cmd = NL80211_CMD_GET_SCAN, 18135 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18136 .dumpit = nl80211_dump_scan, 18137 }, 18138 { 18139 .cmd = NL80211_CMD_START_SCHED_SCAN, 18140 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18141 .doit = nl80211_start_sched_scan, 18142 .flags = GENL_UNS_ADMIN_PERM, 18143 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18144 }, 18145 { 18146 .cmd = NL80211_CMD_STOP_SCHED_SCAN, 18147 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18148 .doit = nl80211_stop_sched_scan, 18149 .flags = GENL_UNS_ADMIN_PERM, 18150 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18151 }, 18152 { 18153 .cmd = NL80211_CMD_AUTHENTICATE, 18154 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18155 .doit = nl80211_authenticate, 18156 .flags = GENL_UNS_ADMIN_PERM, 18157 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18158 NL80211_FLAG_CLEAR_SKB), 18159 }, 18160 { 18161 .cmd = NL80211_CMD_ASSOCIATE, 18162 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18163 .doit = nl80211_associate, 18164 .flags = GENL_UNS_ADMIN_PERM, 18165 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18166 NL80211_FLAG_CLEAR_SKB), 18167 }, 18168 { 18169 .cmd = NL80211_CMD_DEAUTHENTICATE, 18170 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18171 .doit = nl80211_deauthenticate, 18172 .flags = GENL_UNS_ADMIN_PERM, 18173 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18174 }, 18175 { 18176 .cmd = NL80211_CMD_DISASSOCIATE, 18177 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18178 .doit = nl80211_disassociate, 18179 .flags = GENL_UNS_ADMIN_PERM, 18180 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18181 }, 18182 { 18183 .cmd = NL80211_CMD_JOIN_IBSS, 18184 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18185 .doit = nl80211_join_ibss, 18186 .flags = GENL_UNS_ADMIN_PERM, 18187 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18188 }, 18189 { 18190 .cmd = NL80211_CMD_LEAVE_IBSS, 18191 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18192 .doit = nl80211_leave_ibss, 18193 .flags = GENL_UNS_ADMIN_PERM, 18194 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18195 }, 18196 #ifdef CONFIG_NL80211_TESTMODE 18197 { 18198 .cmd = NL80211_CMD_TESTMODE, 18199 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18200 .doit = nl80211_testmode_do, 18201 .dumpit = nl80211_testmode_dump, 18202 .flags = GENL_UNS_ADMIN_PERM, 18203 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18204 }, 18205 #endif 18206 { 18207 .cmd = NL80211_CMD_CONNECT, 18208 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18209 .doit = nl80211_connect, 18210 .flags = GENL_UNS_ADMIN_PERM, 18211 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18212 NL80211_FLAG_CLEAR_SKB), 18213 }, 18214 { 18215 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS, 18216 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18217 .doit = nl80211_update_connect_params, 18218 .flags = GENL_ADMIN_PERM, 18219 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18220 NL80211_FLAG_CLEAR_SKB), 18221 }, 18222 { 18223 .cmd = NL80211_CMD_DISCONNECT, 18224 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18225 .doit = nl80211_disconnect, 18226 .flags = GENL_UNS_ADMIN_PERM, 18227 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18228 }, 18229 { 18230 .cmd = NL80211_CMD_SET_WIPHY_NETNS, 18231 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18232 .doit = nl80211_wiphy_netns, 18233 .flags = GENL_UNS_ADMIN_PERM, 18234 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 18235 NL80211_FLAG_NEED_RTNL | 18236 NL80211_FLAG_NO_WIPHY_MTX), 18237 }, 18238 { 18239 .cmd = NL80211_CMD_GET_SURVEY, 18240 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18241 .dumpit = nl80211_dump_survey, 18242 }, 18243 { 18244 .cmd = NL80211_CMD_SET_PMKSA, 18245 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18246 .doit = nl80211_set_pmksa, 18247 .flags = GENL_UNS_ADMIN_PERM, 18248 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18249 NL80211_FLAG_CLEAR_SKB), 18250 }, 18251 { 18252 .cmd = NL80211_CMD_DEL_PMKSA, 18253 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18254 .doit = nl80211_del_pmksa, 18255 .flags = GENL_UNS_ADMIN_PERM, 18256 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18257 }, 18258 { 18259 .cmd = NL80211_CMD_FLUSH_PMKSA, 18260 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18261 .doit = nl80211_flush_pmksa, 18262 .flags = GENL_UNS_ADMIN_PERM, 18263 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18264 }, 18265 { 18266 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL, 18267 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18268 .doit = nl80211_remain_on_channel, 18269 .flags = GENL_UNS_ADMIN_PERM, 18270 /* FIXME: requiring a link ID here is probably not good */ 18271 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 18272 NL80211_FLAG_MLO_VALID_LINK_ID), 18273 }, 18274 { 18275 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 18276 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18277 .doit = nl80211_cancel_remain_on_channel, 18278 .flags = GENL_UNS_ADMIN_PERM, 18279 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18280 }, 18281 { 18282 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK, 18283 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18284 .doit = nl80211_set_tx_bitrate_mask, 18285 .flags = GENL_UNS_ADMIN_PERM, 18286 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18287 NL80211_FLAG_MLO_VALID_LINK_ID), 18288 }, 18289 { 18290 .cmd = NL80211_CMD_REGISTER_FRAME, 18291 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18292 .doit = nl80211_register_mgmt, 18293 .flags = GENL_UNS_ADMIN_PERM, 18294 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 18295 }, 18296 { 18297 .cmd = NL80211_CMD_FRAME, 18298 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18299 .doit = nl80211_tx_mgmt, 18300 .flags = GENL_UNS_ADMIN_PERM, 18301 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18302 }, 18303 { 18304 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL, 18305 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18306 .doit = nl80211_tx_mgmt_cancel_wait, 18307 .flags = GENL_UNS_ADMIN_PERM, 18308 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18309 }, 18310 { 18311 .cmd = NL80211_CMD_SET_POWER_SAVE, 18312 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18313 .doit = nl80211_set_power_save, 18314 .flags = GENL_UNS_ADMIN_PERM, 18315 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18316 }, 18317 { 18318 .cmd = NL80211_CMD_GET_POWER_SAVE, 18319 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18320 .doit = nl80211_get_power_save, 18321 /* can be retrieved by unprivileged users */ 18322 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18323 }, 18324 { 18325 .cmd = NL80211_CMD_SET_CQM, 18326 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18327 .doit = nl80211_set_cqm, 18328 .flags = GENL_UNS_ADMIN_PERM, 18329 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18330 }, 18331 { 18332 .cmd = NL80211_CMD_SET_CHANNEL, 18333 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18334 .doit = nl80211_set_channel, 18335 .flags = GENL_UNS_ADMIN_PERM, 18336 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18337 NL80211_FLAG_MLO_VALID_LINK_ID), 18338 }, 18339 { 18340 .cmd = NL80211_CMD_JOIN_MESH, 18341 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18342 .doit = nl80211_join_mesh, 18343 .flags = GENL_UNS_ADMIN_PERM, 18344 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18345 }, 18346 { 18347 .cmd = NL80211_CMD_LEAVE_MESH, 18348 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18349 .doit = nl80211_leave_mesh, 18350 .flags = GENL_UNS_ADMIN_PERM, 18351 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18352 }, 18353 { 18354 .cmd = NL80211_CMD_JOIN_OCB, 18355 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18356 .doit = nl80211_join_ocb, 18357 .flags = GENL_UNS_ADMIN_PERM, 18358 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18359 }, 18360 { 18361 .cmd = NL80211_CMD_LEAVE_OCB, 18362 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18363 .doit = nl80211_leave_ocb, 18364 .flags = GENL_UNS_ADMIN_PERM, 18365 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18366 }, 18367 #ifdef CONFIG_PM 18368 { 18369 .cmd = NL80211_CMD_GET_WOWLAN, 18370 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18371 .doit = nl80211_get_wowlan, 18372 /* can be retrieved by unprivileged users */ 18373 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18374 }, 18375 { 18376 .cmd = NL80211_CMD_SET_WOWLAN, 18377 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18378 .doit = nl80211_set_wowlan, 18379 .flags = GENL_UNS_ADMIN_PERM, 18380 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18381 }, 18382 #endif 18383 { 18384 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD, 18385 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18386 .doit = nl80211_set_rekey_data, 18387 .flags = GENL_UNS_ADMIN_PERM, 18388 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18389 NL80211_FLAG_CLEAR_SKB), 18390 }, 18391 { 18392 .cmd = NL80211_CMD_TDLS_MGMT, 18393 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18394 .doit = nl80211_tdls_mgmt, 18395 .flags = GENL_UNS_ADMIN_PERM, 18396 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18397 NL80211_FLAG_MLO_VALID_LINK_ID), 18398 }, 18399 { 18400 .cmd = NL80211_CMD_TDLS_OPER, 18401 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18402 .doit = nl80211_tdls_oper, 18403 .flags = GENL_UNS_ADMIN_PERM, 18404 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18405 }, 18406 { 18407 .cmd = NL80211_CMD_UNEXPECTED_FRAME, 18408 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18409 .doit = nl80211_register_unexpected_frame, 18410 .flags = GENL_UNS_ADMIN_PERM, 18411 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18412 }, 18413 { 18414 .cmd = NL80211_CMD_PROBE_CLIENT, 18415 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18416 .doit = nl80211_probe_client, 18417 .flags = GENL_UNS_ADMIN_PERM, 18418 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18419 }, 18420 { 18421 .cmd = NL80211_CMD_REGISTER_BEACONS, 18422 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18423 .doit = nl80211_register_beacons, 18424 .flags = GENL_UNS_ADMIN_PERM, 18425 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18426 }, 18427 { 18428 .cmd = NL80211_CMD_SET_NOACK_MAP, 18429 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18430 .doit = nl80211_set_noack_map, 18431 .flags = GENL_UNS_ADMIN_PERM, 18432 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18433 }, 18434 { 18435 .cmd = NL80211_CMD_START_P2P_DEVICE, 18436 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18437 .doit = nl80211_start_p2p_device, 18438 .flags = GENL_UNS_ADMIN_PERM, 18439 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 18440 NL80211_FLAG_NEED_RTNL), 18441 }, 18442 { 18443 .cmd = NL80211_CMD_STOP_P2P_DEVICE, 18444 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18445 .doit = nl80211_stop_p2p_device, 18446 .flags = GENL_UNS_ADMIN_PERM, 18447 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 18448 NL80211_FLAG_NEED_RTNL), 18449 }, 18450 { 18451 .cmd = NL80211_CMD_START_NAN, 18452 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18453 .doit = nl80211_start_nan, 18454 .flags = GENL_ADMIN_PERM, 18455 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 18456 NL80211_FLAG_NEED_RTNL), 18457 }, 18458 { 18459 .cmd = NL80211_CMD_STOP_NAN, 18460 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18461 .doit = nl80211_stop_nan, 18462 .flags = GENL_ADMIN_PERM, 18463 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 18464 NL80211_FLAG_NEED_RTNL), 18465 }, 18466 { 18467 .cmd = NL80211_CMD_ADD_NAN_FUNCTION, 18468 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18469 .doit = nl80211_nan_add_func, 18470 .flags = GENL_ADMIN_PERM, 18471 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18472 }, 18473 { 18474 .cmd = NL80211_CMD_DEL_NAN_FUNCTION, 18475 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18476 .doit = nl80211_nan_del_func, 18477 .flags = GENL_ADMIN_PERM, 18478 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18479 }, 18480 { 18481 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG, 18482 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18483 .doit = nl80211_nan_change_config, 18484 .flags = GENL_ADMIN_PERM, 18485 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18486 }, 18487 { 18488 .cmd = NL80211_CMD_SET_MCAST_RATE, 18489 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18490 .doit = nl80211_set_mcast_rate, 18491 .flags = GENL_UNS_ADMIN_PERM, 18492 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18493 }, 18494 { 18495 .cmd = NL80211_CMD_SET_MAC_ACL, 18496 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18497 .doit = nl80211_set_mac_acl, 18498 .flags = GENL_UNS_ADMIN_PERM, 18499 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18500 NL80211_FLAG_MLO_UNSUPPORTED), 18501 }, 18502 { 18503 .cmd = NL80211_CMD_RADAR_DETECT, 18504 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18505 .doit = nl80211_start_radar_detection, 18506 .flags = GENL_UNS_ADMIN_PERM, 18507 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18508 NL80211_FLAG_NO_WIPHY_MTX | 18509 NL80211_FLAG_MLO_VALID_LINK_ID), 18510 }, 18511 { 18512 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES, 18513 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18514 .doit = nl80211_get_protocol_features, 18515 }, 18516 { 18517 .cmd = NL80211_CMD_UPDATE_FT_IES, 18518 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18519 .doit = nl80211_update_ft_ies, 18520 .flags = GENL_UNS_ADMIN_PERM, 18521 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18522 }, 18523 { 18524 .cmd = NL80211_CMD_CRIT_PROTOCOL_START, 18525 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18526 .doit = nl80211_crit_protocol_start, 18527 .flags = GENL_UNS_ADMIN_PERM, 18528 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18529 }, 18530 { 18531 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP, 18532 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18533 .doit = nl80211_crit_protocol_stop, 18534 .flags = GENL_UNS_ADMIN_PERM, 18535 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18536 }, 18537 { 18538 .cmd = NL80211_CMD_GET_COALESCE, 18539 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18540 .doit = nl80211_get_coalesce, 18541 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18542 }, 18543 { 18544 .cmd = NL80211_CMD_SET_COALESCE, 18545 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18546 .doit = nl80211_set_coalesce, 18547 .flags = GENL_UNS_ADMIN_PERM, 18548 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 18549 }, 18550 { 18551 .cmd = NL80211_CMD_CHANNEL_SWITCH, 18552 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18553 .doit = nl80211_channel_switch, 18554 .flags = GENL_UNS_ADMIN_PERM, 18555 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18556 NL80211_FLAG_MLO_VALID_LINK_ID), 18557 }, 18558 { 18559 .cmd = NL80211_CMD_VENDOR, 18560 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18561 .doit = nl80211_vendor_cmd, 18562 .dumpit = nl80211_vendor_cmd_dump, 18563 .flags = GENL_UNS_ADMIN_PERM, 18564 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 18565 NL80211_FLAG_CLEAR_SKB), 18566 }, 18567 { 18568 .cmd = NL80211_CMD_SET_QOS_MAP, 18569 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18570 .doit = nl80211_set_qos_map, 18571 .flags = GENL_UNS_ADMIN_PERM, 18572 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18573 }, 18574 { 18575 .cmd = NL80211_CMD_ADD_TX_TS, 18576 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18577 .doit = nl80211_add_tx_ts, 18578 .flags = GENL_UNS_ADMIN_PERM, 18579 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18580 NL80211_FLAG_MLO_UNSUPPORTED), 18581 }, 18582 { 18583 .cmd = NL80211_CMD_DEL_TX_TS, 18584 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18585 .doit = nl80211_del_tx_ts, 18586 .flags = GENL_UNS_ADMIN_PERM, 18587 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18588 }, 18589 { 18590 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH, 18591 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18592 .doit = nl80211_tdls_channel_switch, 18593 .flags = GENL_UNS_ADMIN_PERM, 18594 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18595 }, 18596 { 18597 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH, 18598 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18599 .doit = nl80211_tdls_cancel_channel_switch, 18600 .flags = GENL_UNS_ADMIN_PERM, 18601 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18602 }, 18603 { 18604 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST, 18605 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18606 .doit = nl80211_set_multicast_to_unicast, 18607 .flags = GENL_UNS_ADMIN_PERM, 18608 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 18609 }, 18610 { 18611 .cmd = NL80211_CMD_SET_PMK, 18612 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18613 .doit = nl80211_set_pmk, 18614 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18615 NL80211_FLAG_CLEAR_SKB), 18616 }, 18617 { 18618 .cmd = NL80211_CMD_DEL_PMK, 18619 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18620 .doit = nl80211_del_pmk, 18621 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18622 }, 18623 { 18624 .cmd = NL80211_CMD_EXTERNAL_AUTH, 18625 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18626 .doit = nl80211_external_auth, 18627 .flags = GENL_ADMIN_PERM, 18628 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18629 }, 18630 { 18631 .cmd = NL80211_CMD_CONTROL_PORT_FRAME, 18632 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18633 .doit = nl80211_tx_control_port, 18634 .flags = GENL_UNS_ADMIN_PERM, 18635 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18636 }, 18637 { 18638 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS, 18639 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18640 .doit = nl80211_get_ftm_responder_stats, 18641 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18642 NL80211_FLAG_MLO_VALID_LINK_ID), 18643 }, 18644 { 18645 .cmd = NL80211_CMD_PEER_MEASUREMENT_START, 18646 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18647 .doit = nl80211_pmsr_start, 18648 .flags = GENL_UNS_ADMIN_PERM, 18649 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 18650 }, 18651 { 18652 .cmd = NL80211_CMD_NOTIFY_RADAR, 18653 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18654 .doit = nl80211_notify_radar_detection, 18655 .flags = GENL_UNS_ADMIN_PERM, 18656 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18657 }, 18658 { 18659 .cmd = NL80211_CMD_UPDATE_OWE_INFO, 18660 .doit = nl80211_update_owe_info, 18661 .flags = GENL_ADMIN_PERM, 18662 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18663 }, 18664 { 18665 .cmd = NL80211_CMD_PROBE_MESH_LINK, 18666 .doit = nl80211_probe_mesh_link, 18667 .flags = GENL_UNS_ADMIN_PERM, 18668 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18669 }, 18670 { 18671 .cmd = NL80211_CMD_SET_TID_CONFIG, 18672 .doit = nl80211_set_tid_config, 18673 .flags = GENL_UNS_ADMIN_PERM, 18674 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 18675 NL80211_FLAG_MLO_VALID_LINK_ID), 18676 }, 18677 { 18678 .cmd = NL80211_CMD_SET_SAR_SPECS, 18679 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18680 .doit = nl80211_set_sar_specs, 18681 .flags = GENL_UNS_ADMIN_PERM, 18682 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 18683 NL80211_FLAG_NEED_RTNL), 18684 }, 18685 { 18686 .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST, 18687 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18688 .doit = nl80211_color_change, 18689 .flags = GENL_UNS_ADMIN_PERM, 18690 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18691 NL80211_FLAG_MLO_VALID_LINK_ID), 18692 }, 18693 { 18694 .cmd = NL80211_CMD_SET_FILS_AAD, 18695 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 18696 .doit = nl80211_set_fils_aad, 18697 .flags = GENL_UNS_ADMIN_PERM, 18698 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18699 }, 18700 { 18701 .cmd = NL80211_CMD_ADD_LINK, 18702 .doit = nl80211_add_link, 18703 .flags = GENL_UNS_ADMIN_PERM, 18704 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18705 }, 18706 { 18707 .cmd = NL80211_CMD_REMOVE_LINK, 18708 .doit = nl80211_remove_link, 18709 .flags = GENL_UNS_ADMIN_PERM, 18710 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18711 NL80211_FLAG_MLO_VALID_LINK_ID), 18712 }, 18713 { 18714 .cmd = NL80211_CMD_ADD_LINK_STA, 18715 .doit = nl80211_add_link_station, 18716 .flags = GENL_UNS_ADMIN_PERM, 18717 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18718 NL80211_FLAG_MLO_VALID_LINK_ID), 18719 }, 18720 { 18721 .cmd = NL80211_CMD_MODIFY_LINK_STA, 18722 .doit = nl80211_modify_link_station, 18723 .flags = GENL_UNS_ADMIN_PERM, 18724 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18725 NL80211_FLAG_MLO_VALID_LINK_ID), 18726 }, 18727 { 18728 .cmd = NL80211_CMD_REMOVE_LINK_STA, 18729 .doit = nl80211_remove_link_station, 18730 .flags = GENL_UNS_ADMIN_PERM, 18731 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 18732 NL80211_FLAG_MLO_VALID_LINK_ID), 18733 }, 18734 { 18735 .cmd = NL80211_CMD_SET_HW_TIMESTAMP, 18736 .doit = nl80211_set_hw_timestamp, 18737 .flags = GENL_UNS_ADMIN_PERM, 18738 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18739 }, 18740 { 18741 .cmd = NL80211_CMD_SET_TID_TO_LINK_MAPPING, 18742 .doit = nl80211_set_ttlm, 18743 .flags = GENL_UNS_ADMIN_PERM, 18744 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18745 }, 18746 { 18747 .cmd = NL80211_CMD_ASSOC_MLO_RECONF, 18748 .doit = nl80211_assoc_ml_reconf, 18749 .flags = GENL_UNS_ADMIN_PERM, 18750 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18751 }, 18752 { 18753 .cmd = NL80211_CMD_EPCS_CFG, 18754 .doit = nl80211_epcs_cfg, 18755 .flags = GENL_UNS_ADMIN_PERM, 18756 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 18757 }, 18758 }; 18759 18760 static struct genl_family nl80211_fam __ro_after_init = { 18761 .name = NL80211_GENL_NAME, /* have users key off the name instead */ 18762 .hdrsize = 0, /* no private header */ 18763 .version = 1, /* no particular meaning now */ 18764 .maxattr = NL80211_ATTR_MAX, 18765 .policy = nl80211_policy, 18766 .netnsok = true, 18767 .pre_doit = nl80211_pre_doit, 18768 .post_doit = nl80211_post_doit, 18769 .module = THIS_MODULE, 18770 .ops = nl80211_ops, 18771 .n_ops = ARRAY_SIZE(nl80211_ops), 18772 .small_ops = nl80211_small_ops, 18773 .n_small_ops = ARRAY_SIZE(nl80211_small_ops), 18774 .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1, 18775 .mcgrps = nl80211_mcgrps, 18776 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps), 18777 .parallel_ops = true, 18778 }; 18779 18780 /* notification functions */ 18781 18782 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev, 18783 enum nl80211_commands cmd) 18784 { 18785 struct sk_buff *msg; 18786 struct nl80211_dump_wiphy_state state = {}; 18787 18788 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY && 18789 cmd != NL80211_CMD_DEL_WIPHY); 18790 18791 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18792 if (!msg) 18793 return; 18794 18795 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) { 18796 nlmsg_free(msg); 18797 return; 18798 } 18799 18800 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18801 NL80211_MCGRP_CONFIG, GFP_KERNEL); 18802 } 18803 18804 void nl80211_notify_iface(struct cfg80211_registered_device *rdev, 18805 struct wireless_dev *wdev, 18806 enum nl80211_commands cmd) 18807 { 18808 struct sk_buff *msg; 18809 18810 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18811 if (!msg) 18812 return; 18813 18814 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) { 18815 nlmsg_free(msg); 18816 return; 18817 } 18818 18819 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18820 NL80211_MCGRP_CONFIG, GFP_KERNEL); 18821 } 18822 18823 static int nl80211_add_scan_req(struct sk_buff *msg, 18824 struct cfg80211_registered_device *rdev) 18825 { 18826 struct cfg80211_scan_request_int *req = rdev->scan_req; 18827 struct nlattr *nest; 18828 int i; 18829 struct cfg80211_scan_info *info; 18830 18831 if (WARN_ON(!req)) 18832 return 0; 18833 18834 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS); 18835 if (!nest) 18836 goto nla_put_failure; 18837 for (i = 0; i < req->req.n_ssids; i++) { 18838 if (nla_put(msg, i, req->req.ssids[i].ssid_len, 18839 req->req.ssids[i].ssid)) 18840 goto nla_put_failure; 18841 } 18842 nla_nest_end(msg, nest); 18843 18844 if (req->req.flags & NL80211_SCAN_FLAG_FREQ_KHZ) { 18845 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ); 18846 if (!nest) 18847 goto nla_put_failure; 18848 for (i = 0; i < req->req.n_channels; i++) { 18849 if (nla_put_u32(msg, i, 18850 ieee80211_channel_to_khz(req->req.channels[i]))) 18851 goto nla_put_failure; 18852 } 18853 nla_nest_end(msg, nest); 18854 } else { 18855 nest = nla_nest_start_noflag(msg, 18856 NL80211_ATTR_SCAN_FREQUENCIES); 18857 if (!nest) 18858 goto nla_put_failure; 18859 for (i = 0; i < req->req.n_channels; i++) { 18860 if (nla_put_u32(msg, i, 18861 req->req.channels[i]->center_freq)) 18862 goto nla_put_failure; 18863 } 18864 nla_nest_end(msg, nest); 18865 } 18866 18867 if (req->req.ie && 18868 nla_put(msg, NL80211_ATTR_IE, req->req.ie_len, req->req.ie)) 18869 goto nla_put_failure; 18870 18871 if (req->req.flags && 18872 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->req.flags)) 18873 goto nla_put_failure; 18874 18875 info = rdev->int_scan_req ? &rdev->int_scan_req->info : 18876 &rdev->scan_req->info; 18877 if (info->scan_start_tsf && 18878 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF, 18879 info->scan_start_tsf, NL80211_BSS_PAD) || 18880 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN, 18881 info->tsf_bssid))) 18882 goto nla_put_failure; 18883 18884 return 0; 18885 nla_put_failure: 18886 return -ENOBUFS; 18887 } 18888 18889 static int nl80211_prep_scan_msg(struct sk_buff *msg, 18890 struct cfg80211_registered_device *rdev, 18891 struct wireless_dev *wdev, 18892 u32 portid, u32 seq, int flags, 18893 u32 cmd) 18894 { 18895 void *hdr; 18896 18897 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 18898 if (!hdr) 18899 return -1; 18900 18901 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18902 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18903 wdev->netdev->ifindex)) || 18904 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18905 NL80211_ATTR_PAD)) 18906 goto nla_put_failure; 18907 18908 /* ignore errors and send incomplete event anyway */ 18909 nl80211_add_scan_req(msg, rdev); 18910 18911 genlmsg_end(msg, hdr); 18912 return 0; 18913 18914 nla_put_failure: 18915 genlmsg_cancel(msg, hdr); 18916 return -EMSGSIZE; 18917 } 18918 18919 static int 18920 nl80211_prep_sched_scan_msg(struct sk_buff *msg, 18921 struct cfg80211_sched_scan_request *req, u32 cmd) 18922 { 18923 void *hdr; 18924 18925 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18926 if (!hdr) 18927 return -1; 18928 18929 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, 18930 wiphy_to_rdev(req->wiphy)->wiphy_idx) || 18931 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) || 18932 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid, 18933 NL80211_ATTR_PAD)) 18934 goto nla_put_failure; 18935 18936 genlmsg_end(msg, hdr); 18937 return 0; 18938 18939 nla_put_failure: 18940 genlmsg_cancel(msg, hdr); 18941 return -EMSGSIZE; 18942 } 18943 18944 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev, 18945 struct wireless_dev *wdev) 18946 { 18947 struct sk_buff *msg; 18948 18949 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18950 if (!msg) 18951 return; 18952 18953 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 18954 NL80211_CMD_TRIGGER_SCAN) < 0) { 18955 nlmsg_free(msg); 18956 return; 18957 } 18958 18959 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18960 NL80211_MCGRP_SCAN, GFP_KERNEL); 18961 } 18962 18963 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev, 18964 struct wireless_dev *wdev, bool aborted) 18965 { 18966 struct sk_buff *msg; 18967 18968 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18969 if (!msg) 18970 return NULL; 18971 18972 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 18973 aborted ? NL80211_CMD_SCAN_ABORTED : 18974 NL80211_CMD_NEW_SCAN_RESULTS) < 0) { 18975 nlmsg_free(msg); 18976 return NULL; 18977 } 18978 18979 return msg; 18980 } 18981 18982 /* send message created by nl80211_build_scan_msg() */ 18983 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev, 18984 struct sk_buff *msg) 18985 { 18986 if (!msg) 18987 return; 18988 18989 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18990 NL80211_MCGRP_SCAN, GFP_KERNEL); 18991 } 18992 18993 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd) 18994 { 18995 struct sk_buff *msg; 18996 18997 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18998 if (!msg) 18999 return; 19000 19001 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) { 19002 nlmsg_free(msg); 19003 return; 19004 } 19005 19006 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0, 19007 NL80211_MCGRP_SCAN, GFP_KERNEL); 19008 } 19009 19010 static bool nl80211_reg_change_event_fill(struct sk_buff *msg, 19011 struct regulatory_request *request) 19012 { 19013 /* Userspace can always count this one always being set */ 19014 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator)) 19015 goto nla_put_failure; 19016 19017 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') { 19018 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19019 NL80211_REGDOM_TYPE_WORLD)) 19020 goto nla_put_failure; 19021 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') { 19022 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19023 NL80211_REGDOM_TYPE_CUSTOM_WORLD)) 19024 goto nla_put_failure; 19025 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') || 19026 request->intersect) { 19027 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19028 NL80211_REGDOM_TYPE_INTERSECTION)) 19029 goto nla_put_failure; 19030 } else { 19031 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 19032 NL80211_REGDOM_TYPE_COUNTRY) || 19033 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, 19034 request->alpha2)) 19035 goto nla_put_failure; 19036 } 19037 19038 if (request->wiphy_idx != WIPHY_IDX_INVALID) { 19039 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx); 19040 19041 if (wiphy && 19042 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx)) 19043 goto nla_put_failure; 19044 19045 if (wiphy && 19046 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 19047 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 19048 goto nla_put_failure; 19049 } 19050 19051 return true; 19052 19053 nla_put_failure: 19054 return false; 19055 } 19056 19057 /* 19058 * This can happen on global regulatory changes or device specific settings 19059 * based on custom regulatory domains. 19060 */ 19061 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id, 19062 struct regulatory_request *request) 19063 { 19064 struct sk_buff *msg; 19065 void *hdr; 19066 19067 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19068 if (!msg) 19069 return; 19070 19071 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id); 19072 if (!hdr) 19073 goto nla_put_failure; 19074 19075 if (!nl80211_reg_change_event_fill(msg, request)) 19076 goto nla_put_failure; 19077 19078 genlmsg_end(msg, hdr); 19079 19080 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 19081 NL80211_MCGRP_REGULATORY); 19082 19083 return; 19084 19085 nla_put_failure: 19086 nlmsg_free(msg); 19087 } 19088 19089 struct nl80211_mlme_event { 19090 enum nl80211_commands cmd; 19091 const u8 *buf; 19092 size_t buf_len; 19093 int uapsd_queues; 19094 const u8 *req_ies; 19095 size_t req_ies_len; 19096 bool reconnect; 19097 }; 19098 19099 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev, 19100 struct net_device *netdev, 19101 const struct nl80211_mlme_event *event, 19102 gfp_t gfp) 19103 { 19104 struct sk_buff *msg; 19105 void *hdr; 19106 19107 msg = nlmsg_new(100 + event->buf_len + event->req_ies_len, gfp); 19108 if (!msg) 19109 return; 19110 19111 hdr = nl80211hdr_put(msg, 0, 0, 0, event->cmd); 19112 if (!hdr) { 19113 nlmsg_free(msg); 19114 return; 19115 } 19116 19117 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19118 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19119 nla_put(msg, NL80211_ATTR_FRAME, event->buf_len, event->buf) || 19120 (event->req_ies && 19121 nla_put(msg, NL80211_ATTR_REQ_IE, event->req_ies_len, 19122 event->req_ies))) 19123 goto nla_put_failure; 19124 19125 if (event->reconnect && 19126 nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED)) 19127 goto nla_put_failure; 19128 19129 if (event->uapsd_queues >= 0) { 19130 struct nlattr *nla_wmm = 19131 nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME); 19132 if (!nla_wmm) 19133 goto nla_put_failure; 19134 19135 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES, 19136 event->uapsd_queues)) 19137 goto nla_put_failure; 19138 19139 nla_nest_end(msg, nla_wmm); 19140 } 19141 19142 genlmsg_end(msg, hdr); 19143 19144 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19145 NL80211_MCGRP_MLME, gfp); 19146 return; 19147 19148 nla_put_failure: 19149 nlmsg_free(msg); 19150 } 19151 19152 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev, 19153 struct net_device *netdev, const u8 *buf, 19154 size_t len, gfp_t gfp) 19155 { 19156 struct nl80211_mlme_event event = { 19157 .cmd = NL80211_CMD_AUTHENTICATE, 19158 .buf = buf, 19159 .buf_len = len, 19160 .uapsd_queues = -1, 19161 }; 19162 19163 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 19164 } 19165 19166 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev, 19167 struct net_device *netdev, 19168 const struct cfg80211_rx_assoc_resp_data *data) 19169 { 19170 struct nl80211_mlme_event event = { 19171 .cmd = NL80211_CMD_ASSOCIATE, 19172 .buf = data->buf, 19173 .buf_len = data->len, 19174 .uapsd_queues = data->uapsd_queues, 19175 .req_ies = data->req_ies, 19176 .req_ies_len = data->req_ies_len, 19177 }; 19178 19179 nl80211_send_mlme_event(rdev, netdev, &event, GFP_KERNEL); 19180 } 19181 19182 void nl80211_send_deauth(struct cfg80211_registered_device *rdev, 19183 struct net_device *netdev, const u8 *buf, 19184 size_t len, bool reconnect, gfp_t gfp) 19185 { 19186 struct nl80211_mlme_event event = { 19187 .cmd = NL80211_CMD_DEAUTHENTICATE, 19188 .buf = buf, 19189 .buf_len = len, 19190 .reconnect = reconnect, 19191 .uapsd_queues = -1, 19192 }; 19193 19194 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 19195 } 19196 19197 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev, 19198 struct net_device *netdev, const u8 *buf, 19199 size_t len, bool reconnect, gfp_t gfp) 19200 { 19201 struct nl80211_mlme_event event = { 19202 .cmd = NL80211_CMD_DISASSOCIATE, 19203 .buf = buf, 19204 .buf_len = len, 19205 .reconnect = reconnect, 19206 .uapsd_queues = -1, 19207 }; 19208 19209 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 19210 } 19211 19212 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf, 19213 size_t len) 19214 { 19215 struct wireless_dev *wdev = dev->ieee80211_ptr; 19216 struct wiphy *wiphy = wdev->wiphy; 19217 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19218 const struct ieee80211_mgmt *mgmt = (void *)buf; 19219 struct nl80211_mlme_event event = { 19220 .buf = buf, 19221 .buf_len = len, 19222 .uapsd_queues = -1, 19223 }; 19224 19225 if (WARN_ON(len < 2)) 19226 return; 19227 19228 if (ieee80211_is_deauth(mgmt->frame_control)) { 19229 event.cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE; 19230 } else if (ieee80211_is_disassoc(mgmt->frame_control)) { 19231 event.cmd = NL80211_CMD_UNPROT_DISASSOCIATE; 19232 } else if (ieee80211_is_beacon(mgmt->frame_control)) { 19233 if (wdev->unprot_beacon_reported && 19234 elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000) 19235 return; 19236 event.cmd = NL80211_CMD_UNPROT_BEACON; 19237 wdev->unprot_beacon_reported = jiffies; 19238 } else { 19239 return; 19240 } 19241 19242 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len); 19243 nl80211_send_mlme_event(rdev, dev, &event, GFP_ATOMIC); 19244 } 19245 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt); 19246 19247 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev, 19248 struct net_device *netdev, int cmd, 19249 const u8 *addr, gfp_t gfp) 19250 { 19251 struct sk_buff *msg; 19252 void *hdr; 19253 19254 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19255 if (!msg) 19256 return; 19257 19258 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19259 if (!hdr) { 19260 nlmsg_free(msg); 19261 return; 19262 } 19263 19264 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19265 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19266 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 19267 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 19268 goto nla_put_failure; 19269 19270 genlmsg_end(msg, hdr); 19271 19272 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19273 NL80211_MCGRP_MLME, gfp); 19274 return; 19275 19276 nla_put_failure: 19277 nlmsg_free(msg); 19278 } 19279 19280 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev, 19281 struct net_device *netdev, const u8 *addr, 19282 gfp_t gfp) 19283 { 19284 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE, 19285 addr, gfp); 19286 } 19287 19288 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev, 19289 struct net_device *netdev, const u8 *addr, 19290 gfp_t gfp) 19291 { 19292 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE, 19293 addr, gfp); 19294 } 19295 19296 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev, 19297 struct net_device *netdev, 19298 struct cfg80211_connect_resp_params *cr, 19299 gfp_t gfp) 19300 { 19301 struct sk_buff *msg; 19302 void *hdr; 19303 unsigned int link; 19304 size_t link_info_size = 0; 19305 const u8 *connected_addr = cr->valid_links ? 19306 cr->ap_mld_addr : cr->links[0].bssid; 19307 19308 if (cr->valid_links) { 19309 for_each_valid_link(cr, link) { 19310 /* Nested attribute header */ 19311 link_info_size += NLA_HDRLEN; 19312 /* Link ID */ 19313 link_info_size += nla_total_size(sizeof(u8)); 19314 link_info_size += cr->links[link].addr ? 19315 nla_total_size(ETH_ALEN) : 0; 19316 link_info_size += (cr->links[link].bssid || 19317 cr->links[link].bss) ? 19318 nla_total_size(ETH_ALEN) : 0; 19319 link_info_size += nla_total_size(sizeof(u16)); 19320 } 19321 } 19322 19323 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len + 19324 cr->fils.kek_len + cr->fils.pmk_len + 19325 (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size, 19326 gfp); 19327 if (!msg) 19328 return; 19329 19330 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT); 19331 if (!hdr) { 19332 nlmsg_free(msg); 19333 return; 19334 } 19335 19336 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19337 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19338 (connected_addr && 19339 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) || 19340 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 19341 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE : 19342 cr->status) || 19343 (cr->status < 0 && 19344 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 19345 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON, 19346 cr->timeout_reason))) || 19347 (cr->req_ie && 19348 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) || 19349 (cr->resp_ie && 19350 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len, 19351 cr->resp_ie)) || 19352 (cr->fils.update_erp_next_seq_num && 19353 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 19354 cr->fils.erp_next_seq_num)) || 19355 (cr->status == WLAN_STATUS_SUCCESS && 19356 ((cr->fils.kek && 19357 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len, 19358 cr->fils.kek)) || 19359 (cr->fils.pmk && 19360 nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) || 19361 (cr->fils.pmkid && 19362 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid))))) 19363 goto nla_put_failure; 19364 19365 if (cr->valid_links) { 19366 int i = 1; 19367 struct nlattr *nested; 19368 19369 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 19370 if (!nested) 19371 goto nla_put_failure; 19372 19373 for_each_valid_link(cr, link) { 19374 struct nlattr *nested_mlo_links; 19375 const u8 *bssid = cr->links[link].bss ? 19376 cr->links[link].bss->bssid : 19377 cr->links[link].bssid; 19378 19379 nested_mlo_links = nla_nest_start(msg, i); 19380 if (!nested_mlo_links) 19381 goto nla_put_failure; 19382 19383 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 19384 (bssid && 19385 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 19386 (cr->links[link].addr && 19387 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 19388 cr->links[link].addr)) || 19389 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 19390 cr->links[link].status)) 19391 goto nla_put_failure; 19392 19393 nla_nest_end(msg, nested_mlo_links); 19394 i++; 19395 } 19396 nla_nest_end(msg, nested); 19397 } 19398 19399 genlmsg_end(msg, hdr); 19400 19401 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19402 NL80211_MCGRP_MLME, gfp); 19403 return; 19404 19405 nla_put_failure: 19406 nlmsg_free(msg); 19407 } 19408 19409 void nl80211_send_roamed(struct cfg80211_registered_device *rdev, 19410 struct net_device *netdev, 19411 struct cfg80211_roam_info *info, gfp_t gfp) 19412 { 19413 struct sk_buff *msg; 19414 void *hdr; 19415 size_t link_info_size = 0; 19416 unsigned int link; 19417 const u8 *connected_addr = info->ap_mld_addr ? 19418 info->ap_mld_addr : 19419 (info->links[0].bss ? 19420 info->links[0].bss->bssid : 19421 info->links[0].bssid); 19422 19423 if (info->valid_links) { 19424 for_each_valid_link(info, link) { 19425 /* Nested attribute header */ 19426 link_info_size += NLA_HDRLEN; 19427 /* Link ID */ 19428 link_info_size += nla_total_size(sizeof(u8)); 19429 link_info_size += info->links[link].addr ? 19430 nla_total_size(ETH_ALEN) : 0; 19431 link_info_size += (info->links[link].bssid || 19432 info->links[link].bss) ? 19433 nla_total_size(ETH_ALEN) : 0; 19434 } 19435 } 19436 19437 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len + 19438 info->fils.kek_len + info->fils.pmk_len + 19439 (info->fils.pmkid ? WLAN_PMKID_LEN : 0) + 19440 link_info_size, gfp); 19441 if (!msg) 19442 return; 19443 19444 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM); 19445 if (!hdr) { 19446 nlmsg_free(msg); 19447 return; 19448 } 19449 19450 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19451 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19452 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) || 19453 (info->req_ie && 19454 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len, 19455 info->req_ie)) || 19456 (info->resp_ie && 19457 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len, 19458 info->resp_ie)) || 19459 (info->fils.update_erp_next_seq_num && 19460 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 19461 info->fils.erp_next_seq_num)) || 19462 (info->fils.kek && 19463 nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len, 19464 info->fils.kek)) || 19465 (info->fils.pmk && 19466 nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) || 19467 (info->fils.pmkid && 19468 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid))) 19469 goto nla_put_failure; 19470 19471 if (info->valid_links) { 19472 int i = 1; 19473 struct nlattr *nested; 19474 19475 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 19476 if (!nested) 19477 goto nla_put_failure; 19478 19479 for_each_valid_link(info, link) { 19480 struct nlattr *nested_mlo_links; 19481 const u8 *bssid = info->links[link].bss ? 19482 info->links[link].bss->bssid : 19483 info->links[link].bssid; 19484 19485 nested_mlo_links = nla_nest_start(msg, i); 19486 if (!nested_mlo_links) 19487 goto nla_put_failure; 19488 19489 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 19490 (bssid && 19491 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 19492 (info->links[link].addr && 19493 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 19494 info->links[link].addr))) 19495 goto nla_put_failure; 19496 19497 nla_nest_end(msg, nested_mlo_links); 19498 i++; 19499 } 19500 nla_nest_end(msg, nested); 19501 } 19502 19503 genlmsg_end(msg, hdr); 19504 19505 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19506 NL80211_MCGRP_MLME, gfp); 19507 return; 19508 19509 nla_put_failure: 19510 nlmsg_free(msg); 19511 } 19512 19513 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev, 19514 struct net_device *netdev, const u8 *peer_addr, 19515 const u8 *td_bitmap, u8 td_bitmap_len) 19516 { 19517 struct sk_buff *msg; 19518 void *hdr; 19519 19520 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19521 if (!msg) 19522 return; 19523 19524 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED); 19525 if (!hdr) { 19526 nlmsg_free(msg); 19527 return; 19528 } 19529 19530 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19531 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19532 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr)) 19533 goto nla_put_failure; 19534 19535 if (td_bitmap_len > 0 && td_bitmap && 19536 nla_put(msg, NL80211_ATTR_TD_BITMAP, td_bitmap_len, td_bitmap)) 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_KERNEL); 19543 return; 19544 19545 nla_put_failure: 19546 nlmsg_free(msg); 19547 } 19548 19549 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev, 19550 struct net_device *netdev, u16 reason, 19551 const u8 *ie, size_t ie_len, bool from_ap) 19552 { 19553 struct sk_buff *msg; 19554 void *hdr; 19555 19556 msg = nlmsg_new(100 + ie_len, GFP_KERNEL); 19557 if (!msg) 19558 return; 19559 19560 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT); 19561 if (!hdr) { 19562 nlmsg_free(msg); 19563 return; 19564 } 19565 19566 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19567 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19568 (reason && 19569 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) || 19570 (from_ap && 19571 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) || 19572 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie))) 19573 goto nla_put_failure; 19574 19575 genlmsg_end(msg, hdr); 19576 19577 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19578 NL80211_MCGRP_MLME, GFP_KERNEL); 19579 return; 19580 19581 nla_put_failure: 19582 nlmsg_free(msg); 19583 } 19584 19585 void cfg80211_links_removed(struct net_device *dev, u16 link_mask) 19586 { 19587 struct wireless_dev *wdev = dev->ieee80211_ptr; 19588 struct wiphy *wiphy = wdev->wiphy; 19589 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19590 struct sk_buff *msg; 19591 struct nlattr *links; 19592 void *hdr; 19593 19594 lockdep_assert_wiphy(wdev->wiphy); 19595 trace_cfg80211_links_removed(dev, link_mask); 19596 19597 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION && 19598 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)) 19599 return; 19600 19601 if (WARN_ON(!wdev->valid_links || !link_mask || 19602 (wdev->valid_links & link_mask) != link_mask || 19603 wdev->valid_links == link_mask)) 19604 return; 19605 19606 cfg80211_wdev_release_link_bsses(wdev, link_mask); 19607 wdev->valid_links &= ~link_mask; 19608 19609 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19610 if (!msg) 19611 return; 19612 19613 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_LINKS_REMOVED); 19614 if (!hdr) { 19615 nlmsg_free(msg); 19616 return; 19617 } 19618 19619 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19620 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19621 goto nla_put_failure; 19622 19623 links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 19624 if (!links) 19625 goto nla_put_failure; 19626 19627 while (link_mask) { 19628 struct nlattr *link; 19629 int link_id = __ffs(link_mask); 19630 19631 link = nla_nest_start(msg, link_id + 1); 19632 if (!link) 19633 goto nla_put_failure; 19634 19635 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19636 goto nla_put_failure; 19637 19638 nla_nest_end(msg, link); 19639 link_mask &= ~(1 << link_id); 19640 } 19641 19642 nla_nest_end(msg, links); 19643 19644 genlmsg_end(msg, hdr); 19645 19646 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19647 NL80211_MCGRP_MLME, GFP_KERNEL); 19648 return; 19649 19650 nla_put_failure: 19651 nlmsg_free(msg); 19652 } 19653 EXPORT_SYMBOL(cfg80211_links_removed); 19654 19655 void nl80211_mlo_reconf_add_done(struct net_device *dev, 19656 struct cfg80211_mlo_reconf_done_data *data) 19657 { 19658 struct wireless_dev *wdev = dev->ieee80211_ptr; 19659 struct wiphy *wiphy = wdev->wiphy; 19660 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19661 struct nl80211_mlme_event event = { 19662 .cmd = NL80211_CMD_ASSOC_MLO_RECONF, 19663 .buf = data->buf, 19664 .buf_len = data->len, 19665 .uapsd_queues = -1, 19666 }; 19667 19668 nl80211_send_mlme_event(rdev, dev, &event, GFP_KERNEL); 19669 } 19670 EXPORT_SYMBOL(nl80211_mlo_reconf_add_done); 19671 19672 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev, 19673 struct net_device *netdev, const u8 *bssid, 19674 gfp_t gfp) 19675 { 19676 struct sk_buff *msg; 19677 void *hdr; 19678 19679 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19680 if (!msg) 19681 return; 19682 19683 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS); 19684 if (!hdr) { 19685 nlmsg_free(msg); 19686 return; 19687 } 19688 19689 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19690 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19691 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 19692 goto nla_put_failure; 19693 19694 genlmsg_end(msg, hdr); 19695 19696 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19697 NL80211_MCGRP_MLME, gfp); 19698 return; 19699 19700 nla_put_failure: 19701 nlmsg_free(msg); 19702 } 19703 19704 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr, 19705 const u8 *ie, u8 ie_len, 19706 int sig_dbm, gfp_t gfp) 19707 { 19708 struct wireless_dev *wdev = dev->ieee80211_ptr; 19709 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19710 struct sk_buff *msg; 19711 void *hdr; 19712 19713 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT)) 19714 return; 19715 19716 trace_cfg80211_notify_new_peer_candidate(dev, addr); 19717 19718 msg = nlmsg_new(100 + ie_len, gfp); 19719 if (!msg) 19720 return; 19721 19722 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE); 19723 if (!hdr) { 19724 nlmsg_free(msg); 19725 return; 19726 } 19727 19728 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19729 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19730 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19731 (ie_len && ie && 19732 nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) || 19733 (sig_dbm && 19734 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm))) 19735 goto nla_put_failure; 19736 19737 genlmsg_end(msg, hdr); 19738 19739 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19740 NL80211_MCGRP_MLME, gfp); 19741 return; 19742 19743 nla_put_failure: 19744 nlmsg_free(msg); 19745 } 19746 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate); 19747 19748 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev, 19749 struct net_device *netdev, const u8 *addr, 19750 enum nl80211_key_type key_type, int key_id, 19751 const u8 *tsc, gfp_t gfp) 19752 { 19753 struct sk_buff *msg; 19754 void *hdr; 19755 19756 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19757 if (!msg) 19758 return; 19759 19760 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE); 19761 if (!hdr) { 19762 nlmsg_free(msg); 19763 return; 19764 } 19765 19766 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19767 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19768 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) || 19769 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) || 19770 (key_id != -1 && 19771 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) || 19772 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc))) 19773 goto nla_put_failure; 19774 19775 genlmsg_end(msg, hdr); 19776 19777 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19778 NL80211_MCGRP_MLME, gfp); 19779 return; 19780 19781 nla_put_failure: 19782 nlmsg_free(msg); 19783 } 19784 19785 void nl80211_send_beacon_hint_event(struct wiphy *wiphy, 19786 struct ieee80211_channel *channel_before, 19787 struct ieee80211_channel *channel_after) 19788 { 19789 struct sk_buff *msg; 19790 void *hdr; 19791 struct nlattr *nl_freq; 19792 19793 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC); 19794 if (!msg) 19795 return; 19796 19797 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT); 19798 if (!hdr) { 19799 nlmsg_free(msg); 19800 return; 19801 } 19802 19803 /* 19804 * Since we are applying the beacon hint to a wiphy we know its 19805 * wiphy_idx is valid 19806 */ 19807 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 19808 goto nla_put_failure; 19809 19810 /* Before */ 19811 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE); 19812 if (!nl_freq) 19813 goto nla_put_failure; 19814 19815 if (nl80211_msg_put_channel(msg, wiphy, channel_before, false)) 19816 goto nla_put_failure; 19817 nla_nest_end(msg, nl_freq); 19818 19819 /* After */ 19820 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER); 19821 if (!nl_freq) 19822 goto nla_put_failure; 19823 19824 if (nl80211_msg_put_channel(msg, wiphy, channel_after, false)) 19825 goto nla_put_failure; 19826 nla_nest_end(msg, nl_freq); 19827 19828 genlmsg_end(msg, hdr); 19829 19830 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 19831 NL80211_MCGRP_REGULATORY); 19832 19833 return; 19834 19835 nla_put_failure: 19836 nlmsg_free(msg); 19837 } 19838 19839 static void nl80211_send_remain_on_chan_event( 19840 int cmd, struct cfg80211_registered_device *rdev, 19841 struct wireless_dev *wdev, u64 cookie, 19842 struct ieee80211_channel *chan, 19843 unsigned int duration, gfp_t gfp) 19844 { 19845 struct sk_buff *msg; 19846 void *hdr; 19847 19848 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19849 if (!msg) 19850 return; 19851 19852 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19853 if (!hdr) { 19854 nlmsg_free(msg); 19855 return; 19856 } 19857 19858 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19859 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 19860 wdev->netdev->ifindex)) || 19861 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19862 NL80211_ATTR_PAD) || 19863 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) || 19864 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 19865 NL80211_CHAN_NO_HT) || 19866 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 19867 NL80211_ATTR_PAD)) 19868 goto nla_put_failure; 19869 19870 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL && 19871 nla_put_u32(msg, NL80211_ATTR_DURATION, duration)) 19872 goto nla_put_failure; 19873 19874 genlmsg_end(msg, hdr); 19875 19876 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19877 NL80211_MCGRP_MLME, gfp); 19878 return; 19879 19880 nla_put_failure: 19881 nlmsg_free(msg); 19882 } 19883 19884 void cfg80211_assoc_comeback(struct net_device *netdev, 19885 const u8 *ap_addr, u32 timeout) 19886 { 19887 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19888 struct wiphy *wiphy = wdev->wiphy; 19889 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19890 struct sk_buff *msg; 19891 void *hdr; 19892 19893 trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout); 19894 19895 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19896 if (!msg) 19897 return; 19898 19899 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK); 19900 if (!hdr) { 19901 nlmsg_free(msg); 19902 return; 19903 } 19904 19905 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19906 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19907 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) || 19908 nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout)) 19909 goto nla_put_failure; 19910 19911 genlmsg_end(msg, hdr); 19912 19913 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19914 NL80211_MCGRP_MLME, GFP_KERNEL); 19915 return; 19916 19917 nla_put_failure: 19918 nlmsg_free(msg); 19919 } 19920 EXPORT_SYMBOL(cfg80211_assoc_comeback); 19921 19922 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie, 19923 struct ieee80211_channel *chan, 19924 unsigned int duration, gfp_t gfp) 19925 { 19926 struct wiphy *wiphy = wdev->wiphy; 19927 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19928 19929 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration); 19930 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL, 19931 rdev, wdev, cookie, chan, 19932 duration, gfp); 19933 } 19934 EXPORT_SYMBOL(cfg80211_ready_on_channel); 19935 19936 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie, 19937 struct ieee80211_channel *chan, 19938 gfp_t gfp) 19939 { 19940 struct wiphy *wiphy = wdev->wiphy; 19941 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19942 19943 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan); 19944 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 19945 rdev, wdev, cookie, chan, 0, gfp); 19946 } 19947 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired); 19948 19949 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie, 19950 struct ieee80211_channel *chan, 19951 gfp_t gfp) 19952 { 19953 struct wiphy *wiphy = wdev->wiphy; 19954 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19955 19956 trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan); 19957 nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL, 19958 rdev, wdev, cookie, chan, 0, gfp); 19959 } 19960 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired); 19961 19962 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr, 19963 struct station_info *sinfo, gfp_t gfp) 19964 { 19965 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 19966 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19967 struct sk_buff *msg; 19968 19969 trace_cfg80211_new_sta(dev, mac_addr, sinfo); 19970 19971 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19972 if (!msg) 19973 return; 19974 19975 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0, 19976 rdev, dev, mac_addr, sinfo, false) < 0) { 19977 nlmsg_free(msg); 19978 return; 19979 } 19980 19981 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19982 NL80211_MCGRP_MLME, gfp); 19983 } 19984 EXPORT_SYMBOL(cfg80211_new_sta); 19985 19986 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr, 19987 struct station_info *sinfo, gfp_t gfp) 19988 { 19989 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 19990 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19991 struct sk_buff *msg; 19992 struct station_info empty_sinfo = {}; 19993 19994 if (!sinfo) 19995 sinfo = &empty_sinfo; 19996 19997 trace_cfg80211_del_sta(dev, mac_addr); 19998 19999 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20000 if (!msg) { 20001 cfg80211_sinfo_release_content(sinfo); 20002 return; 20003 } 20004 20005 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0, 20006 rdev, dev, mac_addr, sinfo, false) < 0) { 20007 nlmsg_free(msg); 20008 return; 20009 } 20010 20011 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20012 NL80211_MCGRP_MLME, gfp); 20013 } 20014 EXPORT_SYMBOL(cfg80211_del_sta_sinfo); 20015 20016 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr, 20017 enum nl80211_connect_failed_reason reason, 20018 gfp_t gfp) 20019 { 20020 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 20021 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20022 struct sk_buff *msg; 20023 void *hdr; 20024 20025 msg = nlmsg_new(NLMSG_GOODSIZE, gfp); 20026 if (!msg) 20027 return; 20028 20029 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED); 20030 if (!hdr) { 20031 nlmsg_free(msg); 20032 return; 20033 } 20034 20035 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20036 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 20037 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason)) 20038 goto nla_put_failure; 20039 20040 genlmsg_end(msg, hdr); 20041 20042 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20043 NL80211_MCGRP_MLME, gfp); 20044 return; 20045 20046 nla_put_failure: 20047 nlmsg_free(msg); 20048 } 20049 EXPORT_SYMBOL(cfg80211_conn_failed); 20050 20051 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd, 20052 const u8 *addr, int link_id, gfp_t gfp) 20053 { 20054 struct wireless_dev *wdev = dev->ieee80211_ptr; 20055 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20056 struct sk_buff *msg; 20057 void *hdr; 20058 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid); 20059 20060 if (!nlportid) 20061 return false; 20062 20063 msg = nlmsg_new(100, gfp); 20064 if (!msg) 20065 return true; 20066 20067 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 20068 if (!hdr) { 20069 nlmsg_free(msg); 20070 return true; 20071 } 20072 20073 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20074 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20075 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 20076 (link_id >= 0 && 20077 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 20078 goto nla_put_failure; 20079 20080 genlmsg_end(msg, hdr); 20081 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20082 return true; 20083 20084 nla_put_failure: 20085 nlmsg_free(msg); 20086 return true; 20087 } 20088 20089 bool cfg80211_rx_spurious_frame(struct net_device *dev, const u8 *addr, 20090 int link_id, gfp_t gfp) 20091 { 20092 struct wireless_dev *wdev = dev->ieee80211_ptr; 20093 bool ret; 20094 20095 trace_cfg80211_rx_spurious_frame(dev, addr, link_id); 20096 20097 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 20098 wdev->iftype != NL80211_IFTYPE_P2P_GO)) { 20099 trace_cfg80211_return_bool(false); 20100 return false; 20101 } 20102 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME, 20103 addr, link_id, gfp); 20104 trace_cfg80211_return_bool(ret); 20105 return ret; 20106 } 20107 EXPORT_SYMBOL(cfg80211_rx_spurious_frame); 20108 20109 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev, const u8 *addr, 20110 int link_id, gfp_t gfp) 20111 { 20112 struct wireless_dev *wdev = dev->ieee80211_ptr; 20113 bool ret; 20114 20115 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr, link_id); 20116 20117 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 20118 wdev->iftype != NL80211_IFTYPE_P2P_GO && 20119 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) { 20120 trace_cfg80211_return_bool(false); 20121 return false; 20122 } 20123 ret = __nl80211_unexpected_frame(dev, 20124 NL80211_CMD_UNEXPECTED_4ADDR_FRAME, 20125 addr, link_id, gfp); 20126 trace_cfg80211_return_bool(ret); 20127 return ret; 20128 } 20129 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame); 20130 20131 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev, 20132 struct wireless_dev *wdev, u32 nlportid, 20133 struct cfg80211_rx_info *info, gfp_t gfp) 20134 { 20135 struct net_device *netdev = wdev->netdev; 20136 struct sk_buff *msg; 20137 void *hdr; 20138 20139 msg = nlmsg_new(100 + info->len, gfp); 20140 if (!msg) 20141 return -ENOMEM; 20142 20143 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 20144 if (!hdr) { 20145 nlmsg_free(msg); 20146 return -ENOMEM; 20147 } 20148 20149 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20150 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 20151 netdev->ifindex)) || 20152 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20153 NL80211_ATTR_PAD) || 20154 (info->have_link_id && 20155 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) || 20156 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) || 20157 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) || 20158 (info->sig_dbm && 20159 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) || 20160 nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) || 20161 (info->flags && 20162 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) || 20163 (info->rx_tstamp && nla_put_u64_64bit(msg, 20164 NL80211_ATTR_RX_HW_TIMESTAMP, 20165 info->rx_tstamp, 20166 NL80211_ATTR_PAD)) || 20167 (info->ack_tstamp && nla_put_u64_64bit(msg, 20168 NL80211_ATTR_TX_HW_TIMESTAMP, 20169 info->ack_tstamp, 20170 NL80211_ATTR_PAD))) 20171 goto nla_put_failure; 20172 20173 genlmsg_end(msg, hdr); 20174 20175 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20176 20177 nla_put_failure: 20178 nlmsg_free(msg); 20179 return -ENOBUFS; 20180 } 20181 20182 static void nl80211_frame_tx_status(struct wireless_dev *wdev, 20183 struct cfg80211_tx_status *status, 20184 gfp_t gfp, enum nl80211_commands command) 20185 { 20186 struct wiphy *wiphy = wdev->wiphy; 20187 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20188 struct net_device *netdev = wdev->netdev; 20189 struct sk_buff *msg; 20190 void *hdr; 20191 20192 if (command == NL80211_CMD_FRAME_TX_STATUS) 20193 trace_cfg80211_mgmt_tx_status(wdev, status->cookie, 20194 status->ack); 20195 else 20196 trace_cfg80211_control_port_tx_status(wdev, status->cookie, 20197 status->ack); 20198 20199 msg = nlmsg_new(100 + status->len, gfp); 20200 if (!msg) 20201 return; 20202 20203 hdr = nl80211hdr_put(msg, 0, 0, 0, command); 20204 if (!hdr) { 20205 nlmsg_free(msg); 20206 return; 20207 } 20208 20209 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20210 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 20211 netdev->ifindex)) || 20212 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20213 NL80211_ATTR_PAD) || 20214 nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) || 20215 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie, 20216 NL80211_ATTR_PAD) || 20217 (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) || 20218 (status->tx_tstamp && 20219 nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP, 20220 status->tx_tstamp, NL80211_ATTR_PAD)) || 20221 (status->ack_tstamp && 20222 nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP, 20223 status->ack_tstamp, NL80211_ATTR_PAD))) 20224 goto nla_put_failure; 20225 20226 genlmsg_end(msg, hdr); 20227 20228 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20229 NL80211_MCGRP_MLME, gfp); 20230 return; 20231 20232 nla_put_failure: 20233 nlmsg_free(msg); 20234 } 20235 20236 void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie, 20237 const u8 *buf, size_t len, bool ack, 20238 gfp_t gfp) 20239 { 20240 struct cfg80211_tx_status status = { 20241 .cookie = cookie, 20242 .buf = buf, 20243 .len = len, 20244 .ack = ack 20245 }; 20246 20247 nl80211_frame_tx_status(wdev, &status, gfp, 20248 NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS); 20249 } 20250 EXPORT_SYMBOL(cfg80211_control_port_tx_status); 20251 20252 void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev, 20253 struct cfg80211_tx_status *status, gfp_t gfp) 20254 { 20255 nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS); 20256 } 20257 EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext); 20258 20259 static int __nl80211_rx_control_port(struct net_device *dev, 20260 struct sk_buff *skb, 20261 bool unencrypted, 20262 int link_id, 20263 gfp_t gfp) 20264 { 20265 struct wireless_dev *wdev = dev->ieee80211_ptr; 20266 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20267 struct ethhdr *ehdr = eth_hdr(skb); 20268 const u8 *addr = ehdr->h_source; 20269 u16 proto = be16_to_cpu(skb->protocol); 20270 struct sk_buff *msg; 20271 void *hdr; 20272 struct nlattr *frame; 20273 20274 u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid); 20275 20276 if (!nlportid) 20277 return -ENOENT; 20278 20279 msg = nlmsg_new(100 + skb->len, gfp); 20280 if (!msg) 20281 return -ENOMEM; 20282 20283 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME); 20284 if (!hdr) { 20285 nlmsg_free(msg); 20286 return -ENOBUFS; 20287 } 20288 20289 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20290 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20291 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20292 NL80211_ATTR_PAD) || 20293 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 20294 nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) || 20295 (link_id >= 0 && 20296 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) || 20297 (unencrypted && nla_put_flag(msg, 20298 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT))) 20299 goto nla_put_failure; 20300 20301 frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len); 20302 if (!frame) 20303 goto nla_put_failure; 20304 20305 skb_copy_bits(skb, 0, nla_data(frame), skb->len); 20306 genlmsg_end(msg, hdr); 20307 20308 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20309 20310 nla_put_failure: 20311 nlmsg_free(msg); 20312 return -ENOBUFS; 20313 } 20314 20315 bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb, 20316 bool unencrypted, int link_id) 20317 { 20318 int ret; 20319 20320 trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id); 20321 ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id, 20322 GFP_ATOMIC); 20323 trace_cfg80211_return_bool(ret == 0); 20324 return ret == 0; 20325 } 20326 EXPORT_SYMBOL(cfg80211_rx_control_port); 20327 20328 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev, 20329 const char *mac, gfp_t gfp) 20330 { 20331 struct wireless_dev *wdev = dev->ieee80211_ptr; 20332 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20333 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20334 void **cb; 20335 20336 if (!msg) 20337 return NULL; 20338 20339 cb = (void **)msg->cb; 20340 20341 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM); 20342 if (!cb[0]) { 20343 nlmsg_free(msg); 20344 return NULL; 20345 } 20346 20347 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20348 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 20349 goto nla_put_failure; 20350 20351 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 20352 goto nla_put_failure; 20353 20354 cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM); 20355 if (!cb[1]) 20356 goto nla_put_failure; 20357 20358 cb[2] = rdev; 20359 20360 return msg; 20361 nla_put_failure: 20362 nlmsg_free(msg); 20363 return NULL; 20364 } 20365 20366 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp) 20367 { 20368 void **cb = (void **)msg->cb; 20369 struct cfg80211_registered_device *rdev = cb[2]; 20370 20371 nla_nest_end(msg, cb[1]); 20372 genlmsg_end(msg, cb[0]); 20373 20374 memset(msg->cb, 0, sizeof(msg->cb)); 20375 20376 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20377 NL80211_MCGRP_MLME, gfp); 20378 } 20379 20380 void cfg80211_cqm_rssi_notify(struct net_device *dev, 20381 enum nl80211_cqm_rssi_threshold_event rssi_event, 20382 s32 rssi_level, gfp_t gfp) 20383 { 20384 struct wireless_dev *wdev = dev->ieee80211_ptr; 20385 struct cfg80211_cqm_config *cqm_config; 20386 20387 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level); 20388 20389 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW && 20390 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH)) 20391 return; 20392 20393 rcu_read_lock(); 20394 cqm_config = rcu_dereference(wdev->cqm_config); 20395 if (cqm_config) { 20396 cqm_config->last_rssi_event_value = rssi_level; 20397 cqm_config->last_rssi_event_type = rssi_event; 20398 wiphy_work_queue(wdev->wiphy, &wdev->cqm_rssi_work); 20399 } 20400 rcu_read_unlock(); 20401 } 20402 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify); 20403 20404 void cfg80211_cqm_rssi_notify_work(struct wiphy *wiphy, struct wiphy_work *work) 20405 { 20406 struct wireless_dev *wdev = container_of(work, struct wireless_dev, 20407 cqm_rssi_work); 20408 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20409 enum nl80211_cqm_rssi_threshold_event rssi_event; 20410 struct cfg80211_cqm_config *cqm_config; 20411 struct sk_buff *msg; 20412 s32 rssi_level; 20413 20414 cqm_config = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 20415 if (!cqm_config) 20416 return; 20417 20418 if (cqm_config->use_range_api) 20419 cfg80211_cqm_rssi_update(rdev, wdev->netdev, cqm_config); 20420 20421 rssi_level = cqm_config->last_rssi_event_value; 20422 rssi_event = cqm_config->last_rssi_event_type; 20423 20424 msg = cfg80211_prepare_cqm(wdev->netdev, NULL, GFP_KERNEL); 20425 if (!msg) 20426 return; 20427 20428 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT, 20429 rssi_event)) 20430 goto nla_put_failure; 20431 20432 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL, 20433 rssi_level)) 20434 goto nla_put_failure; 20435 20436 cfg80211_send_cqm(msg, GFP_KERNEL); 20437 20438 return; 20439 20440 nla_put_failure: 20441 nlmsg_free(msg); 20442 } 20443 20444 void cfg80211_cqm_txe_notify(struct net_device *dev, 20445 const u8 *peer, u32 num_packets, 20446 u32 rate, u32 intvl, gfp_t gfp) 20447 { 20448 struct sk_buff *msg; 20449 20450 msg = cfg80211_prepare_cqm(dev, peer, gfp); 20451 if (!msg) 20452 return; 20453 20454 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets)) 20455 goto nla_put_failure; 20456 20457 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate)) 20458 goto nla_put_failure; 20459 20460 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl)) 20461 goto nla_put_failure; 20462 20463 cfg80211_send_cqm(msg, gfp); 20464 return; 20465 20466 nla_put_failure: 20467 nlmsg_free(msg); 20468 } 20469 EXPORT_SYMBOL(cfg80211_cqm_txe_notify); 20470 20471 void cfg80211_cqm_pktloss_notify(struct net_device *dev, 20472 const u8 *peer, u32 num_packets, gfp_t gfp) 20473 { 20474 struct sk_buff *msg; 20475 20476 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets); 20477 20478 msg = cfg80211_prepare_cqm(dev, peer, gfp); 20479 if (!msg) 20480 return; 20481 20482 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets)) 20483 goto nla_put_failure; 20484 20485 cfg80211_send_cqm(msg, gfp); 20486 return; 20487 20488 nla_put_failure: 20489 nlmsg_free(msg); 20490 } 20491 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify); 20492 20493 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp) 20494 { 20495 struct sk_buff *msg; 20496 20497 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 20498 if (!msg) 20499 return; 20500 20501 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT)) 20502 goto nla_put_failure; 20503 20504 cfg80211_send_cqm(msg, gfp); 20505 return; 20506 20507 nla_put_failure: 20508 nlmsg_free(msg); 20509 } 20510 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify); 20511 20512 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev, 20513 struct net_device *netdev, const u8 *bssid, 20514 const u8 *replay_ctr, gfp_t gfp) 20515 { 20516 struct sk_buff *msg; 20517 struct nlattr *rekey_attr; 20518 void *hdr; 20519 20520 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20521 if (!msg) 20522 return; 20523 20524 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD); 20525 if (!hdr) { 20526 nlmsg_free(msg); 20527 return; 20528 } 20529 20530 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20531 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20532 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 20533 goto nla_put_failure; 20534 20535 rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA); 20536 if (!rekey_attr) 20537 goto nla_put_failure; 20538 20539 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR, 20540 NL80211_REPLAY_CTR_LEN, replay_ctr)) 20541 goto nla_put_failure; 20542 20543 nla_nest_end(msg, rekey_attr); 20544 20545 genlmsg_end(msg, hdr); 20546 20547 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20548 NL80211_MCGRP_MLME, gfp); 20549 return; 20550 20551 nla_put_failure: 20552 nlmsg_free(msg); 20553 } 20554 20555 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid, 20556 const u8 *replay_ctr, gfp_t gfp) 20557 { 20558 struct wireless_dev *wdev = dev->ieee80211_ptr; 20559 struct wiphy *wiphy = wdev->wiphy; 20560 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20561 20562 trace_cfg80211_gtk_rekey_notify(dev, bssid); 20563 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp); 20564 } 20565 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify); 20566 20567 static void 20568 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev, 20569 struct net_device *netdev, int index, 20570 const u8 *bssid, bool preauth, gfp_t gfp) 20571 { 20572 struct sk_buff *msg; 20573 struct nlattr *attr; 20574 void *hdr; 20575 20576 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20577 if (!msg) 20578 return; 20579 20580 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE); 20581 if (!hdr) { 20582 nlmsg_free(msg); 20583 return; 20584 } 20585 20586 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20587 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 20588 goto nla_put_failure; 20589 20590 attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE); 20591 if (!attr) 20592 goto nla_put_failure; 20593 20594 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) || 20595 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) || 20596 (preauth && 20597 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH))) 20598 goto nla_put_failure; 20599 20600 nla_nest_end(msg, attr); 20601 20602 genlmsg_end(msg, hdr); 20603 20604 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20605 NL80211_MCGRP_MLME, gfp); 20606 return; 20607 20608 nla_put_failure: 20609 nlmsg_free(msg); 20610 } 20611 20612 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index, 20613 const u8 *bssid, bool preauth, gfp_t gfp) 20614 { 20615 struct wireless_dev *wdev = dev->ieee80211_ptr; 20616 struct wiphy *wiphy = wdev->wiphy; 20617 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20618 20619 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth); 20620 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp); 20621 } 20622 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify); 20623 20624 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev, 20625 struct net_device *netdev, 20626 unsigned int link_id, 20627 struct cfg80211_chan_def *chandef, 20628 gfp_t gfp, 20629 enum nl80211_commands notif, 20630 u8 count, bool quiet) 20631 { 20632 struct wireless_dev *wdev = netdev->ieee80211_ptr; 20633 struct sk_buff *msg; 20634 void *hdr; 20635 20636 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20637 if (!msg) 20638 return; 20639 20640 hdr = nl80211hdr_put(msg, 0, 0, 0, notif); 20641 if (!hdr) { 20642 nlmsg_free(msg); 20643 return; 20644 } 20645 20646 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 20647 goto nla_put_failure; 20648 20649 if (wdev->valid_links && 20650 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 20651 goto nla_put_failure; 20652 20653 if (nl80211_send_chandef(msg, chandef)) 20654 goto nla_put_failure; 20655 20656 if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) { 20657 if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)) 20658 goto nla_put_failure; 20659 if (quiet && 20660 nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX)) 20661 goto nla_put_failure; 20662 } 20663 20664 genlmsg_end(msg, hdr); 20665 20666 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20667 NL80211_MCGRP_MLME, gfp); 20668 return; 20669 20670 nla_put_failure: 20671 nlmsg_free(msg); 20672 } 20673 20674 void cfg80211_ch_switch_notify(struct net_device *dev, 20675 struct cfg80211_chan_def *chandef, 20676 unsigned int link_id) 20677 { 20678 struct wireless_dev *wdev = dev->ieee80211_ptr; 20679 struct wiphy *wiphy = wdev->wiphy; 20680 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20681 20682 lockdep_assert_wiphy(wdev->wiphy); 20683 WARN_INVALID_LINK_ID(wdev, link_id); 20684 20685 trace_cfg80211_ch_switch_notify(dev, chandef, link_id); 20686 20687 switch (wdev->iftype) { 20688 case NL80211_IFTYPE_STATION: 20689 case NL80211_IFTYPE_P2P_CLIENT: 20690 if (!WARN_ON(!wdev->links[link_id].client.current_bss)) 20691 cfg80211_update_assoc_bss_entry(wdev, link_id, 20692 chandef->chan); 20693 break; 20694 case NL80211_IFTYPE_MESH_POINT: 20695 wdev->u.mesh.chandef = *chandef; 20696 wdev->u.mesh.preset_chandef = *chandef; 20697 break; 20698 case NL80211_IFTYPE_AP: 20699 case NL80211_IFTYPE_P2P_GO: 20700 wdev->links[link_id].ap.chandef = *chandef; 20701 break; 20702 case NL80211_IFTYPE_ADHOC: 20703 wdev->u.ibss.chandef = *chandef; 20704 break; 20705 default: 20706 WARN_ON(1); 20707 break; 20708 } 20709 20710 cfg80211_schedule_channels_check(wdev); 20711 cfg80211_sched_dfs_chan_update(rdev); 20712 20713 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 20714 NL80211_CMD_CH_SWITCH_NOTIFY, 0, false); 20715 } 20716 EXPORT_SYMBOL(cfg80211_ch_switch_notify); 20717 20718 void cfg80211_ch_switch_started_notify(struct net_device *dev, 20719 struct cfg80211_chan_def *chandef, 20720 unsigned int link_id, u8 count, 20721 bool quiet) 20722 { 20723 struct wireless_dev *wdev = dev->ieee80211_ptr; 20724 struct wiphy *wiphy = wdev->wiphy; 20725 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20726 20727 lockdep_assert_wiphy(wdev->wiphy); 20728 WARN_INVALID_LINK_ID(wdev, link_id); 20729 20730 trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id); 20731 20732 20733 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 20734 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, 20735 count, quiet); 20736 } 20737 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify); 20738 20739 int cfg80211_bss_color_notify(struct net_device *dev, 20740 enum nl80211_commands cmd, u8 count, 20741 u64 color_bitmap, u8 link_id) 20742 { 20743 struct wireless_dev *wdev = dev->ieee80211_ptr; 20744 struct wiphy *wiphy = wdev->wiphy; 20745 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20746 struct sk_buff *msg; 20747 void *hdr; 20748 20749 lockdep_assert_wiphy(wdev->wiphy); 20750 20751 trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap); 20752 20753 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 20754 if (!msg) 20755 return -ENOMEM; 20756 20757 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 20758 if (!hdr) 20759 goto nla_put_failure; 20760 20761 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 20762 goto nla_put_failure; 20763 20764 if (wdev->valid_links && 20765 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 20766 goto nla_put_failure; 20767 20768 if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED && 20769 nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count)) 20770 goto nla_put_failure; 20771 20772 if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION && 20773 nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP, 20774 color_bitmap, NL80211_ATTR_PAD)) 20775 goto nla_put_failure; 20776 20777 genlmsg_end(msg, hdr); 20778 20779 return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 20780 msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL); 20781 20782 nla_put_failure: 20783 nlmsg_free(msg); 20784 return -EINVAL; 20785 } 20786 EXPORT_SYMBOL(cfg80211_bss_color_notify); 20787 20788 void 20789 nl80211_radar_notify(struct cfg80211_registered_device *rdev, 20790 const struct cfg80211_chan_def *chandef, 20791 enum nl80211_radar_event event, 20792 struct net_device *netdev, gfp_t gfp) 20793 { 20794 struct sk_buff *msg; 20795 void *hdr; 20796 20797 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20798 if (!msg) 20799 return; 20800 20801 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT); 20802 if (!hdr) { 20803 nlmsg_free(msg); 20804 return; 20805 } 20806 20807 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 20808 goto nla_put_failure; 20809 20810 /* NOP and radar events don't need a netdev parameter */ 20811 if (netdev) { 20812 struct wireless_dev *wdev = netdev->ieee80211_ptr; 20813 20814 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20815 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20816 NL80211_ATTR_PAD)) 20817 goto nla_put_failure; 20818 } 20819 20820 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event)) 20821 goto nla_put_failure; 20822 20823 if (nl80211_send_chandef(msg, chandef)) 20824 goto nla_put_failure; 20825 20826 genlmsg_end(msg, hdr); 20827 20828 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20829 NL80211_MCGRP_MLME, gfp); 20830 return; 20831 20832 nla_put_failure: 20833 nlmsg_free(msg); 20834 } 20835 20836 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac, 20837 struct sta_opmode_info *sta_opmode, 20838 gfp_t gfp) 20839 { 20840 struct sk_buff *msg; 20841 struct wireless_dev *wdev = dev->ieee80211_ptr; 20842 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20843 void *hdr; 20844 20845 if (WARN_ON(!mac)) 20846 return; 20847 20848 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20849 if (!msg) 20850 return; 20851 20852 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED); 20853 if (!hdr) { 20854 nlmsg_free(msg); 20855 return; 20856 } 20857 20858 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 20859 goto nla_put_failure; 20860 20861 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 20862 goto nla_put_failure; 20863 20864 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 20865 goto nla_put_failure; 20866 20867 if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) && 20868 nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode)) 20869 goto nla_put_failure; 20870 20871 if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) && 20872 nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw)) 20873 goto nla_put_failure; 20874 20875 if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) && 20876 nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss)) 20877 goto nla_put_failure; 20878 20879 genlmsg_end(msg, hdr); 20880 20881 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20882 NL80211_MCGRP_MLME, gfp); 20883 20884 return; 20885 20886 nla_put_failure: 20887 nlmsg_free(msg); 20888 } 20889 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify); 20890 20891 void cfg80211_probe_status(struct net_device *dev, const u8 *addr, 20892 u64 cookie, bool acked, s32 ack_signal, 20893 bool is_valid_ack_signal, gfp_t gfp) 20894 { 20895 struct wireless_dev *wdev = dev->ieee80211_ptr; 20896 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20897 struct sk_buff *msg; 20898 void *hdr; 20899 20900 trace_cfg80211_probe_status(dev, addr, cookie, acked); 20901 20902 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20903 20904 if (!msg) 20905 return; 20906 20907 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT); 20908 if (!hdr) { 20909 nlmsg_free(msg); 20910 return; 20911 } 20912 20913 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20914 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20915 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 20916 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 20917 NL80211_ATTR_PAD) || 20918 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) || 20919 (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL, 20920 ack_signal))) 20921 goto nla_put_failure; 20922 20923 genlmsg_end(msg, hdr); 20924 20925 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20926 NL80211_MCGRP_MLME, gfp); 20927 return; 20928 20929 nla_put_failure: 20930 nlmsg_free(msg); 20931 } 20932 EXPORT_SYMBOL(cfg80211_probe_status); 20933 20934 void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame, 20935 size_t len, int freq, int sig_dbm) 20936 { 20937 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20938 struct sk_buff *msg; 20939 void *hdr; 20940 struct cfg80211_beacon_registration *reg; 20941 20942 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm); 20943 20944 spin_lock_bh(&rdev->beacon_registrations_lock); 20945 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 20946 msg = nlmsg_new(len + 100, GFP_ATOMIC); 20947 if (!msg) { 20948 spin_unlock_bh(&rdev->beacon_registrations_lock); 20949 return; 20950 } 20951 20952 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 20953 if (!hdr) 20954 goto nla_put_failure; 20955 20956 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20957 (freq && 20958 (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 20959 KHZ_TO_MHZ(freq)) || 20960 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 20961 freq % 1000))) || 20962 (sig_dbm && 20963 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 20964 nla_put(msg, NL80211_ATTR_FRAME, len, frame)) 20965 goto nla_put_failure; 20966 20967 genlmsg_end(msg, hdr); 20968 20969 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid); 20970 } 20971 spin_unlock_bh(&rdev->beacon_registrations_lock); 20972 return; 20973 20974 nla_put_failure: 20975 spin_unlock_bh(&rdev->beacon_registrations_lock); 20976 nlmsg_free(msg); 20977 } 20978 EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz); 20979 20980 #ifdef CONFIG_PM 20981 static int cfg80211_net_detect_results(struct sk_buff *msg, 20982 struct cfg80211_wowlan_wakeup *wakeup) 20983 { 20984 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect; 20985 struct nlattr *nl_results, *nl_match, *nl_freqs; 20986 int i, j; 20987 20988 nl_results = nla_nest_start_noflag(msg, 20989 NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS); 20990 if (!nl_results) 20991 return -EMSGSIZE; 20992 20993 for (i = 0; i < nd->n_matches; i++) { 20994 struct cfg80211_wowlan_nd_match *match = nd->matches[i]; 20995 20996 nl_match = nla_nest_start_noflag(msg, i); 20997 if (!nl_match) 20998 break; 20999 21000 /* The SSID attribute is optional in nl80211, but for 21001 * simplicity reasons it's always present in the 21002 * cfg80211 structure. If a driver can't pass the 21003 * SSID, that needs to be changed. A zero length SSID 21004 * is still a valid SSID (wildcard), so it cannot be 21005 * used for this purpose. 21006 */ 21007 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len, 21008 match->ssid.ssid)) { 21009 nla_nest_cancel(msg, nl_match); 21010 goto out; 21011 } 21012 21013 if (match->n_channels) { 21014 nl_freqs = nla_nest_start_noflag(msg, 21015 NL80211_ATTR_SCAN_FREQUENCIES); 21016 if (!nl_freqs) { 21017 nla_nest_cancel(msg, nl_match); 21018 goto out; 21019 } 21020 21021 for (j = 0; j < match->n_channels; j++) { 21022 if (nla_put_u32(msg, j, match->channels[j])) { 21023 nla_nest_cancel(msg, nl_freqs); 21024 nla_nest_cancel(msg, nl_match); 21025 goto out; 21026 } 21027 } 21028 21029 nla_nest_end(msg, nl_freqs); 21030 } 21031 21032 nla_nest_end(msg, nl_match); 21033 } 21034 21035 out: 21036 nla_nest_end(msg, nl_results); 21037 return 0; 21038 } 21039 21040 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev, 21041 struct cfg80211_wowlan_wakeup *wakeup, 21042 gfp_t gfp) 21043 { 21044 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 21045 struct sk_buff *msg; 21046 void *hdr; 21047 int size = 200; 21048 21049 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup); 21050 21051 if (wakeup) 21052 size += wakeup->packet_present_len; 21053 21054 msg = nlmsg_new(size, gfp); 21055 if (!msg) 21056 return; 21057 21058 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN); 21059 if (!hdr) 21060 goto free_msg; 21061 21062 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21063 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21064 NL80211_ATTR_PAD)) 21065 goto free_msg; 21066 21067 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 21068 wdev->netdev->ifindex)) 21069 goto free_msg; 21070 21071 if (wakeup) { 21072 struct nlattr *reasons; 21073 21074 reasons = nla_nest_start_noflag(msg, 21075 NL80211_ATTR_WOWLAN_TRIGGERS); 21076 if (!reasons) 21077 goto free_msg; 21078 21079 if (wakeup->disconnect && 21080 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) 21081 goto free_msg; 21082 if (wakeup->magic_pkt && 21083 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) 21084 goto free_msg; 21085 if (wakeup->gtk_rekey_failure && 21086 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) 21087 goto free_msg; 21088 if (wakeup->eap_identity_req && 21089 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) 21090 goto free_msg; 21091 if (wakeup->four_way_handshake && 21092 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) 21093 goto free_msg; 21094 if (wakeup->rfkill_release && 21095 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)) 21096 goto free_msg; 21097 21098 if (wakeup->pattern_idx >= 0 && 21099 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 21100 wakeup->pattern_idx)) 21101 goto free_msg; 21102 21103 if (wakeup->tcp_match && 21104 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH)) 21105 goto free_msg; 21106 21107 if (wakeup->tcp_connlost && 21108 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST)) 21109 goto free_msg; 21110 21111 if (wakeup->tcp_nomoretokens && 21112 nla_put_flag(msg, 21113 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS)) 21114 goto free_msg; 21115 21116 if (wakeup->unprot_deauth_disassoc && 21117 nla_put_flag(msg, 21118 NL80211_WOWLAN_TRIG_UNPROTECTED_DEAUTH_DISASSOC)) 21119 goto free_msg; 21120 21121 if (wakeup->packet) { 21122 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211; 21123 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN; 21124 21125 if (!wakeup->packet_80211) { 21126 pkt_attr = 21127 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023; 21128 len_attr = 21129 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN; 21130 } 21131 21132 if (wakeup->packet_len && 21133 nla_put_u32(msg, len_attr, wakeup->packet_len)) 21134 goto free_msg; 21135 21136 if (nla_put(msg, pkt_attr, wakeup->packet_present_len, 21137 wakeup->packet)) 21138 goto free_msg; 21139 } 21140 21141 if (wakeup->net_detect && 21142 cfg80211_net_detect_results(msg, wakeup)) 21143 goto free_msg; 21144 21145 nla_nest_end(msg, reasons); 21146 } 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 return; 21153 21154 free_msg: 21155 nlmsg_free(msg); 21156 } 21157 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup); 21158 #endif 21159 21160 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer, 21161 enum nl80211_tdls_operation oper, 21162 u16 reason_code, 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_tdls_oper_request(wdev->wiphy, dev, peer, oper, 21170 reason_code); 21171 21172 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21173 if (!msg) 21174 return; 21175 21176 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER); 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_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) || 21185 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) || 21186 (reason_code > 0 && 21187 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code))) 21188 goto nla_put_failure; 21189 21190 genlmsg_end(msg, hdr); 21191 21192 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21193 NL80211_MCGRP_MLME, gfp); 21194 return; 21195 21196 nla_put_failure: 21197 nlmsg_free(msg); 21198 } 21199 EXPORT_SYMBOL(cfg80211_tdls_oper_request); 21200 21201 static int nl80211_netlink_notify(struct notifier_block * nb, 21202 unsigned long state, 21203 void *_notify) 21204 { 21205 struct netlink_notify *notify = _notify; 21206 struct cfg80211_registered_device *rdev; 21207 struct wireless_dev *wdev; 21208 struct cfg80211_beacon_registration *reg, *tmp; 21209 21210 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC) 21211 return NOTIFY_DONE; 21212 21213 rcu_read_lock(); 21214 21215 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 21216 struct cfg80211_sched_scan_request *sched_scan_req; 21217 21218 list_for_each_entry_rcu(sched_scan_req, 21219 &rdev->sched_scan_req_list, 21220 list) { 21221 if (sched_scan_req->owner_nlportid == notify->portid) { 21222 sched_scan_req->nl_owner_dead = true; 21223 wiphy_work_queue(&rdev->wiphy, 21224 &rdev->sched_scan_stop_wk); 21225 } 21226 } 21227 21228 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) { 21229 cfg80211_mlme_unregister_socket(wdev, notify->portid); 21230 21231 if (wdev->owner_nlportid == notify->portid) { 21232 wdev->nl_owner_dead = true; 21233 schedule_work(&rdev->destroy_work); 21234 } else if (wdev->conn_owner_nlportid == notify->portid) { 21235 schedule_work(&wdev->disconnect_wk); 21236 } 21237 21238 cfg80211_release_pmsr(wdev, notify->portid); 21239 } 21240 21241 spin_lock_bh(&rdev->beacon_registrations_lock); 21242 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations, 21243 list) { 21244 if (reg->nlportid == notify->portid) { 21245 list_del(®->list); 21246 kfree(reg); 21247 break; 21248 } 21249 } 21250 spin_unlock_bh(&rdev->beacon_registrations_lock); 21251 } 21252 21253 rcu_read_unlock(); 21254 21255 /* 21256 * It is possible that the user space process that is controlling the 21257 * indoor setting disappeared, so notify the regulatory core. 21258 */ 21259 regulatory_netlink_notify(notify->portid); 21260 return NOTIFY_OK; 21261 } 21262 21263 static struct notifier_block nl80211_netlink_notifier = { 21264 .notifier_call = nl80211_netlink_notify, 21265 }; 21266 21267 void cfg80211_ft_event(struct net_device *netdev, 21268 struct cfg80211_ft_event_params *ft_event) 21269 { 21270 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 21271 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21272 struct sk_buff *msg; 21273 void *hdr; 21274 21275 trace_cfg80211_ft_event(wiphy, netdev, ft_event); 21276 21277 if (!ft_event->target_ap) 21278 return; 21279 21280 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len, 21281 GFP_KERNEL); 21282 if (!msg) 21283 return; 21284 21285 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT); 21286 if (!hdr) 21287 goto out; 21288 21289 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21290 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 21291 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap)) 21292 goto out; 21293 21294 if (ft_event->ies && 21295 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies)) 21296 goto out; 21297 if (ft_event->ric_ies && 21298 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len, 21299 ft_event->ric_ies)) 21300 goto out; 21301 21302 genlmsg_end(msg, hdr); 21303 21304 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21305 NL80211_MCGRP_MLME, GFP_KERNEL); 21306 return; 21307 out: 21308 nlmsg_free(msg); 21309 } 21310 EXPORT_SYMBOL(cfg80211_ft_event); 21311 21312 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp) 21313 { 21314 struct cfg80211_registered_device *rdev; 21315 struct sk_buff *msg; 21316 void *hdr; 21317 u32 nlportid; 21318 21319 rdev = wiphy_to_rdev(wdev->wiphy); 21320 if (!rdev->crit_proto_nlportid) 21321 return; 21322 21323 nlportid = rdev->crit_proto_nlportid; 21324 rdev->crit_proto_nlportid = 0; 21325 21326 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21327 if (!msg) 21328 return; 21329 21330 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP); 21331 if (!hdr) 21332 goto nla_put_failure; 21333 21334 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21335 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21336 NL80211_ATTR_PAD)) 21337 goto nla_put_failure; 21338 21339 genlmsg_end(msg, hdr); 21340 21341 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 21342 return; 21343 21344 nla_put_failure: 21345 nlmsg_free(msg); 21346 } 21347 EXPORT_SYMBOL(cfg80211_crit_proto_stopped); 21348 21349 void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id) 21350 { 21351 struct wiphy *wiphy = wdev->wiphy; 21352 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21353 struct sk_buff *msg; 21354 void *hdr; 21355 21356 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 21357 if (!msg) 21358 return; 21359 21360 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP); 21361 if (!hdr) 21362 goto out; 21363 21364 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21365 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 21366 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 21367 NL80211_ATTR_PAD) || 21368 (wdev->valid_links && 21369 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 21370 goto out; 21371 21372 genlmsg_end(msg, hdr); 21373 21374 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 21375 NL80211_MCGRP_MLME, GFP_KERNEL); 21376 return; 21377 out: 21378 nlmsg_free(msg); 21379 } 21380 21381 int cfg80211_external_auth_request(struct net_device *dev, 21382 struct cfg80211_external_auth_params *params, 21383 gfp_t gfp) 21384 { 21385 struct wireless_dev *wdev = dev->ieee80211_ptr; 21386 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 21387 struct sk_buff *msg; 21388 void *hdr; 21389 21390 if (!wdev->conn_owner_nlportid) 21391 return -EINVAL; 21392 21393 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21394 if (!msg) 21395 return -ENOMEM; 21396 21397 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH); 21398 if (!hdr) 21399 goto nla_put_failure; 21400 21401 /* Some historical mistakes in drivers <-> userspace interface (notably 21402 * between drivers and wpa_supplicant) led to a big-endian conversion 21403 * being needed on NL80211_ATTR_AKM_SUITES _only_ when its value is 21404 * WLAN_AKM_SUITE_SAE. This is now fixed on userspace side, but for the 21405 * benefit of older wpa_supplicant versions, send this particular value 21406 * in big-endian. Note that newer wpa_supplicant will also detect this 21407 * particular value in big endian still, so it all continues to work. 21408 */ 21409 if (params->key_mgmt_suite == WLAN_AKM_SUITE_SAE) { 21410 if (nla_put_be32(msg, NL80211_ATTR_AKM_SUITES, 21411 cpu_to_be32(WLAN_AKM_SUITE_SAE))) 21412 goto nla_put_failure; 21413 } else { 21414 if (nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, 21415 params->key_mgmt_suite)) 21416 goto nla_put_failure; 21417 } 21418 21419 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21420 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 21421 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION, 21422 params->action) || 21423 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) || 21424 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len, 21425 params->ssid.ssid) || 21426 (!is_zero_ether_addr(params->mld_addr) && 21427 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr))) 21428 goto nla_put_failure; 21429 21430 genlmsg_end(msg, hdr); 21431 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 21432 wdev->conn_owner_nlportid); 21433 return 0; 21434 21435 nla_put_failure: 21436 nlmsg_free(msg); 21437 return -ENOBUFS; 21438 } 21439 EXPORT_SYMBOL(cfg80211_external_auth_request); 21440 21441 void cfg80211_update_owe_info_event(struct net_device *netdev, 21442 struct cfg80211_update_owe_info *owe_info, 21443 gfp_t gfp) 21444 { 21445 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 21446 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21447 struct sk_buff *msg; 21448 void *hdr; 21449 21450 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info); 21451 21452 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 21453 if (!msg) 21454 return; 21455 21456 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO); 21457 if (!hdr) 21458 goto nla_put_failure; 21459 21460 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 21461 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 21462 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer)) 21463 goto nla_put_failure; 21464 21465 if (!owe_info->ie_len || 21466 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie)) 21467 goto nla_put_failure; 21468 21469 if (owe_info->assoc_link_id != -1) { 21470 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 21471 owe_info->assoc_link_id)) 21472 goto nla_put_failure; 21473 21474 if (!is_zero_ether_addr(owe_info->peer_mld_addr) && 21475 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 21476 owe_info->peer_mld_addr)) 21477 goto nla_put_failure; 21478 } 21479 21480 genlmsg_end(msg, hdr); 21481 21482 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21483 NL80211_MCGRP_MLME, gfp); 21484 return; 21485 21486 nla_put_failure: 21487 genlmsg_cancel(msg, hdr); 21488 nlmsg_free(msg); 21489 } 21490 EXPORT_SYMBOL(cfg80211_update_owe_info_event); 21491 21492 void cfg80211_schedule_channels_check(struct wireless_dev *wdev) 21493 { 21494 struct wiphy *wiphy = wdev->wiphy; 21495 21496 /* Schedule channels check if NO_IR or DFS relaxations are supported */ 21497 if (wdev->iftype == NL80211_IFTYPE_STATION && 21498 (wiphy_ext_feature_isset(wiphy, 21499 NL80211_EXT_FEATURE_DFS_CONCURRENT) || 21500 (IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) && 21501 wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR))) 21502 reg_check_channels(); 21503 } 21504 EXPORT_SYMBOL(cfg80211_schedule_channels_check); 21505 21506 void cfg80211_epcs_changed(struct net_device *netdev, bool enabled) 21507 { 21508 struct wireless_dev *wdev = netdev->ieee80211_ptr; 21509 struct wiphy *wiphy = wdev->wiphy; 21510 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 21511 struct sk_buff *msg; 21512 void *hdr; 21513 21514 trace_cfg80211_epcs_changed(wdev, enabled); 21515 21516 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 21517 if (!msg) 21518 return; 21519 21520 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EPCS_CFG); 21521 if (!hdr) { 21522 nlmsg_free(msg); 21523 return; 21524 } 21525 21526 if (enabled && nla_put_flag(msg, NL80211_ATTR_EPCS)) 21527 goto nla_put_failure; 21528 21529 genlmsg_end(msg, hdr); 21530 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 21531 NL80211_MCGRP_MLME, GFP_KERNEL); 21532 return; 21533 21534 nla_put_failure: 21535 nlmsg_free(msg); 21536 } 21537 EXPORT_SYMBOL(cfg80211_epcs_changed); 21538 21539 /* initialisation/exit functions */ 21540 21541 int __init nl80211_init(void) 21542 { 21543 int err; 21544 21545 err = genl_register_family(&nl80211_fam); 21546 if (err) 21547 return err; 21548 21549 err = netlink_register_notifier(&nl80211_netlink_notifier); 21550 if (err) 21551 goto err_out; 21552 21553 return 0; 21554 err_out: 21555 genl_unregister_family(&nl80211_fam); 21556 return err; 21557 } 21558 21559 void nl80211_exit(void) 21560 { 21561 netlink_unregister_notifier(&nl80211_netlink_notifier); 21562 genl_unregister_family(&nl80211_fam); 21563 } 21564