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-2024 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 unsigned int fixedlen, hdrlen; 233 bool s1g_bcn; 234 235 if (len < offsetofend(typeof(*mgmt), frame_control)) 236 goto err; 237 238 s1g_bcn = ieee80211_is_s1g_beacon(mgmt->frame_control); 239 if (s1g_bcn) { 240 fixedlen = offsetof(struct ieee80211_ext, 241 u.s1g_beacon.variable); 242 hdrlen = offsetof(struct ieee80211_ext, u.s1g_beacon); 243 } else { 244 fixedlen = offsetof(struct ieee80211_mgmt, 245 u.beacon.variable); 246 hdrlen = offsetof(struct ieee80211_mgmt, u.beacon); 247 } 248 249 if (len < fixedlen) 250 goto err; 251 252 if (ieee80211_hdrlen(mgmt->frame_control) != hdrlen) 253 goto err; 254 255 data += fixedlen; 256 len -= fixedlen; 257 258 for_each_element(elem, data, len) { 259 /* nothing */ 260 } 261 262 if (for_each_element_completed(elem, data, len)) 263 return 0; 264 265 err: 266 NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head"); 267 return -EINVAL; 268 } 269 270 static int validate_ie_attr(const struct nlattr *attr, 271 struct netlink_ext_ack *extack) 272 { 273 const u8 *data = nla_data(attr); 274 unsigned int len = nla_len(attr); 275 const struct element *elem; 276 277 for_each_element(elem, data, len) { 278 /* nothing */ 279 } 280 281 if (for_each_element_completed(elem, data, len)) 282 return 0; 283 284 NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements"); 285 return -EINVAL; 286 } 287 288 static int validate_he_capa(const struct nlattr *attr, 289 struct netlink_ext_ack *extack) 290 { 291 if (!ieee80211_he_capa_size_ok(nla_data(attr), nla_len(attr))) 292 return -EINVAL; 293 294 return 0; 295 } 296 297 static int validate_supported_selectors(const struct nlattr *attr, 298 struct netlink_ext_ack *extack) 299 { 300 const u8 *supported_selectors = nla_data(attr); 301 u8 supported_selectors_len = nla_len(attr); 302 303 /* The top bit must not be set as it is not part of the selector */ 304 for (int i = 0; i < supported_selectors_len; i++) { 305 if (supported_selectors[i] & 0x80) 306 return -EINVAL; 307 } 308 309 return 0; 310 } 311 312 /* policy for the attributes */ 313 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR]; 314 315 static const struct nla_policy 316 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = { 317 [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, }, 318 [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY, 319 .len = U8_MAX }, 320 [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY, 321 .len = U8_MAX }, 322 }; 323 324 static const struct nla_policy 325 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = { 326 [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG }, 327 [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 }, 328 [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] = 329 NLA_POLICY_MAX(NLA_U8, 15), 330 [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 }, 331 [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] = 332 NLA_POLICY_MAX(NLA_U8, 15), 333 [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] = { .type = NLA_U8 }, 334 [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 }, 335 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG }, 336 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG }, 337 [NL80211_PMSR_FTM_REQ_ATTR_TRIGGER_BASED] = { .type = NLA_FLAG }, 338 [NL80211_PMSR_FTM_REQ_ATTR_NON_TRIGGER_BASED] = { .type = NLA_FLAG }, 339 [NL80211_PMSR_FTM_REQ_ATTR_LMR_FEEDBACK] = { .type = NLA_FLAG }, 340 [NL80211_PMSR_FTM_REQ_ATTR_BSS_COLOR] = { .type = NLA_U8 }, 341 }; 342 343 static const struct nla_policy 344 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = { 345 [NL80211_PMSR_TYPE_FTM] = 346 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy), 347 }; 348 349 static const struct nla_policy 350 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = { 351 [NL80211_PMSR_REQ_ATTR_DATA] = 352 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy), 353 [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG }, 354 }; 355 356 static const struct nla_policy 357 nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = { 358 [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR, 359 [NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy), 360 [NL80211_PMSR_PEER_ATTR_REQ] = 361 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy), 362 [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT }, 363 }; 364 365 static const struct nla_policy 366 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = { 367 [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT }, 368 [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT }, 369 [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT }, 370 [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT }, 371 [NL80211_PMSR_ATTR_PEERS] = 372 NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy), 373 }; 374 375 static const struct nla_policy 376 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = { 377 [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] = 378 NLA_POLICY_RANGE(NLA_U8, 1, 20), 379 [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] = 380 NLA_POLICY_RANGE(NLA_U8, 1, 20), 381 [NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] = 382 NLA_POLICY_RANGE(NLA_U8, 1, 20), 383 [NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] = 384 NLA_POLICY_EXACT_LEN(8), 385 [NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] = 386 NLA_POLICY_EXACT_LEN(8), 387 [NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 }, 388 }; 389 390 static const struct nla_policy 391 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = { 392 [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63), 393 [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG }, 394 [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG }, 395 }; 396 397 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = { 398 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY, 399 .len = NL80211_MAX_SUPP_RATES }, 400 [NL80211_TXRATE_HT] = { .type = NLA_BINARY, 401 .len = NL80211_MAX_SUPP_HT_RATES }, 402 [NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)), 403 [NL80211_TXRATE_GI] = { .type = NLA_U8 }, 404 [NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)), 405 [NL80211_TXRATE_HE_GI] = NLA_POLICY_RANGE(NLA_U8, 406 NL80211_RATE_INFO_HE_GI_0_8, 407 NL80211_RATE_INFO_HE_GI_3_2), 408 [NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8, 409 NL80211_RATE_INFO_HE_1XLTF, 410 NL80211_RATE_INFO_HE_4XLTF), 411 }; 412 413 static const struct nla_policy 414 nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = { 415 [NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 }, 416 [NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 }, 417 [NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG }, 418 [NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff), 419 [NL80211_TID_CONFIG_ATTR_NOACK] = 420 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 421 [NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 422 [NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 423 [NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] = 424 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 425 [NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] = 426 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 427 [NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] = 428 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 429 [NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] = 430 NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED), 431 [NL80211_TID_CONFIG_ATTR_TX_RATE] = 432 NLA_POLICY_NESTED(nl80211_txattr_policy), 433 }; 434 435 static const struct nla_policy 436 nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = { 437 [NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000), 438 [NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000), 439 [NL80211_FILS_DISCOVERY_ATTR_TMPL] = 440 NLA_POLICY_RANGE(NLA_BINARY, 441 NL80211_FILS_DISCOVERY_TMPL_MIN_LEN, 442 IEEE80211_MAX_DATA_LEN), 443 }; 444 445 static const struct nla_policy 446 nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = { 447 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20), 448 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY, 449 .len = IEEE80211_MAX_DATA_LEN } 450 }; 451 452 static const struct nla_policy 453 sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = { 454 [NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 }, 455 [NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 }, 456 }; 457 458 static const struct nla_policy 459 sar_policy[NL80211_SAR_ATTR_MAX + 1] = { 460 [NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE), 461 [NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy), 462 }; 463 464 static const struct nla_policy 465 nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = { 466 [NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2), 467 [NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] = 468 NLA_POLICY_MIN(NLA_U8, 1), 469 [NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 }, 470 [NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 }, 471 [NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG }, 472 }; 473 474 static const struct nla_policy 475 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = { 476 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 }, 477 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 }, 478 }; 479 480 static const struct netlink_range_validation nl80211_punct_bitmap_range = { 481 .min = 0, 482 .max = 0xffff, 483 }; 484 485 static const struct netlink_range_validation q_range = { 486 .max = INT_MAX, 487 }; 488 489 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = { 490 [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD }, 491 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 }, 492 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING, 493 .len = 20-1 }, 494 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED }, 495 496 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 }, 497 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 }, 498 [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8, 499 NL80211_EDMG_CHANNELS_MIN, 500 NL80211_EDMG_CHANNELS_MAX), 501 [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8, 502 NL80211_EDMG_BW_CONFIG_MIN, 503 NL80211_EDMG_BW_CONFIG_MAX), 504 505 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 }, 506 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 }, 507 [NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 508 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 }, 509 510 [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 511 [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 512 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 }, 513 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 }, 514 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 }, 515 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG }, 516 517 [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX), 518 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 }, 519 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 }, 520 521 [NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 522 [NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 523 524 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, }, 525 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY, 526 .len = WLAN_MAX_KEY_LEN }, 527 [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7), 528 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 }, 529 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG }, 530 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 531 [NL80211_ATTR_KEY_TYPE] = 532 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES), 533 534 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 }, 535 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 }, 536 [NL80211_ATTR_BEACON_HEAD] = 537 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 538 IEEE80211_MAX_DATA_LEN), 539 [NL80211_ATTR_BEACON_TAIL] = 540 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 541 IEEE80211_MAX_DATA_LEN), 542 [NL80211_ATTR_STA_AID] = 543 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 544 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED }, 545 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 }, 546 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY, 547 .len = NL80211_MAX_SUPP_RATES }, 548 [NL80211_ATTR_STA_PLINK_ACTION] = 549 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1), 550 [NL80211_ATTR_STA_TX_POWER_SETTING] = 551 NLA_POLICY_RANGE(NLA_U8, 552 NL80211_TX_POWER_AUTOMATIC, 553 NL80211_TX_POWER_FIXED), 554 [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 }, 555 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 }, 556 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ }, 557 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY, 558 .len = IEEE80211_MAX_MESH_ID_LEN }, 559 [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT, 560 561 /* allow 3 for NUL-termination, we used to declare this NLA_STRING */ 562 [NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3), 563 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED }, 564 565 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 }, 566 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 }, 567 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 }, 568 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY, 569 .len = NL80211_MAX_SUPP_RATES }, 570 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 }, 571 572 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED }, 573 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG }, 574 575 [NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN), 576 577 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 }, 578 [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY, 579 validate_ie_attr, 580 IEEE80211_MAX_DATA_LEN), 581 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED }, 582 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED }, 583 584 [NL80211_ATTR_SSID] = { .type = NLA_BINARY, 585 .len = IEEE80211_MAX_SSID_LEN }, 586 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 }, 587 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 }, 588 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG }, 589 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG }, 590 [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32, 591 NL80211_MFP_NO, 592 NL80211_MFP_OPTIONAL), 593 [NL80211_ATTR_STA_FLAGS2] = 594 NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)), 595 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG }, 596 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 }, 597 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG }, 598 [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG }, 599 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG }, 600 [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 }, 601 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 }, 602 [NL80211_ATTR_WPA_VERSIONS] = 603 NLA_POLICY_RANGE(NLA_U32, 0, 604 NL80211_WPA_VERSION_1 | 605 NL80211_WPA_VERSION_2 | 606 NL80211_WPA_VERSION_3), 607 [NL80211_ATTR_PID] = { .type = NLA_U32 }, 608 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 }, 609 [NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN), 610 [NL80211_ATTR_DURATION] = { .type = NLA_U32 }, 611 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 }, 612 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED }, 613 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY, 614 .len = IEEE80211_MAX_DATA_LEN }, 615 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, }, 616 [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32, 617 NL80211_PS_DISABLED, 618 NL80211_PS_ENABLED), 619 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, }, 620 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG }, 621 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 }, 622 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 }, 623 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 }, 624 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 }, 625 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 }, 626 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 }, 627 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 }, 628 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG }, 629 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 630 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED }, 631 [NL80211_ATTR_STA_PLINK_STATE] = 632 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1), 633 [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 }, 634 [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG }, 635 [NL80211_ATTR_MESH_PEER_AID] = 636 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 637 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 }, 638 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED }, 639 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED }, 640 [NL80211_ATTR_HIDDEN_SSID] = 641 NLA_POLICY_RANGE(NLA_U32, 642 NL80211_HIDDEN_SSID_NOT_IN_USE, 643 NL80211_HIDDEN_SSID_ZERO_CONTENTS), 644 [NL80211_ATTR_IE_PROBE_RESP] = 645 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 646 IEEE80211_MAX_DATA_LEN), 647 [NL80211_ATTR_IE_ASSOC_RESP] = 648 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 649 IEEE80211_MAX_DATA_LEN), 650 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG }, 651 [NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy), 652 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED }, 653 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG }, 654 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 }, 655 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 }, 656 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 }, 657 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG }, 658 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG }, 659 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG }, 660 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG }, 661 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY, 662 .len = IEEE80211_MAX_DATA_LEN }, 663 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 }, 664 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG }, 665 [NL80211_ATTR_HT_CAPABILITY_MASK] = { 666 .len = NL80211_HT_CAPABILITY_LEN 667 }, 668 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 }, 669 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 }, 670 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 }, 671 [NL80211_ATTR_WDEV] = { .type = NLA_U64 }, 672 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 }, 673 674 /* need to include at least Auth Transaction and Status Code */ 675 [NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4), 676 677 [NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN), 678 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 }, 679 [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127), 680 [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1), 681 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = 682 NLA_POLICY_RANGE(NLA_U32, 683 NL80211_MESH_POWER_UNKNOWN + 1, 684 NL80211_MESH_POWER_MAX), 685 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 }, 686 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED }, 687 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 }, 688 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, }, 689 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, }, 690 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG }, 691 [NL80211_ATTR_VHT_CAPABILITY_MASK] = { 692 .len = NL80211_VHT_CAPABILITY_LEN, 693 }, 694 [NL80211_ATTR_MDID] = { .type = NLA_U16 }, 695 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY, 696 .len = IEEE80211_MAX_DATA_LEN }, 697 [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 }, 698 [NL80211_ATTR_MAX_CRIT_PROT_DURATION] = 699 NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION), 700 [NL80211_ATTR_PEER_AID] = 701 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 702 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 }, 703 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG }, 704 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED }, 705 [NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY }, 706 [NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY }, 707 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2), 708 /* 709 * The value of the Length field of the Supported Operating 710 * Classes element is between 2 and 253. 711 */ 712 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = 713 NLA_POLICY_RANGE(NLA_BINARY, 2, 253), 714 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG }, 715 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 }, 716 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 }, 717 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 }, 718 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY }, 719 [NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY, 720 IEEE80211_QOS_MAP_LEN_MIN, 721 IEEE80211_QOS_MAP_LEN_MAX), 722 [NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 723 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 }, 724 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 }, 725 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG }, 726 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY }, 727 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG }, 728 [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1), 729 [NL80211_ATTR_USER_PRIO] = 730 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1), 731 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 }, 732 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 }, 733 [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 }, 734 [NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 735 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG }, 736 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 }, 737 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 }, 738 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG }, 739 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG }, 740 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED }, 741 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = 742 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1), 743 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = { 744 .len = VHT_MUMIMO_GROUPS_DATA_LEN 745 }, 746 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 747 [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1), 748 [NL80211_ATTR_BANDS] = { .type = NLA_U32 }, 749 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED }, 750 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY, 751 .len = FILS_MAX_KEK_LEN }, 752 [NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN), 753 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, }, 754 [NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 755 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 }, 756 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = { 757 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 758 }, 759 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 }, 760 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY, 761 .len = FILS_ERP_MAX_USERNAME_LEN }, 762 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY, 763 .len = FILS_ERP_MAX_REALM_LEN }, 764 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 }, 765 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY, 766 .len = FILS_ERP_MAX_RRK_LEN }, 767 [NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2), 768 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN }, 769 [NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN), 770 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG }, 771 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG }, 772 773 [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 }, 774 [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 }, 775 [NL80211_ATTR_TXQ_QUANTUM] = NLA_POLICY_FULL_RANGE(NLA_U32, &q_range), 776 [NL80211_ATTR_HE_CAPABILITY] = 777 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa, 778 NL80211_HE_MAX_CAPABILITY_LEN), 779 [NL80211_ATTR_FTM_RESPONDER] = 780 NLA_POLICY_NESTED(nl80211_ftm_responder_policy), 781 [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1), 782 [NL80211_ATTR_PEER_MEASUREMENTS] = 783 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy), 784 [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1), 785 [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY, 786 .len = SAE_PASSWORD_MAX_LEN }, 787 [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG }, 788 [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy), 789 [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2), 790 [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy), 791 [NL80211_ATTR_TID_CONFIG] = 792 NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy), 793 [NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG }, 794 [NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1), 795 [NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100), 796 [NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG }, 797 [NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 798 [NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED }, 799 [NL80211_ATTR_HE_6GHZ_CAPABILITY] = 800 NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)), 801 [NL80211_ATTR_FILS_DISCOVERY] = 802 NLA_POLICY_NESTED(nl80211_fils_discovery_policy), 803 [NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] = 804 NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy), 805 [NL80211_ATTR_S1G_CAPABILITY] = 806 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 807 [NL80211_ATTR_S1G_CAPABILITY_MASK] = 808 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 809 [NL80211_ATTR_SAE_PWE] = 810 NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK, 811 NL80211_SAE_PWE_BOTH), 812 [NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT }, 813 [NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy), 814 [NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG }, 815 [NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 }, 816 [NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 }, 817 [NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 }, 818 [NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy), 819 [NL80211_ATTR_MBSSID_CONFIG] = 820 NLA_POLICY_NESTED(nl80211_mbssid_config_policy), 821 [NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED }, 822 [NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG }, 823 [NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 }, 824 [NL80211_ATTR_EHT_CAPABILITY] = 825 NLA_POLICY_RANGE(NLA_BINARY, 826 NL80211_EHT_MIN_CAPABILITY_LEN, 827 NL80211_EHT_MAX_CAPABILITY_LEN), 828 [NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG }, 829 [NL80211_ATTR_MLO_LINKS] = 830 NLA_POLICY_NESTED_ARRAY(nl80211_policy), 831 [NL80211_ATTR_MLO_LINK_ID] = 832 NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS - 1), 833 [NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN), 834 [NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG }, 835 [NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT }, 836 [NL80211_ATTR_PUNCT_BITMAP] = 837 NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range), 838 839 [NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS] = { .type = NLA_U16 }, 840 [NL80211_ATTR_HW_TIMESTAMP_ENABLED] = { .type = NLA_FLAG }, 841 [NL80211_ATTR_EMA_RNR_ELEMS] = { .type = NLA_NESTED }, 842 [NL80211_ATTR_MLO_LINK_DISABLED] = { .type = NLA_FLAG }, 843 [NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA] = { .type = NLA_FLAG }, 844 [NL80211_ATTR_MLO_TTLM_DLINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 845 [NL80211_ATTR_MLO_TTLM_ULINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 846 [NL80211_ATTR_ASSOC_SPP_AMSDU] = { .type = NLA_FLAG }, 847 [NL80211_ATTR_VIF_RADIO_MASK] = { .type = NLA_U32 }, 848 [NL80211_ATTR_SUPPORTED_SELECTORS] = 849 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_supported_selectors, 850 NL80211_MAX_SUPP_SELECTORS), 851 [NL80211_ATTR_MLO_RECONF_REM_LINKS] = { .type = NLA_U16 }, 852 [NL80211_ATTR_EPCS] = { .type = NLA_FLAG }, 853 }; 854 855 /* policy for the key attributes */ 856 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = { 857 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN }, 858 [NL80211_KEY_IDX] = { .type = NLA_U8 }, 859 [NL80211_KEY_CIPHER] = { .type = NLA_U32 }, 860 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 861 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG }, 862 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG }, 863 [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1), 864 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 865 [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX), 866 }; 867 868 /* policy for the key default flags */ 869 static const struct nla_policy 870 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = { 871 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG }, 872 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG }, 873 }; 874 875 #ifdef CONFIG_PM 876 /* policy for WoWLAN attributes */ 877 static const struct nla_policy 878 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = { 879 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG }, 880 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG }, 881 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG }, 882 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED }, 883 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG }, 884 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG }, 885 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG }, 886 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG }, 887 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED }, 888 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED }, 889 }; 890 891 static const struct nla_policy 892 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = { 893 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 }, 894 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 }, 895 [NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 896 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 }, 897 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 }, 898 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 899 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = { 900 .len = sizeof(struct nl80211_wowlan_tcp_data_seq) 901 }, 902 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = { 903 .len = sizeof(struct nl80211_wowlan_tcp_data_token) 904 }, 905 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 }, 906 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 907 [NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1), 908 }; 909 #endif /* CONFIG_PM */ 910 911 /* policy for coalesce rule attributes */ 912 static const struct nla_policy 913 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = { 914 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 }, 915 [NL80211_ATTR_COALESCE_RULE_CONDITION] = 916 NLA_POLICY_RANGE(NLA_U32, 917 NL80211_COALESCE_CONDITION_MATCH, 918 NL80211_COALESCE_CONDITION_NO_MATCH), 919 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED }, 920 }; 921 922 /* policy for GTK rekey offload attributes */ 923 static const struct nla_policy 924 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = { 925 [NL80211_REKEY_DATA_KEK] = { 926 .type = NLA_BINARY, 927 .len = NL80211_KEK_EXT_LEN 928 }, 929 [NL80211_REKEY_DATA_KCK] = { 930 .type = NLA_BINARY, 931 .len = NL80211_KCK_EXT_LEN_32 932 }, 933 [NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN), 934 [NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 }, 935 }; 936 937 static const struct nla_policy 938 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = { 939 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY, 940 .len = IEEE80211_MAX_SSID_LEN }, 941 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 942 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 }, 943 }; 944 945 static const struct nla_policy 946 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = { 947 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 }, 948 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 }, 949 }; 950 951 static const struct nla_policy 952 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = { 953 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG }, 954 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 }, 955 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = { 956 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 957 }, 958 }; 959 960 /* policy for NAN function attributes */ 961 static const struct nla_policy 962 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = { 963 [NL80211_NAN_FUNC_TYPE] = 964 NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE), 965 [NL80211_NAN_FUNC_SERVICE_ID] = { 966 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN }, 967 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 }, 968 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG }, 969 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG }, 970 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 }, 971 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 }, 972 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 973 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG }, 974 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 }, 975 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY, 976 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN }, 977 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED }, 978 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED }, 979 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED }, 980 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 }, 981 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 }, 982 }; 983 984 /* policy for Service Response Filter attributes */ 985 static const struct nla_policy 986 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = { 987 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG }, 988 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY, 989 .len = NL80211_NAN_FUNC_SRF_MAX_LEN }, 990 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 }, 991 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED }, 992 }; 993 994 /* policy for packet pattern attributes */ 995 static const struct nla_policy 996 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = { 997 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, }, 998 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, }, 999 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 }, 1000 }; 1001 1002 static int nl80211_prepare_wdev_dump(struct netlink_callback *cb, 1003 struct cfg80211_registered_device **rdev, 1004 struct wireless_dev **wdev, 1005 struct nlattr **attrbuf) 1006 { 1007 int err; 1008 1009 if (!cb->args[0]) { 1010 struct nlattr **attrbuf_free = NULL; 1011 1012 if (!attrbuf) { 1013 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 1014 GFP_KERNEL); 1015 if (!attrbuf) 1016 return -ENOMEM; 1017 attrbuf_free = attrbuf; 1018 } 1019 1020 err = nlmsg_parse_deprecated(cb->nlh, 1021 GENL_HDRLEN + nl80211_fam.hdrsize, 1022 attrbuf, nl80211_fam.maxattr, 1023 nl80211_policy, NULL); 1024 if (err) { 1025 kfree(attrbuf_free); 1026 return err; 1027 } 1028 1029 rtnl_lock(); 1030 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk), 1031 attrbuf); 1032 kfree(attrbuf_free); 1033 if (IS_ERR(*wdev)) { 1034 rtnl_unlock(); 1035 return PTR_ERR(*wdev); 1036 } 1037 *rdev = wiphy_to_rdev((*wdev)->wiphy); 1038 mutex_lock(&(*rdev)->wiphy.mtx); 1039 rtnl_unlock(); 1040 /* 0 is the first index - add 1 to parse only once */ 1041 cb->args[0] = (*rdev)->wiphy_idx + 1; 1042 cb->args[1] = (*wdev)->identifier; 1043 } else { 1044 /* subtract the 1 again here */ 1045 struct wiphy *wiphy; 1046 struct wireless_dev *tmp; 1047 1048 rtnl_lock(); 1049 wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 1050 if (!wiphy) { 1051 rtnl_unlock(); 1052 return -ENODEV; 1053 } 1054 *rdev = wiphy_to_rdev(wiphy); 1055 *wdev = NULL; 1056 1057 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) { 1058 if (tmp->identifier == cb->args[1]) { 1059 *wdev = tmp; 1060 break; 1061 } 1062 } 1063 1064 if (!*wdev) { 1065 rtnl_unlock(); 1066 return -ENODEV; 1067 } 1068 mutex_lock(&(*rdev)->wiphy.mtx); 1069 rtnl_unlock(); 1070 } 1071 1072 return 0; 1073 } 1074 1075 /* message building helper */ 1076 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq, 1077 int flags, u8 cmd) 1078 { 1079 /* since there is no private header just add the generic one */ 1080 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd); 1081 } 1082 1083 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg, 1084 const struct ieee80211_reg_rule *rule) 1085 { 1086 int j; 1087 struct nlattr *nl_wmm_rules = 1088 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM); 1089 1090 if (!nl_wmm_rules) 1091 goto nla_put_failure; 1092 1093 for (j = 0; j < IEEE80211_NUM_ACS; j++) { 1094 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j); 1095 1096 if (!nl_wmm_rule) 1097 goto nla_put_failure; 1098 1099 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN, 1100 rule->wmm_rule.client[j].cw_min) || 1101 nla_put_u16(msg, NL80211_WMMR_CW_MAX, 1102 rule->wmm_rule.client[j].cw_max) || 1103 nla_put_u8(msg, NL80211_WMMR_AIFSN, 1104 rule->wmm_rule.client[j].aifsn) || 1105 nla_put_u16(msg, NL80211_WMMR_TXOP, 1106 rule->wmm_rule.client[j].cot)) 1107 goto nla_put_failure; 1108 1109 nla_nest_end(msg, nl_wmm_rule); 1110 } 1111 nla_nest_end(msg, nl_wmm_rules); 1112 1113 return 0; 1114 1115 nla_put_failure: 1116 return -ENOBUFS; 1117 } 1118 1119 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy, 1120 struct ieee80211_channel *chan, 1121 bool large) 1122 { 1123 /* Some channels must be completely excluded from the 1124 * list to protect old user-space tools from breaking 1125 */ 1126 if (!large && chan->flags & 1127 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ)) 1128 return 0; 1129 if (!large && chan->freq_offset) 1130 return 0; 1131 1132 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ, 1133 chan->center_freq)) 1134 goto nla_put_failure; 1135 1136 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset)) 1137 goto nla_put_failure; 1138 1139 if ((chan->flags & IEEE80211_CHAN_PSD) && 1140 nla_put_s8(msg, NL80211_FREQUENCY_ATTR_PSD, chan->psd)) 1141 goto nla_put_failure; 1142 1143 if ((chan->flags & IEEE80211_CHAN_DISABLED) && 1144 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED)) 1145 goto nla_put_failure; 1146 if (chan->flags & IEEE80211_CHAN_NO_IR) { 1147 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR)) 1148 goto nla_put_failure; 1149 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS)) 1150 goto nla_put_failure; 1151 } 1152 if (chan->flags & IEEE80211_CHAN_RADAR) { 1153 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR)) 1154 goto nla_put_failure; 1155 if (large) { 1156 u32 time; 1157 1158 time = elapsed_jiffies_msecs(chan->dfs_state_entered); 1159 1160 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE, 1161 chan->dfs_state)) 1162 goto nla_put_failure; 1163 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME, 1164 time)) 1165 goto nla_put_failure; 1166 if (nla_put_u32(msg, 1167 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME, 1168 chan->dfs_cac_ms)) 1169 goto nla_put_failure; 1170 } 1171 } 1172 1173 if (large) { 1174 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) && 1175 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS)) 1176 goto nla_put_failure; 1177 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) && 1178 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS)) 1179 goto nla_put_failure; 1180 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) && 1181 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ)) 1182 goto nla_put_failure; 1183 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) && 1184 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ)) 1185 goto nla_put_failure; 1186 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) && 1187 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY)) 1188 goto nla_put_failure; 1189 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) && 1190 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT)) 1191 goto nla_put_failure; 1192 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) && 1193 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ)) 1194 goto nla_put_failure; 1195 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) && 1196 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ)) 1197 goto nla_put_failure; 1198 if ((chan->flags & IEEE80211_CHAN_NO_HE) && 1199 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE)) 1200 goto nla_put_failure; 1201 if ((chan->flags & IEEE80211_CHAN_1MHZ) && 1202 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_1MHZ)) 1203 goto nla_put_failure; 1204 if ((chan->flags & IEEE80211_CHAN_2MHZ) && 1205 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_2MHZ)) 1206 goto nla_put_failure; 1207 if ((chan->flags & IEEE80211_CHAN_4MHZ) && 1208 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_4MHZ)) 1209 goto nla_put_failure; 1210 if ((chan->flags & IEEE80211_CHAN_8MHZ) && 1211 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_8MHZ)) 1212 goto nla_put_failure; 1213 if ((chan->flags & IEEE80211_CHAN_16MHZ) && 1214 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_16MHZ)) 1215 goto nla_put_failure; 1216 if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) && 1217 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ)) 1218 goto nla_put_failure; 1219 if ((chan->flags & IEEE80211_CHAN_NO_EHT) && 1220 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT)) 1221 goto nla_put_failure; 1222 if ((chan->flags & IEEE80211_CHAN_DFS_CONCURRENT) && 1223 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DFS_CONCURRENT)) 1224 goto nla_put_failure; 1225 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_VLP_CLIENT) && 1226 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_VLP_CLIENT)) 1227 goto nla_put_failure; 1228 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_AFC_CLIENT) && 1229 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_AFC_CLIENT)) 1230 goto nla_put_failure; 1231 if ((chan->flags & IEEE80211_CHAN_CAN_MONITOR) && 1232 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_CAN_MONITOR)) 1233 goto nla_put_failure; 1234 if ((chan->flags & IEEE80211_CHAN_ALLOW_6GHZ_VLP_AP) && 1235 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_ALLOW_6GHZ_VLP_AP)) 1236 goto nla_put_failure; 1237 } 1238 1239 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER, 1240 DBM_TO_MBM(chan->max_power))) 1241 goto nla_put_failure; 1242 1243 if (large) { 1244 const struct ieee80211_reg_rule *rule = 1245 freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq)); 1246 1247 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) { 1248 if (nl80211_msg_put_wmm_rules(msg, rule)) 1249 goto nla_put_failure; 1250 } 1251 } 1252 1253 return 0; 1254 1255 nla_put_failure: 1256 return -ENOBUFS; 1257 } 1258 1259 static bool nl80211_put_txq_stats(struct sk_buff *msg, 1260 struct cfg80211_txq_stats *txqstats, 1261 int attrtype) 1262 { 1263 struct nlattr *txqattr; 1264 1265 #define PUT_TXQVAL_U32(attr, memb) do { \ 1266 if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \ 1267 nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \ 1268 return false; \ 1269 } while (0) 1270 1271 txqattr = nla_nest_start_noflag(msg, attrtype); 1272 if (!txqattr) 1273 return false; 1274 1275 PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes); 1276 PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets); 1277 PUT_TXQVAL_U32(FLOWS, flows); 1278 PUT_TXQVAL_U32(DROPS, drops); 1279 PUT_TXQVAL_U32(ECN_MARKS, ecn_marks); 1280 PUT_TXQVAL_U32(OVERLIMIT, overlimit); 1281 PUT_TXQVAL_U32(OVERMEMORY, overmemory); 1282 PUT_TXQVAL_U32(COLLISIONS, collisions); 1283 PUT_TXQVAL_U32(TX_BYTES, tx_bytes); 1284 PUT_TXQVAL_U32(TX_PACKETS, tx_packets); 1285 PUT_TXQVAL_U32(MAX_FLOWS, max_flows); 1286 nla_nest_end(msg, txqattr); 1287 1288 #undef PUT_TXQVAL_U32 1289 return true; 1290 } 1291 1292 /* netlink command implementations */ 1293 1294 /** 1295 * nl80211_link_id - return link ID 1296 * @attrs: attributes to look at 1297 * 1298 * Returns: the link ID or 0 if not given 1299 * 1300 * Note this function doesn't do any validation of the link 1301 * ID validity wrt. links that were actually added, so it must 1302 * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID 1303 * or if additional validation is done. 1304 */ 1305 static unsigned int nl80211_link_id(struct nlattr **attrs) 1306 { 1307 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1308 1309 return nla_get_u8_default(linkid, 0); 1310 } 1311 1312 static int nl80211_link_id_or_invalid(struct nlattr **attrs) 1313 { 1314 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1315 1316 if (!linkid) 1317 return -1; 1318 1319 return nla_get_u8(linkid); 1320 } 1321 1322 struct key_parse { 1323 struct key_params p; 1324 int idx; 1325 int type; 1326 bool def, defmgmt, defbeacon; 1327 bool def_uni, def_multi; 1328 }; 1329 1330 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key, 1331 struct key_parse *k) 1332 { 1333 struct nlattr *tb[NL80211_KEY_MAX + 1]; 1334 int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key, 1335 nl80211_key_policy, 1336 info->extack); 1337 if (err) 1338 return err; 1339 1340 k->def = !!tb[NL80211_KEY_DEFAULT]; 1341 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT]; 1342 k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON]; 1343 1344 if (k->def) { 1345 k->def_uni = true; 1346 k->def_multi = true; 1347 } 1348 if (k->defmgmt || k->defbeacon) 1349 k->def_multi = true; 1350 1351 if (tb[NL80211_KEY_IDX]) 1352 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]); 1353 1354 if (tb[NL80211_KEY_DATA]) { 1355 k->p.key = nla_data(tb[NL80211_KEY_DATA]); 1356 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]); 1357 } 1358 1359 if (tb[NL80211_KEY_SEQ]) { 1360 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]); 1361 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]); 1362 } 1363 1364 if (tb[NL80211_KEY_CIPHER]) 1365 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]); 1366 1367 if (tb[NL80211_KEY_TYPE]) 1368 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]); 1369 1370 if (tb[NL80211_KEY_DEFAULT_TYPES]) { 1371 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1372 1373 err = nla_parse_nested_deprecated(kdt, 1374 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1375 tb[NL80211_KEY_DEFAULT_TYPES], 1376 nl80211_key_default_policy, 1377 info->extack); 1378 if (err) 1379 return err; 1380 1381 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1382 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1383 } 1384 1385 if (tb[NL80211_KEY_MODE]) 1386 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]); 1387 1388 return 0; 1389 } 1390 1391 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k) 1392 { 1393 if (info->attrs[NL80211_ATTR_KEY_DATA]) { 1394 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]); 1395 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]); 1396 } 1397 1398 if (info->attrs[NL80211_ATTR_KEY_SEQ]) { 1399 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]); 1400 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]); 1401 } 1402 1403 if (info->attrs[NL80211_ATTR_KEY_IDX]) 1404 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 1405 1406 if (info->attrs[NL80211_ATTR_KEY_CIPHER]) 1407 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]); 1408 1409 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT]; 1410 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT]; 1411 1412 if (k->def) { 1413 k->def_uni = true; 1414 k->def_multi = true; 1415 } 1416 if (k->defmgmt) 1417 k->def_multi = true; 1418 1419 if (info->attrs[NL80211_ATTR_KEY_TYPE]) 1420 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 1421 1422 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) { 1423 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1424 int err = nla_parse_nested_deprecated(kdt, 1425 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1426 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES], 1427 nl80211_key_default_policy, 1428 info->extack); 1429 if (err) 1430 return err; 1431 1432 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1433 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1434 } 1435 1436 return 0; 1437 } 1438 1439 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k) 1440 { 1441 int err; 1442 1443 memset(k, 0, sizeof(*k)); 1444 k->idx = -1; 1445 k->type = -1; 1446 1447 if (info->attrs[NL80211_ATTR_KEY]) 1448 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k); 1449 else 1450 err = nl80211_parse_key_old(info, k); 1451 1452 if (err) 1453 return err; 1454 1455 if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) + 1456 (k->defbeacon ? 1 : 0) > 1) { 1457 GENL_SET_ERR_MSG(info, 1458 "key with multiple default flags is invalid"); 1459 return -EINVAL; 1460 } 1461 1462 if (k->defmgmt || k->defbeacon) { 1463 if (k->def_uni || !k->def_multi) { 1464 GENL_SET_ERR_MSG(info, 1465 "defmgmt/defbeacon key must be mcast"); 1466 return -EINVAL; 1467 } 1468 } 1469 1470 if (k->idx != -1) { 1471 if (k->defmgmt) { 1472 if (k->idx < 4 || k->idx > 5) { 1473 GENL_SET_ERR_MSG(info, 1474 "defmgmt key idx not 4 or 5"); 1475 return -EINVAL; 1476 } 1477 } else if (k->defbeacon) { 1478 if (k->idx < 6 || k->idx > 7) { 1479 GENL_SET_ERR_MSG(info, 1480 "defbeacon key idx not 6 or 7"); 1481 return -EINVAL; 1482 } 1483 } else if (k->def) { 1484 if (k->idx < 0 || k->idx > 3) { 1485 GENL_SET_ERR_MSG(info, "def key idx not 0-3"); 1486 return -EINVAL; 1487 } 1488 } else { 1489 if (k->idx < 0 || k->idx > 7) { 1490 GENL_SET_ERR_MSG(info, "key idx not 0-7"); 1491 return -EINVAL; 1492 } 1493 } 1494 } 1495 1496 return 0; 1497 } 1498 1499 static struct cfg80211_cached_keys * 1500 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev, 1501 struct genl_info *info, bool *no_ht) 1502 { 1503 struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS]; 1504 struct key_parse parse; 1505 struct nlattr *key; 1506 struct cfg80211_cached_keys *result; 1507 int rem, err, def = 0; 1508 bool have_key = false; 1509 1510 nla_for_each_nested(key, keys, rem) { 1511 have_key = true; 1512 break; 1513 } 1514 1515 if (!have_key) 1516 return NULL; 1517 1518 result = kzalloc(sizeof(*result), GFP_KERNEL); 1519 if (!result) 1520 return ERR_PTR(-ENOMEM); 1521 1522 result->def = -1; 1523 1524 nla_for_each_nested(key, keys, rem) { 1525 memset(&parse, 0, sizeof(parse)); 1526 parse.idx = -1; 1527 1528 err = nl80211_parse_key_new(info, key, &parse); 1529 if (err) 1530 goto error; 1531 err = -EINVAL; 1532 if (!parse.p.key) 1533 goto error; 1534 if (parse.idx < 0 || parse.idx > 3) { 1535 GENL_SET_ERR_MSG(info, "key index out of range [0-3]"); 1536 goto error; 1537 } 1538 if (parse.def) { 1539 if (def) { 1540 GENL_SET_ERR_MSG(info, 1541 "only one key can be default"); 1542 goto error; 1543 } 1544 def = 1; 1545 result->def = parse.idx; 1546 if (!parse.def_uni || !parse.def_multi) 1547 goto error; 1548 } else if (parse.defmgmt) 1549 goto error; 1550 err = cfg80211_validate_key_settings(rdev, &parse.p, 1551 parse.idx, false, NULL); 1552 if (err) 1553 goto error; 1554 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 && 1555 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) { 1556 GENL_SET_ERR_MSG(info, "connect key must be WEP"); 1557 err = -EINVAL; 1558 goto error; 1559 } 1560 result->params[parse.idx].cipher = parse.p.cipher; 1561 result->params[parse.idx].key_len = parse.p.key_len; 1562 result->params[parse.idx].key = result->data[parse.idx]; 1563 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len); 1564 1565 /* must be WEP key if we got here */ 1566 if (no_ht) 1567 *no_ht = true; 1568 } 1569 1570 if (result->def < 0) { 1571 err = -EINVAL; 1572 GENL_SET_ERR_MSG(info, "need a default/TX key"); 1573 goto error; 1574 } 1575 1576 return result; 1577 error: 1578 kfree(result); 1579 return ERR_PTR(err); 1580 } 1581 1582 static int nl80211_key_allowed(struct wireless_dev *wdev) 1583 { 1584 lockdep_assert_wiphy(wdev->wiphy); 1585 1586 switch (wdev->iftype) { 1587 case NL80211_IFTYPE_AP: 1588 case NL80211_IFTYPE_AP_VLAN: 1589 case NL80211_IFTYPE_P2P_GO: 1590 case NL80211_IFTYPE_MESH_POINT: 1591 break; 1592 case NL80211_IFTYPE_ADHOC: 1593 if (wdev->u.ibss.current_bss) 1594 return 0; 1595 return -ENOLINK; 1596 case NL80211_IFTYPE_STATION: 1597 case NL80211_IFTYPE_P2P_CLIENT: 1598 if (wdev->connected) 1599 return 0; 1600 return -ENOLINK; 1601 case NL80211_IFTYPE_NAN: 1602 if (wiphy_ext_feature_isset(wdev->wiphy, 1603 NL80211_EXT_FEATURE_SECURE_NAN)) 1604 return 0; 1605 return -EINVAL; 1606 case NL80211_IFTYPE_UNSPECIFIED: 1607 case NL80211_IFTYPE_OCB: 1608 case NL80211_IFTYPE_MONITOR: 1609 case NL80211_IFTYPE_P2P_DEVICE: 1610 case NL80211_IFTYPE_WDS: 1611 case NUM_NL80211_IFTYPES: 1612 return -EINVAL; 1613 } 1614 1615 return 0; 1616 } 1617 1618 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy, 1619 u32 freq) 1620 { 1621 struct ieee80211_channel *chan; 1622 1623 chan = ieee80211_get_channel_khz(wiphy, freq); 1624 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) 1625 return NULL; 1626 return chan; 1627 } 1628 1629 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes) 1630 { 1631 struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr); 1632 int i; 1633 1634 if (!nl_modes) 1635 goto nla_put_failure; 1636 1637 i = 0; 1638 while (ifmodes) { 1639 if ((ifmodes & 1) && nla_put_flag(msg, i)) 1640 goto nla_put_failure; 1641 ifmodes >>= 1; 1642 i++; 1643 } 1644 1645 nla_nest_end(msg, nl_modes); 1646 return 0; 1647 1648 nla_put_failure: 1649 return -ENOBUFS; 1650 } 1651 1652 static int nl80211_put_ifcomb_data(struct sk_buff *msg, bool large, int idx, 1653 const struct ieee80211_iface_combination *c, 1654 u16 nested) 1655 { 1656 struct nlattr *nl_combi, *nl_limits; 1657 int i; 1658 1659 nl_combi = nla_nest_start_noflag(msg, idx | nested); 1660 if (!nl_combi) 1661 goto nla_put_failure; 1662 1663 nl_limits = nla_nest_start_noflag(msg, NL80211_IFACE_COMB_LIMITS | 1664 nested); 1665 if (!nl_limits) 1666 goto nla_put_failure; 1667 1668 for (i = 0; i < c->n_limits; i++) { 1669 struct nlattr *nl_limit; 1670 1671 nl_limit = nla_nest_start_noflag(msg, i + 1); 1672 if (!nl_limit) 1673 goto nla_put_failure; 1674 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, c->limits[i].max)) 1675 goto nla_put_failure; 1676 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES, 1677 c->limits[i].types)) 1678 goto nla_put_failure; 1679 nla_nest_end(msg, nl_limit); 1680 } 1681 1682 nla_nest_end(msg, nl_limits); 1683 1684 if (c->beacon_int_infra_match && 1685 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH)) 1686 goto nla_put_failure; 1687 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS, 1688 c->num_different_channels) || 1689 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM, 1690 c->max_interfaces)) 1691 goto nla_put_failure; 1692 if (large && 1693 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS, 1694 c->radar_detect_widths) || 1695 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS, 1696 c->radar_detect_regions))) 1697 goto nla_put_failure; 1698 if (c->beacon_int_min_gcd && 1699 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD, 1700 c->beacon_int_min_gcd)) 1701 goto nla_put_failure; 1702 1703 nla_nest_end(msg, nl_combi); 1704 1705 return 0; 1706 nla_put_failure: 1707 return -ENOBUFS; 1708 } 1709 1710 static int nl80211_put_iface_combinations(struct wiphy *wiphy, 1711 struct sk_buff *msg, 1712 int attr, int radio, 1713 bool large, u16 nested) 1714 { 1715 const struct ieee80211_iface_combination *c; 1716 struct nlattr *nl_combis; 1717 int i, n; 1718 1719 nl_combis = nla_nest_start_noflag(msg, attr | nested); 1720 if (!nl_combis) 1721 goto nla_put_failure; 1722 1723 if (radio >= 0) { 1724 c = wiphy->radio[0].iface_combinations; 1725 n = wiphy->radio[0].n_iface_combinations; 1726 } else { 1727 c = wiphy->iface_combinations; 1728 n = wiphy->n_iface_combinations; 1729 } 1730 for (i = 0; i < n; i++) 1731 if (nl80211_put_ifcomb_data(msg, large, i + 1, &c[i], nested)) 1732 goto nla_put_failure; 1733 1734 nla_nest_end(msg, nl_combis); 1735 1736 return 0; 1737 nla_put_failure: 1738 return -ENOBUFS; 1739 } 1740 1741 #ifdef CONFIG_PM 1742 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev, 1743 struct sk_buff *msg) 1744 { 1745 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp; 1746 struct nlattr *nl_tcp; 1747 1748 if (!tcp) 1749 return 0; 1750 1751 nl_tcp = nla_nest_start_noflag(msg, 1752 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 1753 if (!nl_tcp) 1754 return -ENOBUFS; 1755 1756 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1757 tcp->data_payload_max)) 1758 return -ENOBUFS; 1759 1760 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1761 tcp->data_payload_max)) 1762 return -ENOBUFS; 1763 1764 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ)) 1765 return -ENOBUFS; 1766 1767 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 1768 sizeof(*tcp->tok), tcp->tok)) 1769 return -ENOBUFS; 1770 1771 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 1772 tcp->data_interval_max)) 1773 return -ENOBUFS; 1774 1775 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 1776 tcp->wake_payload_max)) 1777 return -ENOBUFS; 1778 1779 nla_nest_end(msg, nl_tcp); 1780 return 0; 1781 } 1782 1783 static int nl80211_send_wowlan(struct sk_buff *msg, 1784 struct cfg80211_registered_device *rdev, 1785 bool large) 1786 { 1787 struct nlattr *nl_wowlan; 1788 1789 if (!rdev->wiphy.wowlan) 1790 return 0; 1791 1792 nl_wowlan = nla_nest_start_noflag(msg, 1793 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED); 1794 if (!nl_wowlan) 1795 return -ENOBUFS; 1796 1797 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) && 1798 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 1799 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) && 1800 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 1801 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) && 1802 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 1803 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) && 1804 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) || 1805 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) && 1806 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 1807 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) && 1808 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 1809 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) && 1810 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 1811 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) && 1812 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 1813 return -ENOBUFS; 1814 1815 if (rdev->wiphy.wowlan->n_patterns) { 1816 struct nl80211_pattern_support pat = { 1817 .max_patterns = rdev->wiphy.wowlan->n_patterns, 1818 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len, 1819 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len, 1820 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset, 1821 }; 1822 1823 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 1824 sizeof(pat), &pat)) 1825 return -ENOBUFS; 1826 } 1827 1828 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) && 1829 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT, 1830 rdev->wiphy.wowlan->max_nd_match_sets)) 1831 return -ENOBUFS; 1832 1833 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg)) 1834 return -ENOBUFS; 1835 1836 nla_nest_end(msg, nl_wowlan); 1837 1838 return 0; 1839 } 1840 #endif 1841 1842 static int nl80211_send_coalesce(struct sk_buff *msg, 1843 struct cfg80211_registered_device *rdev) 1844 { 1845 struct nl80211_coalesce_rule_support rule; 1846 1847 if (!rdev->wiphy.coalesce) 1848 return 0; 1849 1850 rule.max_rules = rdev->wiphy.coalesce->n_rules; 1851 rule.max_delay = rdev->wiphy.coalesce->max_delay; 1852 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns; 1853 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len; 1854 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len; 1855 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset; 1856 1857 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule)) 1858 return -ENOBUFS; 1859 1860 return 0; 1861 } 1862 1863 static int 1864 nl80211_send_iftype_data(struct sk_buff *msg, 1865 const struct ieee80211_supported_band *sband, 1866 const struct ieee80211_sband_iftype_data *iftdata) 1867 { 1868 const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap; 1869 const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap; 1870 1871 if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES, 1872 iftdata->types_mask)) 1873 return -ENOBUFS; 1874 1875 if (he_cap->has_he) { 1876 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC, 1877 sizeof(he_cap->he_cap_elem.mac_cap_info), 1878 he_cap->he_cap_elem.mac_cap_info) || 1879 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY, 1880 sizeof(he_cap->he_cap_elem.phy_cap_info), 1881 he_cap->he_cap_elem.phy_cap_info) || 1882 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET, 1883 sizeof(he_cap->he_mcs_nss_supp), 1884 &he_cap->he_mcs_nss_supp) || 1885 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE, 1886 sizeof(he_cap->ppe_thres), he_cap->ppe_thres)) 1887 return -ENOBUFS; 1888 } 1889 1890 if (eht_cap->has_eht && he_cap->has_he) { 1891 u8 mcs_nss_size, ppe_thresh_size; 1892 u16 ppe_thres_hdr; 1893 bool is_ap; 1894 1895 is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) || 1896 iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO); 1897 1898 mcs_nss_size = 1899 ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 1900 &eht_cap->eht_cap_elem, 1901 is_ap); 1902 1903 ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]); 1904 ppe_thresh_size = 1905 ieee80211_eht_ppe_size(ppe_thres_hdr, 1906 eht_cap->eht_cap_elem.phy_cap_info); 1907 1908 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC, 1909 sizeof(eht_cap->eht_cap_elem.mac_cap_info), 1910 eht_cap->eht_cap_elem.mac_cap_info) || 1911 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY, 1912 sizeof(eht_cap->eht_cap_elem.phy_cap_info), 1913 eht_cap->eht_cap_elem.phy_cap_info) || 1914 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET, 1915 mcs_nss_size, &eht_cap->eht_mcs_nss_supp) || 1916 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE, 1917 ppe_thresh_size, eht_cap->eht_ppe_thres)) 1918 return -ENOBUFS; 1919 } 1920 1921 if (sband->band == NL80211_BAND_6GHZ && 1922 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA, 1923 sizeof(iftdata->he_6ghz_capa), 1924 &iftdata->he_6ghz_capa)) 1925 return -ENOBUFS; 1926 1927 if (iftdata->vendor_elems.data && iftdata->vendor_elems.len && 1928 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS, 1929 iftdata->vendor_elems.len, iftdata->vendor_elems.data)) 1930 return -ENOBUFS; 1931 1932 return 0; 1933 } 1934 1935 static int nl80211_send_band_rateinfo(struct sk_buff *msg, 1936 struct ieee80211_supported_band *sband, 1937 bool large) 1938 { 1939 struct nlattr *nl_rates, *nl_rate; 1940 struct ieee80211_rate *rate; 1941 int i; 1942 1943 /* add HT info */ 1944 if (sband->ht_cap.ht_supported && 1945 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET, 1946 sizeof(sband->ht_cap.mcs), 1947 &sband->ht_cap.mcs) || 1948 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA, 1949 sband->ht_cap.cap) || 1950 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR, 1951 sband->ht_cap.ampdu_factor) || 1952 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY, 1953 sband->ht_cap.ampdu_density))) 1954 return -ENOBUFS; 1955 1956 /* add VHT info */ 1957 if (sband->vht_cap.vht_supported && 1958 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET, 1959 sizeof(sband->vht_cap.vht_mcs), 1960 &sband->vht_cap.vht_mcs) || 1961 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA, 1962 sband->vht_cap.cap))) 1963 return -ENOBUFS; 1964 1965 if (large && sband->n_iftype_data) { 1966 struct nlattr *nl_iftype_data = 1967 nla_nest_start_noflag(msg, 1968 NL80211_BAND_ATTR_IFTYPE_DATA); 1969 const struct ieee80211_sband_iftype_data *iftd; 1970 int err; 1971 1972 if (!nl_iftype_data) 1973 return -ENOBUFS; 1974 1975 for_each_sband_iftype_data(sband, i, iftd) { 1976 struct nlattr *iftdata; 1977 1978 iftdata = nla_nest_start_noflag(msg, i + 1); 1979 if (!iftdata) 1980 return -ENOBUFS; 1981 1982 err = nl80211_send_iftype_data(msg, sband, iftd); 1983 if (err) 1984 return err; 1985 1986 nla_nest_end(msg, iftdata); 1987 } 1988 1989 nla_nest_end(msg, nl_iftype_data); 1990 } 1991 1992 /* add EDMG info */ 1993 if (large && sband->edmg_cap.channels && 1994 (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS, 1995 sband->edmg_cap.channels) || 1996 nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG, 1997 sband->edmg_cap.bw_config))) 1998 1999 return -ENOBUFS; 2000 2001 /* add bitrates */ 2002 nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES); 2003 if (!nl_rates) 2004 return -ENOBUFS; 2005 2006 for (i = 0; i < sband->n_bitrates; i++) { 2007 nl_rate = nla_nest_start_noflag(msg, i); 2008 if (!nl_rate) 2009 return -ENOBUFS; 2010 2011 rate = &sband->bitrates[i]; 2012 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE, 2013 rate->bitrate)) 2014 return -ENOBUFS; 2015 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) && 2016 nla_put_flag(msg, 2017 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE)) 2018 return -ENOBUFS; 2019 2020 nla_nest_end(msg, nl_rate); 2021 } 2022 2023 nla_nest_end(msg, nl_rates); 2024 2025 /* S1G capabilities */ 2026 if (sband->band == NL80211_BAND_S1GHZ && sband->s1g_cap.s1g && 2027 (nla_put(msg, NL80211_BAND_ATTR_S1G_CAPA, 2028 sizeof(sband->s1g_cap.cap), 2029 sband->s1g_cap.cap) || 2030 nla_put(msg, NL80211_BAND_ATTR_S1G_MCS_NSS_SET, 2031 sizeof(sband->s1g_cap.nss_mcs), 2032 sband->s1g_cap.nss_mcs))) 2033 return -ENOBUFS; 2034 2035 return 0; 2036 } 2037 2038 static int 2039 nl80211_send_mgmt_stypes(struct sk_buff *msg, 2040 const struct ieee80211_txrx_stypes *mgmt_stypes) 2041 { 2042 u16 stypes; 2043 struct nlattr *nl_ftypes, *nl_ifs; 2044 enum nl80211_iftype ift; 2045 int i; 2046 2047 if (!mgmt_stypes) 2048 return 0; 2049 2050 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES); 2051 if (!nl_ifs) 2052 return -ENOBUFS; 2053 2054 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2055 nl_ftypes = nla_nest_start_noflag(msg, ift); 2056 if (!nl_ftypes) 2057 return -ENOBUFS; 2058 i = 0; 2059 stypes = mgmt_stypes[ift].tx; 2060 while (stypes) { 2061 if ((stypes & 1) && 2062 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2063 (i << 4) | IEEE80211_FTYPE_MGMT)) 2064 return -ENOBUFS; 2065 stypes >>= 1; 2066 i++; 2067 } 2068 nla_nest_end(msg, nl_ftypes); 2069 } 2070 2071 nla_nest_end(msg, nl_ifs); 2072 2073 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES); 2074 if (!nl_ifs) 2075 return -ENOBUFS; 2076 2077 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2078 nl_ftypes = nla_nest_start_noflag(msg, ift); 2079 if (!nl_ftypes) 2080 return -ENOBUFS; 2081 i = 0; 2082 stypes = mgmt_stypes[ift].rx; 2083 while (stypes) { 2084 if ((stypes & 1) && 2085 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2086 (i << 4) | IEEE80211_FTYPE_MGMT)) 2087 return -ENOBUFS; 2088 stypes >>= 1; 2089 i++; 2090 } 2091 nla_nest_end(msg, nl_ftypes); 2092 } 2093 nla_nest_end(msg, nl_ifs); 2094 2095 return 0; 2096 } 2097 2098 #define CMD(op, n) \ 2099 do { \ 2100 if (rdev->ops->op) { \ 2101 i++; \ 2102 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \ 2103 goto nla_put_failure; \ 2104 } \ 2105 } while (0) 2106 2107 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev, 2108 struct sk_buff *msg) 2109 { 2110 int i = 0; 2111 2112 /* 2113 * do *NOT* add anything into this function, new things need to be 2114 * advertised only to new versions of userspace that can deal with 2115 * the split (and they can't possibly care about new features... 2116 */ 2117 CMD(add_virtual_intf, NEW_INTERFACE); 2118 CMD(change_virtual_intf, SET_INTERFACE); 2119 CMD(add_key, NEW_KEY); 2120 CMD(start_ap, START_AP); 2121 CMD(add_station, NEW_STATION); 2122 CMD(add_mpath, NEW_MPATH); 2123 CMD(update_mesh_config, SET_MESH_CONFIG); 2124 CMD(change_bss, SET_BSS); 2125 CMD(auth, AUTHENTICATE); 2126 CMD(assoc, ASSOCIATE); 2127 CMD(deauth, DEAUTHENTICATE); 2128 CMD(disassoc, DISASSOCIATE); 2129 CMD(join_ibss, JOIN_IBSS); 2130 CMD(join_mesh, JOIN_MESH); 2131 CMD(set_pmksa, SET_PMKSA); 2132 CMD(del_pmksa, DEL_PMKSA); 2133 CMD(flush_pmksa, FLUSH_PMKSA); 2134 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) 2135 CMD(remain_on_channel, REMAIN_ON_CHANNEL); 2136 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK); 2137 CMD(mgmt_tx, FRAME); 2138 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL); 2139 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) { 2140 i++; 2141 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS)) 2142 goto nla_put_failure; 2143 } 2144 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap || 2145 rdev->ops->join_mesh) { 2146 i++; 2147 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL)) 2148 goto nla_put_failure; 2149 } 2150 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) { 2151 CMD(tdls_mgmt, TDLS_MGMT); 2152 CMD(tdls_oper, TDLS_OPER); 2153 } 2154 if (rdev->wiphy.max_sched_scan_reqs) 2155 CMD(sched_scan_start, START_SCHED_SCAN); 2156 CMD(probe_client, PROBE_CLIENT); 2157 CMD(set_noack_map, SET_NOACK_MAP); 2158 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) { 2159 i++; 2160 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS)) 2161 goto nla_put_failure; 2162 } 2163 CMD(start_p2p_device, START_P2P_DEVICE); 2164 CMD(set_mcast_rate, SET_MCAST_RATE); 2165 #ifdef CONFIG_NL80211_TESTMODE 2166 CMD(testmode_cmd, TESTMODE); 2167 #endif 2168 2169 if (rdev->ops->connect || rdev->ops->auth) { 2170 i++; 2171 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT)) 2172 goto nla_put_failure; 2173 } 2174 2175 if (rdev->ops->disconnect || rdev->ops->deauth) { 2176 i++; 2177 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT)) 2178 goto nla_put_failure; 2179 } 2180 2181 return i; 2182 nla_put_failure: 2183 return -ENOBUFS; 2184 } 2185 2186 static int 2187 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap, 2188 struct sk_buff *msg) 2189 { 2190 struct nlattr *ftm; 2191 2192 if (!cap->ftm.supported) 2193 return 0; 2194 2195 ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM); 2196 if (!ftm) 2197 return -ENOBUFS; 2198 2199 if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP)) 2200 return -ENOBUFS; 2201 if (cap->ftm.non_asap && 2202 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP)) 2203 return -ENOBUFS; 2204 if (cap->ftm.request_lci && 2205 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI)) 2206 return -ENOBUFS; 2207 if (cap->ftm.request_civicloc && 2208 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC)) 2209 return -ENOBUFS; 2210 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES, 2211 cap->ftm.preambles)) 2212 return -ENOBUFS; 2213 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS, 2214 cap->ftm.bandwidths)) 2215 return -ENOBUFS; 2216 if (cap->ftm.max_bursts_exponent >= 0 && 2217 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT, 2218 cap->ftm.max_bursts_exponent)) 2219 return -ENOBUFS; 2220 if (cap->ftm.max_ftms_per_burst && 2221 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST, 2222 cap->ftm.max_ftms_per_burst)) 2223 return -ENOBUFS; 2224 if (cap->ftm.trigger_based && 2225 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED)) 2226 return -ENOBUFS; 2227 if (cap->ftm.non_trigger_based && 2228 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED)) 2229 return -ENOBUFS; 2230 2231 nla_nest_end(msg, ftm); 2232 return 0; 2233 } 2234 2235 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev, 2236 struct sk_buff *msg) 2237 { 2238 const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa; 2239 struct nlattr *pmsr, *caps; 2240 2241 if (!cap) 2242 return 0; 2243 2244 /* 2245 * we don't need to clean up anything here since the caller 2246 * will genlmsg_cancel() if we fail 2247 */ 2248 2249 pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS); 2250 if (!pmsr) 2251 return -ENOBUFS; 2252 2253 if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers)) 2254 return -ENOBUFS; 2255 2256 if (cap->report_ap_tsf && 2257 nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF)) 2258 return -ENOBUFS; 2259 2260 if (cap->randomize_mac_addr && 2261 nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR)) 2262 return -ENOBUFS; 2263 2264 caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA); 2265 if (!caps) 2266 return -ENOBUFS; 2267 2268 if (nl80211_send_pmsr_ftm_capa(cap, msg)) 2269 return -ENOBUFS; 2270 2271 nla_nest_end(msg, caps); 2272 nla_nest_end(msg, pmsr); 2273 2274 return 0; 2275 } 2276 2277 static int 2278 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev, 2279 struct sk_buff *msg) 2280 { 2281 int i; 2282 struct nlattr *nested, *nested_akms; 2283 const struct wiphy_iftype_akm_suites *iftype_akms; 2284 2285 if (!rdev->wiphy.num_iftype_akm_suites || 2286 !rdev->wiphy.iftype_akm_suites) 2287 return 0; 2288 2289 nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES); 2290 if (!nested) 2291 return -ENOBUFS; 2292 2293 for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) { 2294 nested_akms = nla_nest_start(msg, i + 1); 2295 if (!nested_akms) 2296 return -ENOBUFS; 2297 2298 iftype_akms = &rdev->wiphy.iftype_akm_suites[i]; 2299 2300 if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES, 2301 iftype_akms->iftypes_mask)) 2302 return -ENOBUFS; 2303 2304 if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES, 2305 sizeof(u32) * iftype_akms->n_akm_suites, 2306 iftype_akms->akm_suites)) { 2307 return -ENOBUFS; 2308 } 2309 nla_nest_end(msg, nested_akms); 2310 } 2311 2312 nla_nest_end(msg, nested); 2313 2314 return 0; 2315 } 2316 2317 static int 2318 nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev, 2319 struct sk_buff *msg) 2320 { 2321 struct nlattr *supp; 2322 2323 if (!rdev->wiphy.tid_config_support.vif && 2324 !rdev->wiphy.tid_config_support.peer) 2325 return 0; 2326 2327 supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG); 2328 if (!supp) 2329 return -ENOSPC; 2330 2331 if (rdev->wiphy.tid_config_support.vif && 2332 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP, 2333 rdev->wiphy.tid_config_support.vif, 2334 NL80211_TID_CONFIG_ATTR_PAD)) 2335 goto fail; 2336 2337 if (rdev->wiphy.tid_config_support.peer && 2338 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP, 2339 rdev->wiphy.tid_config_support.peer, 2340 NL80211_TID_CONFIG_ATTR_PAD)) 2341 goto fail; 2342 2343 /* for now we just use the same value ... makes more sense */ 2344 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT, 2345 rdev->wiphy.tid_config_support.max_retry)) 2346 goto fail; 2347 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG, 2348 rdev->wiphy.tid_config_support.max_retry)) 2349 goto fail; 2350 2351 nla_nest_end(msg, supp); 2352 2353 return 0; 2354 fail: 2355 nla_nest_cancel(msg, supp); 2356 return -ENOBUFS; 2357 } 2358 2359 static int 2360 nl80211_put_sar_specs(struct cfg80211_registered_device *rdev, 2361 struct sk_buff *msg) 2362 { 2363 struct nlattr *sar_capa, *specs, *sub_freq_range; 2364 u8 num_freq_ranges; 2365 int i; 2366 2367 if (!rdev->wiphy.sar_capa) 2368 return 0; 2369 2370 num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges; 2371 2372 sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC); 2373 if (!sar_capa) 2374 return -ENOSPC; 2375 2376 if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type)) 2377 goto fail; 2378 2379 specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS); 2380 if (!specs) 2381 goto fail; 2382 2383 /* report supported freq_ranges */ 2384 for (i = 0; i < num_freq_ranges; i++) { 2385 sub_freq_range = nla_nest_start(msg, i + 1); 2386 if (!sub_freq_range) 2387 goto fail; 2388 2389 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ, 2390 rdev->wiphy.sar_capa->freq_ranges[i].start_freq)) 2391 goto fail; 2392 2393 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ, 2394 rdev->wiphy.sar_capa->freq_ranges[i].end_freq)) 2395 goto fail; 2396 2397 nla_nest_end(msg, sub_freq_range); 2398 } 2399 2400 nla_nest_end(msg, specs); 2401 nla_nest_end(msg, sar_capa); 2402 2403 return 0; 2404 fail: 2405 nla_nest_cancel(msg, sar_capa); 2406 return -ENOBUFS; 2407 } 2408 2409 static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg) 2410 { 2411 struct nlattr *config; 2412 2413 if (!wiphy->mbssid_max_interfaces) 2414 return 0; 2415 2416 config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG); 2417 if (!config) 2418 return -ENOBUFS; 2419 2420 if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES, 2421 wiphy->mbssid_max_interfaces)) 2422 goto fail; 2423 2424 if (wiphy->ema_max_profile_periodicity && 2425 nla_put_u8(msg, 2426 NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY, 2427 wiphy->ema_max_profile_periodicity)) 2428 goto fail; 2429 2430 nla_nest_end(msg, config); 2431 return 0; 2432 2433 fail: 2434 nla_nest_cancel(msg, config); 2435 return -ENOBUFS; 2436 } 2437 2438 static int nl80211_put_radio(struct wiphy *wiphy, struct sk_buff *msg, int idx) 2439 { 2440 const struct wiphy_radio *r = &wiphy->radio[idx]; 2441 struct nlattr *radio, *freq; 2442 int i; 2443 2444 radio = nla_nest_start(msg, idx); 2445 if (!radio) 2446 return -ENOBUFS; 2447 2448 if (nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_INDEX, idx)) 2449 goto nla_put_failure; 2450 2451 if (r->antenna_mask && 2452 nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_ANTENNA_MASK, 2453 r->antenna_mask)) 2454 goto nla_put_failure; 2455 2456 for (i = 0; i < r->n_freq_range; i++) { 2457 const struct wiphy_radio_freq_range *range = &r->freq_range[i]; 2458 2459 freq = nla_nest_start(msg, NL80211_WIPHY_RADIO_ATTR_FREQ_RANGE); 2460 if (!freq) 2461 goto nla_put_failure; 2462 2463 if (nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_START, 2464 range->start_freq) || 2465 nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_END, 2466 range->end_freq)) 2467 goto nla_put_failure; 2468 2469 nla_nest_end(msg, freq); 2470 } 2471 2472 for (i = 0; i < r->n_iface_combinations; i++) 2473 if (nl80211_put_ifcomb_data(msg, true, 2474 NL80211_WIPHY_RADIO_ATTR_INTERFACE_COMBINATION, 2475 &r->iface_combinations[i], 2476 NLA_F_NESTED)) 2477 goto nla_put_failure; 2478 2479 nla_nest_end(msg, radio); 2480 2481 return 0; 2482 2483 nla_put_failure: 2484 return -ENOBUFS; 2485 } 2486 2487 static int nl80211_put_radios(struct wiphy *wiphy, struct sk_buff *msg) 2488 { 2489 struct nlattr *radios; 2490 int i; 2491 2492 if (!wiphy->n_radio) 2493 return 0; 2494 2495 radios = nla_nest_start(msg, NL80211_ATTR_WIPHY_RADIOS); 2496 if (!radios) 2497 return -ENOBUFS; 2498 2499 for (i = 0; i < wiphy->n_radio; i++) 2500 if (nl80211_put_radio(wiphy, msg, i)) 2501 goto fail; 2502 2503 nla_nest_end(msg, radios); 2504 2505 if (nl80211_put_iface_combinations(wiphy, msg, 2506 NL80211_ATTR_WIPHY_INTERFACE_COMBINATIONS, 2507 -1, true, NLA_F_NESTED)) 2508 return -ENOBUFS; 2509 2510 return 0; 2511 2512 fail: 2513 nla_nest_cancel(msg, radios); 2514 return -ENOBUFS; 2515 } 2516 2517 struct nl80211_dump_wiphy_state { 2518 s64 filter_wiphy; 2519 long start; 2520 long split_start, band_start, chan_start, capa_start; 2521 bool split; 2522 }; 2523 2524 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev, 2525 enum nl80211_commands cmd, 2526 struct sk_buff *msg, u32 portid, u32 seq, 2527 int flags, struct nl80211_dump_wiphy_state *state) 2528 { 2529 void *hdr; 2530 struct nlattr *nl_bands, *nl_band; 2531 struct nlattr *nl_freqs, *nl_freq; 2532 struct nlattr *nl_cmds; 2533 enum nl80211_band band; 2534 struct ieee80211_channel *chan; 2535 int i; 2536 const struct ieee80211_txrx_stypes *mgmt_stypes = 2537 rdev->wiphy.mgmt_stypes; 2538 u32 features; 2539 2540 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 2541 if (!hdr) 2542 return -ENOBUFS; 2543 2544 if (WARN_ON(!state)) 2545 return -EINVAL; 2546 2547 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 2548 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, 2549 wiphy_name(&rdev->wiphy)) || 2550 nla_put_u32(msg, NL80211_ATTR_GENERATION, 2551 cfg80211_rdev_list_generation)) 2552 goto nla_put_failure; 2553 2554 if (cmd != NL80211_CMD_NEW_WIPHY) 2555 goto finish; 2556 2557 switch (state->split_start) { 2558 case 0: 2559 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT, 2560 rdev->wiphy.retry_short) || 2561 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG, 2562 rdev->wiphy.retry_long) || 2563 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD, 2564 rdev->wiphy.frag_threshold) || 2565 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD, 2566 rdev->wiphy.rts_threshold) || 2567 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS, 2568 rdev->wiphy.coverage_class) || 2569 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS, 2570 rdev->wiphy.max_scan_ssids) || 2571 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS, 2572 rdev->wiphy.max_sched_scan_ssids) || 2573 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN, 2574 rdev->wiphy.max_scan_ie_len) || 2575 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN, 2576 rdev->wiphy.max_sched_scan_ie_len) || 2577 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS, 2578 rdev->wiphy.max_match_sets)) 2579 goto nla_put_failure; 2580 2581 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) && 2582 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN)) 2583 goto nla_put_failure; 2584 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) && 2585 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH)) 2586 goto nla_put_failure; 2587 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) && 2588 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD)) 2589 goto nla_put_failure; 2590 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) && 2591 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT)) 2592 goto nla_put_failure; 2593 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) && 2594 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT)) 2595 goto nla_put_failure; 2596 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) && 2597 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP)) 2598 goto nla_put_failure; 2599 state->split_start++; 2600 if (state->split) 2601 break; 2602 fallthrough; 2603 case 1: 2604 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES, 2605 sizeof(u32) * rdev->wiphy.n_cipher_suites, 2606 rdev->wiphy.cipher_suites)) 2607 goto nla_put_failure; 2608 2609 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS, 2610 rdev->wiphy.max_num_pmkids)) 2611 goto nla_put_failure; 2612 2613 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 2614 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE)) 2615 goto nla_put_failure; 2616 2617 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX, 2618 rdev->wiphy.available_antennas_tx) || 2619 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX, 2620 rdev->wiphy.available_antennas_rx)) 2621 goto nla_put_failure; 2622 2623 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) && 2624 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD, 2625 rdev->wiphy.probe_resp_offload)) 2626 goto nla_put_failure; 2627 2628 if ((rdev->wiphy.available_antennas_tx || 2629 rdev->wiphy.available_antennas_rx) && 2630 rdev->ops->get_antenna) { 2631 u32 tx_ant = 0, rx_ant = 0; 2632 int res; 2633 2634 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant); 2635 if (!res) { 2636 if (nla_put_u32(msg, 2637 NL80211_ATTR_WIPHY_ANTENNA_TX, 2638 tx_ant) || 2639 nla_put_u32(msg, 2640 NL80211_ATTR_WIPHY_ANTENNA_RX, 2641 rx_ant)) 2642 goto nla_put_failure; 2643 } 2644 } 2645 2646 state->split_start++; 2647 if (state->split) 2648 break; 2649 fallthrough; 2650 case 2: 2651 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES, 2652 rdev->wiphy.interface_modes)) 2653 goto nla_put_failure; 2654 state->split_start++; 2655 if (state->split) 2656 break; 2657 fallthrough; 2658 case 3: 2659 nl_bands = nla_nest_start_noflag(msg, 2660 NL80211_ATTR_WIPHY_BANDS); 2661 if (!nl_bands) 2662 goto nla_put_failure; 2663 2664 for (band = state->band_start; 2665 band < (state->split ? 2666 NUM_NL80211_BANDS : 2667 NL80211_BAND_60GHZ + 1); 2668 band++) { 2669 struct ieee80211_supported_band *sband; 2670 2671 /* omit higher bands for ancient software */ 2672 if (band > NL80211_BAND_5GHZ && !state->split) 2673 break; 2674 2675 sband = rdev->wiphy.bands[band]; 2676 2677 if (!sband) 2678 continue; 2679 2680 nl_band = nla_nest_start_noflag(msg, band); 2681 if (!nl_band) 2682 goto nla_put_failure; 2683 2684 switch (state->chan_start) { 2685 case 0: 2686 if (nl80211_send_band_rateinfo(msg, sband, 2687 state->split)) 2688 goto nla_put_failure; 2689 state->chan_start++; 2690 if (state->split) 2691 break; 2692 fallthrough; 2693 default: 2694 /* add frequencies */ 2695 nl_freqs = nla_nest_start_noflag(msg, 2696 NL80211_BAND_ATTR_FREQS); 2697 if (!nl_freqs) 2698 goto nla_put_failure; 2699 2700 for (i = state->chan_start - 1; 2701 i < sband->n_channels; 2702 i++) { 2703 nl_freq = nla_nest_start_noflag(msg, 2704 i); 2705 if (!nl_freq) 2706 goto nla_put_failure; 2707 2708 chan = &sband->channels[i]; 2709 2710 if (nl80211_msg_put_channel( 2711 msg, &rdev->wiphy, chan, 2712 state->split)) 2713 goto nla_put_failure; 2714 2715 nla_nest_end(msg, nl_freq); 2716 if (state->split) 2717 break; 2718 } 2719 if (i < sband->n_channels) 2720 state->chan_start = i + 2; 2721 else 2722 state->chan_start = 0; 2723 nla_nest_end(msg, nl_freqs); 2724 } 2725 2726 nla_nest_end(msg, nl_band); 2727 2728 if (state->split) { 2729 /* start again here */ 2730 if (state->chan_start) 2731 band--; 2732 break; 2733 } 2734 } 2735 nla_nest_end(msg, nl_bands); 2736 2737 if (band < NUM_NL80211_BANDS) 2738 state->band_start = band + 1; 2739 else 2740 state->band_start = 0; 2741 2742 /* if bands & channels are done, continue outside */ 2743 if (state->band_start == 0 && state->chan_start == 0) 2744 state->split_start++; 2745 if (state->split) 2746 break; 2747 fallthrough; 2748 case 4: 2749 nl_cmds = nla_nest_start_noflag(msg, 2750 NL80211_ATTR_SUPPORTED_COMMANDS); 2751 if (!nl_cmds) 2752 goto nla_put_failure; 2753 2754 i = nl80211_add_commands_unsplit(rdev, msg); 2755 if (i < 0) 2756 goto nla_put_failure; 2757 if (state->split) { 2758 CMD(crit_proto_start, CRIT_PROTOCOL_START); 2759 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP); 2760 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH) 2761 CMD(channel_switch, CHANNEL_SWITCH); 2762 CMD(set_qos_map, SET_QOS_MAP); 2763 if (rdev->wiphy.features & 2764 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION) 2765 CMD(add_tx_ts, ADD_TX_TS); 2766 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST); 2767 CMD(update_connect_params, UPDATE_CONNECT_PARAMS); 2768 CMD(update_ft_ies, UPDATE_FT_IES); 2769 if (rdev->wiphy.sar_capa) 2770 CMD(set_sar_specs, SET_SAR_SPECS); 2771 } 2772 #undef CMD 2773 2774 nla_nest_end(msg, nl_cmds); 2775 state->split_start++; 2776 if (state->split) 2777 break; 2778 fallthrough; 2779 case 5: 2780 if (rdev->ops->remain_on_channel && 2781 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) && 2782 nla_put_u32(msg, 2783 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION, 2784 rdev->wiphy.max_remain_on_channel_duration)) 2785 goto nla_put_failure; 2786 2787 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) && 2788 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK)) 2789 goto nla_put_failure; 2790 2791 state->split_start++; 2792 if (state->split) 2793 break; 2794 fallthrough; 2795 case 6: 2796 #ifdef CONFIG_PM 2797 if (nl80211_send_wowlan(msg, rdev, state->split)) 2798 goto nla_put_failure; 2799 state->split_start++; 2800 if (state->split) 2801 break; 2802 #else 2803 state->split_start++; 2804 #endif 2805 fallthrough; 2806 case 7: 2807 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES, 2808 rdev->wiphy.software_iftypes)) 2809 goto nla_put_failure; 2810 2811 if (nl80211_put_iface_combinations(&rdev->wiphy, msg, 2812 NL80211_ATTR_INTERFACE_COMBINATIONS, 2813 rdev->wiphy.n_radio ? 0 : -1, 2814 state->split, 0)) 2815 goto nla_put_failure; 2816 2817 state->split_start++; 2818 if (state->split) 2819 break; 2820 fallthrough; 2821 case 8: 2822 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) && 2823 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME, 2824 rdev->wiphy.ap_sme_capa)) 2825 goto nla_put_failure; 2826 2827 features = rdev->wiphy.features; 2828 /* 2829 * We can only add the per-channel limit information if the 2830 * dump is split, otherwise it makes it too big. Therefore 2831 * only advertise it in that case. 2832 */ 2833 if (state->split) 2834 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS; 2835 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features)) 2836 goto nla_put_failure; 2837 2838 if (rdev->wiphy.ht_capa_mod_mask && 2839 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK, 2840 sizeof(*rdev->wiphy.ht_capa_mod_mask), 2841 rdev->wiphy.ht_capa_mod_mask)) 2842 goto nla_put_failure; 2843 2844 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME && 2845 rdev->wiphy.max_acl_mac_addrs && 2846 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX, 2847 rdev->wiphy.max_acl_mac_addrs)) 2848 goto nla_put_failure; 2849 2850 /* 2851 * Any information below this point is only available to 2852 * applications that can deal with it being split. This 2853 * helps ensure that newly added capabilities don't break 2854 * older tools by overrunning their buffers. 2855 * 2856 * We still increment split_start so that in the split 2857 * case we'll continue with more data in the next round, 2858 * but break unconditionally so unsplit data stops here. 2859 */ 2860 if (state->split) 2861 state->split_start++; 2862 else 2863 state->split_start = 0; 2864 break; 2865 case 9: 2866 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes)) 2867 goto nla_put_failure; 2868 2869 if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS, 2870 rdev->wiphy.max_sched_scan_plans) || 2871 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL, 2872 rdev->wiphy.max_sched_scan_plan_interval) || 2873 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS, 2874 rdev->wiphy.max_sched_scan_plan_iterations)) 2875 goto nla_put_failure; 2876 2877 if (rdev->wiphy.extended_capabilities && 2878 (nla_put(msg, NL80211_ATTR_EXT_CAPA, 2879 rdev->wiphy.extended_capabilities_len, 2880 rdev->wiphy.extended_capabilities) || 2881 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2882 rdev->wiphy.extended_capabilities_len, 2883 rdev->wiphy.extended_capabilities_mask))) 2884 goto nla_put_failure; 2885 2886 if (rdev->wiphy.vht_capa_mod_mask && 2887 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK, 2888 sizeof(*rdev->wiphy.vht_capa_mod_mask), 2889 rdev->wiphy.vht_capa_mod_mask)) 2890 goto nla_put_failure; 2891 2892 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 2893 rdev->wiphy.perm_addr)) 2894 goto nla_put_failure; 2895 2896 if (!is_zero_ether_addr(rdev->wiphy.addr_mask) && 2897 nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN, 2898 rdev->wiphy.addr_mask)) 2899 goto nla_put_failure; 2900 2901 if (rdev->wiphy.n_addresses > 1) { 2902 void *attr; 2903 2904 attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS); 2905 if (!attr) 2906 goto nla_put_failure; 2907 2908 for (i = 0; i < rdev->wiphy.n_addresses; i++) 2909 if (nla_put(msg, i + 1, ETH_ALEN, 2910 rdev->wiphy.addresses[i].addr)) 2911 goto nla_put_failure; 2912 2913 nla_nest_end(msg, attr); 2914 } 2915 2916 state->split_start++; 2917 break; 2918 case 10: 2919 if (nl80211_send_coalesce(msg, rdev)) 2920 goto nla_put_failure; 2921 2922 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) && 2923 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) || 2924 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ))) 2925 goto nla_put_failure; 2926 2927 if (rdev->wiphy.max_ap_assoc_sta && 2928 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA, 2929 rdev->wiphy.max_ap_assoc_sta)) 2930 goto nla_put_failure; 2931 2932 state->split_start++; 2933 break; 2934 case 11: 2935 if (rdev->wiphy.n_vendor_commands) { 2936 const struct nl80211_vendor_cmd_info *info; 2937 struct nlattr *nested; 2938 2939 nested = nla_nest_start_noflag(msg, 2940 NL80211_ATTR_VENDOR_DATA); 2941 if (!nested) 2942 goto nla_put_failure; 2943 2944 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 2945 info = &rdev->wiphy.vendor_commands[i].info; 2946 if (nla_put(msg, i + 1, sizeof(*info), info)) 2947 goto nla_put_failure; 2948 } 2949 nla_nest_end(msg, nested); 2950 } 2951 2952 if (rdev->wiphy.n_vendor_events) { 2953 const struct nl80211_vendor_cmd_info *info; 2954 struct nlattr *nested; 2955 2956 nested = nla_nest_start_noflag(msg, 2957 NL80211_ATTR_VENDOR_EVENTS); 2958 if (!nested) 2959 goto nla_put_failure; 2960 2961 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) { 2962 info = &rdev->wiphy.vendor_events[i]; 2963 if (nla_put(msg, i + 1, sizeof(*info), info)) 2964 goto nla_put_failure; 2965 } 2966 nla_nest_end(msg, nested); 2967 } 2968 state->split_start++; 2969 break; 2970 case 12: 2971 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH && 2972 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS, 2973 rdev->wiphy.max_num_csa_counters)) 2974 goto nla_put_failure; 2975 2976 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 2977 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 2978 goto nla_put_failure; 2979 2980 if (rdev->wiphy.max_sched_scan_reqs && 2981 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS, 2982 rdev->wiphy.max_sched_scan_reqs)) 2983 goto nla_put_failure; 2984 2985 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES, 2986 sizeof(rdev->wiphy.ext_features), 2987 rdev->wiphy.ext_features)) 2988 goto nla_put_failure; 2989 2990 if (rdev->wiphy.bss_select_support) { 2991 struct nlattr *nested; 2992 u32 bss_select_support = rdev->wiphy.bss_select_support; 2993 2994 nested = nla_nest_start_noflag(msg, 2995 NL80211_ATTR_BSS_SELECT); 2996 if (!nested) 2997 goto nla_put_failure; 2998 2999 i = 0; 3000 while (bss_select_support) { 3001 if ((bss_select_support & 1) && 3002 nla_put_flag(msg, i)) 3003 goto nla_put_failure; 3004 i++; 3005 bss_select_support >>= 1; 3006 } 3007 nla_nest_end(msg, nested); 3008 } 3009 3010 state->split_start++; 3011 break; 3012 case 13: 3013 if (rdev->wiphy.num_iftype_ext_capab && 3014 rdev->wiphy.iftype_ext_capab) { 3015 struct nlattr *nested_ext_capab, *nested; 3016 3017 nested = nla_nest_start_noflag(msg, 3018 NL80211_ATTR_IFTYPE_EXT_CAPA); 3019 if (!nested) 3020 goto nla_put_failure; 3021 3022 for (i = state->capa_start; 3023 i < rdev->wiphy.num_iftype_ext_capab; i++) { 3024 const struct wiphy_iftype_ext_capab *capab; 3025 3026 capab = &rdev->wiphy.iftype_ext_capab[i]; 3027 3028 nested_ext_capab = nla_nest_start_noflag(msg, 3029 i); 3030 if (!nested_ext_capab || 3031 nla_put_u32(msg, NL80211_ATTR_IFTYPE, 3032 capab->iftype) || 3033 nla_put(msg, NL80211_ATTR_EXT_CAPA, 3034 capab->extended_capabilities_len, 3035 capab->extended_capabilities) || 3036 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 3037 capab->extended_capabilities_len, 3038 capab->extended_capabilities_mask)) 3039 goto nla_put_failure; 3040 3041 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO && 3042 (nla_put_u16(msg, 3043 NL80211_ATTR_EML_CAPABILITY, 3044 capab->eml_capabilities) || 3045 nla_put_u16(msg, 3046 NL80211_ATTR_MLD_CAPA_AND_OPS, 3047 capab->mld_capa_and_ops))) 3048 goto nla_put_failure; 3049 3050 nla_nest_end(msg, nested_ext_capab); 3051 if (state->split) 3052 break; 3053 } 3054 nla_nest_end(msg, nested); 3055 if (i < rdev->wiphy.num_iftype_ext_capab) { 3056 state->capa_start = i + 1; 3057 break; 3058 } 3059 } 3060 3061 if (nla_put_u32(msg, NL80211_ATTR_BANDS, 3062 rdev->wiphy.nan_supported_bands)) 3063 goto nla_put_failure; 3064 3065 if (wiphy_ext_feature_isset(&rdev->wiphy, 3066 NL80211_EXT_FEATURE_TXQS)) { 3067 struct cfg80211_txq_stats txqstats = {}; 3068 int res; 3069 3070 res = rdev_get_txq_stats(rdev, NULL, &txqstats); 3071 if (!res && 3072 !nl80211_put_txq_stats(msg, &txqstats, 3073 NL80211_ATTR_TXQ_STATS)) 3074 goto nla_put_failure; 3075 3076 if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT, 3077 rdev->wiphy.txq_limit)) 3078 goto nla_put_failure; 3079 if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT, 3080 rdev->wiphy.txq_memory_limit)) 3081 goto nla_put_failure; 3082 if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM, 3083 rdev->wiphy.txq_quantum)) 3084 goto nla_put_failure; 3085 } 3086 3087 state->split_start++; 3088 break; 3089 case 14: 3090 if (nl80211_send_pmsr_capa(rdev, msg)) 3091 goto nla_put_failure; 3092 3093 state->split_start++; 3094 break; 3095 case 15: 3096 if (rdev->wiphy.akm_suites && 3097 nla_put(msg, NL80211_ATTR_AKM_SUITES, 3098 sizeof(u32) * rdev->wiphy.n_akm_suites, 3099 rdev->wiphy.akm_suites)) 3100 goto nla_put_failure; 3101 3102 if (nl80211_put_iftype_akm_suites(rdev, msg)) 3103 goto nla_put_failure; 3104 3105 if (nl80211_put_tid_config_support(rdev, msg)) 3106 goto nla_put_failure; 3107 state->split_start++; 3108 break; 3109 case 16: 3110 if (nl80211_put_sar_specs(rdev, msg)) 3111 goto nla_put_failure; 3112 3113 if (nl80211_put_mbssid_support(&rdev->wiphy, msg)) 3114 goto nla_put_failure; 3115 3116 if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES, 3117 rdev->wiphy.max_num_akm_suites)) 3118 goto nla_put_failure; 3119 3120 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO) 3121 nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT); 3122 3123 if (rdev->wiphy.hw_timestamp_max_peers && 3124 nla_put_u16(msg, NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS, 3125 rdev->wiphy.hw_timestamp_max_peers)) 3126 goto nla_put_failure; 3127 3128 state->split_start++; 3129 break; 3130 case 17: 3131 if (nl80211_put_radios(&rdev->wiphy, msg)) 3132 goto nla_put_failure; 3133 3134 /* done */ 3135 state->split_start = 0; 3136 break; 3137 } 3138 finish: 3139 genlmsg_end(msg, hdr); 3140 return 0; 3141 3142 nla_put_failure: 3143 genlmsg_cancel(msg, hdr); 3144 return -EMSGSIZE; 3145 } 3146 3147 static int nl80211_dump_wiphy_parse(struct sk_buff *skb, 3148 struct netlink_callback *cb, 3149 struct nl80211_dump_wiphy_state *state) 3150 { 3151 struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 3152 int ret; 3153 3154 if (!tb) 3155 return -ENOMEM; 3156 3157 ret = nlmsg_parse_deprecated(cb->nlh, 3158 GENL_HDRLEN + nl80211_fam.hdrsize, 3159 tb, nl80211_fam.maxattr, 3160 nl80211_policy, NULL); 3161 /* ignore parse errors for backward compatibility */ 3162 if (ret) { 3163 ret = 0; 3164 goto out; 3165 } 3166 3167 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP]; 3168 if (tb[NL80211_ATTR_WIPHY]) 3169 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]); 3170 if (tb[NL80211_ATTR_WDEV]) 3171 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32; 3172 if (tb[NL80211_ATTR_IFINDEX]) { 3173 struct net_device *netdev; 3174 struct cfg80211_registered_device *rdev; 3175 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]); 3176 3177 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx); 3178 if (!netdev) { 3179 ret = -ENODEV; 3180 goto out; 3181 } 3182 if (netdev->ieee80211_ptr) { 3183 rdev = wiphy_to_rdev( 3184 netdev->ieee80211_ptr->wiphy); 3185 state->filter_wiphy = rdev->wiphy_idx; 3186 } 3187 } 3188 3189 ret = 0; 3190 out: 3191 kfree(tb); 3192 return ret; 3193 } 3194 3195 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb) 3196 { 3197 int idx = 0, ret; 3198 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0]; 3199 struct cfg80211_registered_device *rdev; 3200 3201 rtnl_lock(); 3202 if (!state) { 3203 state = kzalloc(sizeof(*state), GFP_KERNEL); 3204 if (!state) { 3205 rtnl_unlock(); 3206 return -ENOMEM; 3207 } 3208 state->filter_wiphy = -1; 3209 ret = nl80211_dump_wiphy_parse(skb, cb, state); 3210 if (ret) { 3211 kfree(state); 3212 rtnl_unlock(); 3213 return ret; 3214 } 3215 cb->args[0] = (long)state; 3216 } 3217 3218 for_each_rdev(rdev) { 3219 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 3220 continue; 3221 if (++idx <= state->start) 3222 continue; 3223 if (state->filter_wiphy != -1 && 3224 state->filter_wiphy != rdev->wiphy_idx) 3225 continue; 3226 wiphy_lock(&rdev->wiphy); 3227 /* attempt to fit multiple wiphy data chunks into the skb */ 3228 do { 3229 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, 3230 skb, 3231 NETLINK_CB(cb->skb).portid, 3232 cb->nlh->nlmsg_seq, 3233 NLM_F_MULTI, state); 3234 if (ret < 0) { 3235 /* 3236 * If sending the wiphy data didn't fit (ENOBUFS 3237 * or EMSGSIZE returned), this SKB is still 3238 * empty (so it's not too big because another 3239 * wiphy dataset is already in the skb) and 3240 * we've not tried to adjust the dump allocation 3241 * yet ... then adjust the alloc size to be 3242 * bigger, and return 1 but with the empty skb. 3243 * This results in an empty message being RX'ed 3244 * in userspace, but that is ignored. 3245 * 3246 * We can then retry with the larger buffer. 3247 */ 3248 if ((ret == -ENOBUFS || ret == -EMSGSIZE) && 3249 !skb->len && !state->split && 3250 cb->min_dump_alloc < 4096) { 3251 cb->min_dump_alloc = 4096; 3252 state->split_start = 0; 3253 wiphy_unlock(&rdev->wiphy); 3254 rtnl_unlock(); 3255 return 1; 3256 } 3257 idx--; 3258 break; 3259 } 3260 } while (state->split_start > 0); 3261 wiphy_unlock(&rdev->wiphy); 3262 break; 3263 } 3264 rtnl_unlock(); 3265 3266 state->start = idx; 3267 3268 return skb->len; 3269 } 3270 3271 static int nl80211_dump_wiphy_done(struct netlink_callback *cb) 3272 { 3273 kfree((void *)cb->args[0]); 3274 return 0; 3275 } 3276 3277 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info) 3278 { 3279 struct sk_buff *msg; 3280 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3281 struct nl80211_dump_wiphy_state state = {}; 3282 3283 msg = nlmsg_new(4096, GFP_KERNEL); 3284 if (!msg) 3285 return -ENOMEM; 3286 3287 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg, 3288 info->snd_portid, info->snd_seq, 0, 3289 &state) < 0) { 3290 nlmsg_free(msg); 3291 return -ENOBUFS; 3292 } 3293 3294 return genlmsg_reply(msg, info); 3295 } 3296 3297 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = { 3298 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 }, 3299 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 }, 3300 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 }, 3301 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 }, 3302 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 }, 3303 }; 3304 3305 static int parse_txq_params(struct nlattr *tb[], 3306 struct ieee80211_txq_params *txq_params) 3307 { 3308 u8 ac; 3309 3310 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] || 3311 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] || 3312 !tb[NL80211_TXQ_ATTR_AIFS]) 3313 return -EINVAL; 3314 3315 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]); 3316 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]); 3317 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]); 3318 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]); 3319 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]); 3320 3321 if (ac >= NL80211_NUM_ACS) 3322 return -EINVAL; 3323 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS); 3324 return 0; 3325 } 3326 3327 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev) 3328 { 3329 /* 3330 * You can only set the channel explicitly for some interfaces, 3331 * most have their channel managed via their respective 3332 * "establish a connection" command (connect, join, ...) 3333 * 3334 * For AP/GO and mesh mode, the channel can be set with the 3335 * channel userspace API, but is only stored and passed to the 3336 * low-level driver when the AP starts or the mesh is joined. 3337 * This is for backward compatibility, userspace can also give 3338 * the channel in the start-ap or join-mesh commands instead. 3339 * 3340 * Monitors are special as they are normally slaved to 3341 * whatever else is going on, so they have their own special 3342 * operation to set the monitor channel if possible. 3343 */ 3344 return !wdev || 3345 wdev->iftype == NL80211_IFTYPE_AP || 3346 wdev->iftype == NL80211_IFTYPE_MESH_POINT || 3347 wdev->iftype == NL80211_IFTYPE_MONITOR || 3348 wdev->iftype == NL80211_IFTYPE_P2P_GO; 3349 } 3350 3351 static int _nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3352 struct genl_info *info, bool monitor, 3353 struct cfg80211_chan_def *chandef) 3354 { 3355 struct netlink_ext_ack *extack = info->extack; 3356 struct nlattr **attrs = info->attrs; 3357 u32 control_freq; 3358 3359 if (!attrs[NL80211_ATTR_WIPHY_FREQ]) { 3360 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3361 "Frequency is missing"); 3362 return -EINVAL; 3363 } 3364 3365 control_freq = MHZ_TO_KHZ( 3366 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 3367 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 3368 control_freq += 3369 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 3370 3371 memset(chandef, 0, sizeof(*chandef)); 3372 chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq); 3373 chandef->width = NL80211_CHAN_WIDTH_20_NOHT; 3374 chandef->center_freq1 = KHZ_TO_MHZ(control_freq); 3375 chandef->freq1_offset = control_freq % 1000; 3376 chandef->center_freq2 = 0; 3377 3378 if (!chandef->chan) { 3379 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3380 "Unknown channel"); 3381 return -EINVAL; 3382 } 3383 3384 if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) { 3385 enum nl80211_channel_type chantype; 3386 3387 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]); 3388 3389 switch (chantype) { 3390 case NL80211_CHAN_NO_HT: 3391 case NL80211_CHAN_HT20: 3392 case NL80211_CHAN_HT40PLUS: 3393 case NL80211_CHAN_HT40MINUS: 3394 cfg80211_chandef_create(chandef, chandef->chan, 3395 chantype); 3396 /* user input for center_freq is incorrect */ 3397 if (attrs[NL80211_ATTR_CENTER_FREQ1] && 3398 chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) { 3399 NL_SET_ERR_MSG_ATTR(extack, 3400 attrs[NL80211_ATTR_CENTER_FREQ1], 3401 "bad center frequency 1"); 3402 return -EINVAL; 3403 } 3404 /* center_freq2 must be zero */ 3405 if (attrs[NL80211_ATTR_CENTER_FREQ2] && 3406 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) { 3407 NL_SET_ERR_MSG_ATTR(extack, 3408 attrs[NL80211_ATTR_CENTER_FREQ2], 3409 "center frequency 2 can't be used"); 3410 return -EINVAL; 3411 } 3412 break; 3413 default: 3414 NL_SET_ERR_MSG_ATTR(extack, 3415 attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE], 3416 "invalid channel type"); 3417 return -EINVAL; 3418 } 3419 } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) { 3420 chandef->width = 3421 nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]); 3422 if (chandef->chan->band == NL80211_BAND_S1GHZ) { 3423 /* User input error for channel width doesn't match channel */ 3424 if (chandef->width != ieee80211_s1g_channel_width(chandef->chan)) { 3425 NL_SET_ERR_MSG_ATTR(extack, 3426 attrs[NL80211_ATTR_CHANNEL_WIDTH], 3427 "bad channel width"); 3428 return -EINVAL; 3429 } 3430 } 3431 if (attrs[NL80211_ATTR_CENTER_FREQ1]) { 3432 chandef->center_freq1 = 3433 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]); 3434 chandef->freq1_offset = 3435 nla_get_u32_default(attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET], 3436 0); 3437 } 3438 if (attrs[NL80211_ATTR_CENTER_FREQ2]) 3439 chandef->center_freq2 = 3440 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]); 3441 } 3442 3443 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 3444 chandef->edmg.channels = 3445 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 3446 3447 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 3448 chandef->edmg.bw_config = 3449 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 3450 } else { 3451 chandef->edmg.bw_config = 0; 3452 chandef->edmg.channels = 0; 3453 } 3454 3455 if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) { 3456 chandef->punctured = 3457 nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]); 3458 3459 if (chandef->punctured && 3460 !wiphy_ext_feature_isset(&rdev->wiphy, 3461 NL80211_EXT_FEATURE_PUNCT)) { 3462 NL_SET_ERR_MSG(extack, 3463 "driver doesn't support puncturing"); 3464 return -EINVAL; 3465 } 3466 } 3467 3468 if (!cfg80211_chandef_valid(chandef)) { 3469 NL_SET_ERR_MSG(extack, "invalid channel definition"); 3470 return -EINVAL; 3471 } 3472 3473 if (!_cfg80211_chandef_usable(&rdev->wiphy, chandef, 3474 IEEE80211_CHAN_DISABLED, 3475 monitor ? IEEE80211_CHAN_CAN_MONITOR : 0)) { 3476 NL_SET_ERR_MSG(extack, "(extension) channel is disabled"); 3477 return -EINVAL; 3478 } 3479 3480 if ((chandef->width == NL80211_CHAN_WIDTH_5 || 3481 chandef->width == NL80211_CHAN_WIDTH_10) && 3482 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) { 3483 NL_SET_ERR_MSG(extack, "5/10 MHz not supported"); 3484 return -EINVAL; 3485 } 3486 3487 return 0; 3488 } 3489 3490 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3491 struct genl_info *info, 3492 struct cfg80211_chan_def *chandef) 3493 { 3494 return _nl80211_parse_chandef(rdev, info, false, chandef); 3495 } 3496 3497 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev, 3498 struct net_device *dev, 3499 struct genl_info *info, 3500 int _link_id) 3501 { 3502 struct cfg80211_chan_def chandef; 3503 int result; 3504 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR; 3505 struct wireless_dev *wdev = NULL; 3506 int link_id = _link_id; 3507 3508 if (dev) 3509 wdev = dev->ieee80211_ptr; 3510 if (!nl80211_can_set_dev_channel(wdev)) 3511 return -EOPNOTSUPP; 3512 if (wdev) 3513 iftype = wdev->iftype; 3514 3515 if (link_id < 0) { 3516 if (wdev && wdev->valid_links) 3517 return -EINVAL; 3518 link_id = 0; 3519 } 3520 3521 result = _nl80211_parse_chandef(rdev, info, 3522 iftype == NL80211_IFTYPE_MONITOR, 3523 &chandef); 3524 if (result) 3525 return result; 3526 3527 switch (iftype) { 3528 case NL80211_IFTYPE_AP: 3529 case NL80211_IFTYPE_P2P_GO: 3530 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 3531 iftype)) 3532 return -EINVAL; 3533 if (wdev->links[link_id].ap.beacon_interval) { 3534 struct ieee80211_channel *cur_chan; 3535 3536 if (!dev || !rdev->ops->set_ap_chanwidth || 3537 !(rdev->wiphy.features & 3538 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) 3539 return -EBUSY; 3540 3541 /* Only allow dynamic channel width changes */ 3542 cur_chan = wdev->links[link_id].ap.chandef.chan; 3543 if (chandef.chan != cur_chan) 3544 return -EBUSY; 3545 3546 /* only allow this for regular channel widths */ 3547 switch (wdev->links[link_id].ap.chandef.width) { 3548 case NL80211_CHAN_WIDTH_20_NOHT: 3549 case NL80211_CHAN_WIDTH_20: 3550 case NL80211_CHAN_WIDTH_40: 3551 case NL80211_CHAN_WIDTH_80: 3552 case NL80211_CHAN_WIDTH_80P80: 3553 case NL80211_CHAN_WIDTH_160: 3554 case NL80211_CHAN_WIDTH_320: 3555 break; 3556 default: 3557 return -EINVAL; 3558 } 3559 3560 switch (chandef.width) { 3561 case NL80211_CHAN_WIDTH_20_NOHT: 3562 case NL80211_CHAN_WIDTH_20: 3563 case NL80211_CHAN_WIDTH_40: 3564 case NL80211_CHAN_WIDTH_80: 3565 case NL80211_CHAN_WIDTH_80P80: 3566 case NL80211_CHAN_WIDTH_160: 3567 case NL80211_CHAN_WIDTH_320: 3568 break; 3569 default: 3570 return -EINVAL; 3571 } 3572 3573 result = rdev_set_ap_chanwidth(rdev, dev, link_id, 3574 &chandef); 3575 if (result) 3576 return result; 3577 wdev->links[link_id].ap.chandef = chandef; 3578 } else { 3579 wdev->u.ap.preset_chandef = chandef; 3580 } 3581 return 0; 3582 case NL80211_IFTYPE_MESH_POINT: 3583 return cfg80211_set_mesh_channel(rdev, wdev, &chandef); 3584 case NL80211_IFTYPE_MONITOR: 3585 return cfg80211_set_monitor_channel(rdev, dev, &chandef); 3586 default: 3587 break; 3588 } 3589 3590 return -EINVAL; 3591 } 3592 3593 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info) 3594 { 3595 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3596 int link_id = nl80211_link_id_or_invalid(info->attrs); 3597 struct net_device *netdev = info->user_ptr[1]; 3598 3599 return __nl80211_set_channel(rdev, netdev, info, link_id); 3600 } 3601 3602 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info) 3603 { 3604 struct cfg80211_registered_device *rdev = NULL; 3605 struct net_device *netdev = NULL; 3606 struct wireless_dev *wdev; 3607 int result = 0, rem_txq_params = 0; 3608 struct nlattr *nl_txq_params; 3609 u32 changed; 3610 u8 retry_short = 0, retry_long = 0; 3611 u32 frag_threshold = 0, rts_threshold = 0; 3612 u8 coverage_class = 0; 3613 u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0; 3614 3615 rtnl_lock(); 3616 /* 3617 * Try to find the wiphy and netdev. Normally this 3618 * function shouldn't need the netdev, but this is 3619 * done for backward compatibility -- previously 3620 * setting the channel was done per wiphy, but now 3621 * it is per netdev. Previous userland like hostapd 3622 * also passed a netdev to set_wiphy, so that it is 3623 * possible to let that go to the right netdev! 3624 */ 3625 3626 if (info->attrs[NL80211_ATTR_IFINDEX]) { 3627 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]); 3628 3629 netdev = __dev_get_by_index(genl_info_net(info), ifindex); 3630 if (netdev && netdev->ieee80211_ptr) 3631 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy); 3632 else 3633 netdev = NULL; 3634 } 3635 3636 if (!netdev) { 3637 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info), 3638 info->attrs); 3639 if (IS_ERR(rdev)) { 3640 rtnl_unlock(); 3641 return PTR_ERR(rdev); 3642 } 3643 wdev = NULL; 3644 netdev = NULL; 3645 result = 0; 3646 } else 3647 wdev = netdev->ieee80211_ptr; 3648 3649 guard(wiphy)(&rdev->wiphy); 3650 3651 /* 3652 * end workaround code, by now the rdev is available 3653 * and locked, and wdev may or may not be NULL. 3654 */ 3655 3656 if (info->attrs[NL80211_ATTR_WIPHY_NAME]) 3657 result = cfg80211_dev_rename( 3658 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME])); 3659 rtnl_unlock(); 3660 3661 if (result) 3662 return result; 3663 3664 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) { 3665 struct ieee80211_txq_params txq_params; 3666 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1]; 3667 3668 if (!rdev->ops->set_txq_params) 3669 return -EOPNOTSUPP; 3670 3671 if (!netdev) 3672 return -EINVAL; 3673 3674 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 3675 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 3676 return -EINVAL; 3677 3678 if (!netif_running(netdev)) 3679 return -ENETDOWN; 3680 3681 nla_for_each_nested(nl_txq_params, 3682 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS], 3683 rem_txq_params) { 3684 result = nla_parse_nested_deprecated(tb, 3685 NL80211_TXQ_ATTR_MAX, 3686 nl_txq_params, 3687 txq_params_policy, 3688 info->extack); 3689 if (result) 3690 return result; 3691 3692 result = parse_txq_params(tb, &txq_params); 3693 if (result) 3694 return result; 3695 3696 txq_params.link_id = 3697 nl80211_link_id_or_invalid(info->attrs); 3698 3699 if (txq_params.link_id >= 0 && 3700 !(netdev->ieee80211_ptr->valid_links & 3701 BIT(txq_params.link_id))) 3702 result = -ENOLINK; 3703 else if (txq_params.link_id >= 0 && 3704 !netdev->ieee80211_ptr->valid_links) 3705 result = -EINVAL; 3706 else 3707 result = rdev_set_txq_params(rdev, netdev, 3708 &txq_params); 3709 if (result) 3710 return result; 3711 } 3712 } 3713 3714 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 3715 int link_id = nl80211_link_id_or_invalid(info->attrs); 3716 3717 if (wdev) { 3718 result = __nl80211_set_channel( 3719 rdev, 3720 nl80211_can_set_dev_channel(wdev) ? netdev : NULL, 3721 info, link_id); 3722 } else { 3723 result = __nl80211_set_channel(rdev, netdev, info, link_id); 3724 } 3725 3726 if (result) 3727 return result; 3728 } 3729 3730 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) { 3731 struct wireless_dev *txp_wdev = wdev; 3732 enum nl80211_tx_power_setting type; 3733 int idx, mbm = 0; 3734 3735 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER)) 3736 txp_wdev = NULL; 3737 3738 if (!rdev->ops->set_tx_power) 3739 return -EOPNOTSUPP; 3740 3741 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING; 3742 type = nla_get_u32(info->attrs[idx]); 3743 3744 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] && 3745 (type != NL80211_TX_POWER_AUTOMATIC)) 3746 return -EINVAL; 3747 3748 if (type != NL80211_TX_POWER_AUTOMATIC) { 3749 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL; 3750 mbm = nla_get_u32(info->attrs[idx]); 3751 } 3752 3753 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm); 3754 if (result) 3755 return result; 3756 } 3757 3758 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] && 3759 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) { 3760 u32 tx_ant, rx_ant; 3761 3762 if ((!rdev->wiphy.available_antennas_tx && 3763 !rdev->wiphy.available_antennas_rx) || 3764 !rdev->ops->set_antenna) 3765 return -EOPNOTSUPP; 3766 3767 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]); 3768 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]); 3769 3770 /* reject antenna configurations which don't match the 3771 * available antenna masks, except for the "all" mask */ 3772 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) || 3773 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) 3774 return -EINVAL; 3775 3776 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx; 3777 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx; 3778 3779 result = rdev_set_antenna(rdev, tx_ant, rx_ant); 3780 if (result) 3781 return result; 3782 } 3783 3784 changed = 0; 3785 3786 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) { 3787 retry_short = nla_get_u8( 3788 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]); 3789 3790 changed |= WIPHY_PARAM_RETRY_SHORT; 3791 } 3792 3793 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) { 3794 retry_long = nla_get_u8( 3795 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]); 3796 3797 changed |= WIPHY_PARAM_RETRY_LONG; 3798 } 3799 3800 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) { 3801 frag_threshold = nla_get_u32( 3802 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]); 3803 if (frag_threshold < 256) 3804 return -EINVAL; 3805 3806 if (frag_threshold != (u32) -1) { 3807 /* 3808 * Fragments (apart from the last one) are required to 3809 * have even length. Make the fragmentation code 3810 * simpler by stripping LSB should someone try to use 3811 * odd threshold value. 3812 */ 3813 frag_threshold &= ~0x1; 3814 } 3815 changed |= WIPHY_PARAM_FRAG_THRESHOLD; 3816 } 3817 3818 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3819 rts_threshold = nla_get_u32( 3820 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3821 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3822 } 3823 3824 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) { 3825 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) 3826 return -EINVAL; 3827 3828 coverage_class = nla_get_u8( 3829 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]); 3830 changed |= WIPHY_PARAM_COVERAGE_CLASS; 3831 } 3832 3833 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3834 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) 3835 return -EOPNOTSUPP; 3836 3837 changed |= WIPHY_PARAM_DYN_ACK; 3838 } 3839 3840 if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) { 3841 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3842 NL80211_EXT_FEATURE_TXQS)) 3843 return -EOPNOTSUPP; 3844 3845 txq_limit = nla_get_u32( 3846 info->attrs[NL80211_ATTR_TXQ_LIMIT]); 3847 changed |= WIPHY_PARAM_TXQ_LIMIT; 3848 } 3849 3850 if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) { 3851 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3852 NL80211_EXT_FEATURE_TXQS)) 3853 return -EOPNOTSUPP; 3854 3855 txq_memory_limit = nla_get_u32( 3856 info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]); 3857 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT; 3858 } 3859 3860 if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) { 3861 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3862 NL80211_EXT_FEATURE_TXQS)) 3863 return -EOPNOTSUPP; 3864 3865 txq_quantum = nla_get_u32( 3866 info->attrs[NL80211_ATTR_TXQ_QUANTUM]); 3867 changed |= WIPHY_PARAM_TXQ_QUANTUM; 3868 } 3869 3870 if (changed) { 3871 u8 old_retry_short, old_retry_long; 3872 u32 old_frag_threshold, old_rts_threshold; 3873 u8 old_coverage_class; 3874 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum; 3875 3876 if (!rdev->ops->set_wiphy_params) 3877 return -EOPNOTSUPP; 3878 3879 old_retry_short = rdev->wiphy.retry_short; 3880 old_retry_long = rdev->wiphy.retry_long; 3881 old_frag_threshold = rdev->wiphy.frag_threshold; 3882 old_rts_threshold = rdev->wiphy.rts_threshold; 3883 old_coverage_class = rdev->wiphy.coverage_class; 3884 old_txq_limit = rdev->wiphy.txq_limit; 3885 old_txq_memory_limit = rdev->wiphy.txq_memory_limit; 3886 old_txq_quantum = rdev->wiphy.txq_quantum; 3887 3888 if (changed & WIPHY_PARAM_RETRY_SHORT) 3889 rdev->wiphy.retry_short = retry_short; 3890 if (changed & WIPHY_PARAM_RETRY_LONG) 3891 rdev->wiphy.retry_long = retry_long; 3892 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) 3893 rdev->wiphy.frag_threshold = frag_threshold; 3894 if (changed & WIPHY_PARAM_RTS_THRESHOLD) 3895 rdev->wiphy.rts_threshold = rts_threshold; 3896 if (changed & WIPHY_PARAM_COVERAGE_CLASS) 3897 rdev->wiphy.coverage_class = coverage_class; 3898 if (changed & WIPHY_PARAM_TXQ_LIMIT) 3899 rdev->wiphy.txq_limit = txq_limit; 3900 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT) 3901 rdev->wiphy.txq_memory_limit = txq_memory_limit; 3902 if (changed & WIPHY_PARAM_TXQ_QUANTUM) 3903 rdev->wiphy.txq_quantum = txq_quantum; 3904 3905 result = rdev_set_wiphy_params(rdev, changed); 3906 if (result) { 3907 rdev->wiphy.retry_short = old_retry_short; 3908 rdev->wiphy.retry_long = old_retry_long; 3909 rdev->wiphy.frag_threshold = old_frag_threshold; 3910 rdev->wiphy.rts_threshold = old_rts_threshold; 3911 rdev->wiphy.coverage_class = old_coverage_class; 3912 rdev->wiphy.txq_limit = old_txq_limit; 3913 rdev->wiphy.txq_memory_limit = old_txq_memory_limit; 3914 rdev->wiphy.txq_quantum = old_txq_quantum; 3915 return result; 3916 } 3917 } 3918 3919 return 0; 3920 } 3921 3922 int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef) 3923 { 3924 if (WARN_ON(!cfg80211_chandef_valid(chandef))) 3925 return -EINVAL; 3926 3927 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 3928 chandef->chan->center_freq)) 3929 return -ENOBUFS; 3930 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 3931 chandef->chan->freq_offset)) 3932 return -ENOBUFS; 3933 switch (chandef->width) { 3934 case NL80211_CHAN_WIDTH_20_NOHT: 3935 case NL80211_CHAN_WIDTH_20: 3936 case NL80211_CHAN_WIDTH_40: 3937 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 3938 cfg80211_get_chandef_type(chandef))) 3939 return -ENOBUFS; 3940 break; 3941 default: 3942 break; 3943 } 3944 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width)) 3945 return -ENOBUFS; 3946 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1)) 3947 return -ENOBUFS; 3948 if (chandef->center_freq2 && 3949 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2)) 3950 return -ENOBUFS; 3951 if (chandef->punctured && 3952 nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, chandef->punctured)) 3953 return -ENOBUFS; 3954 3955 return 0; 3956 } 3957 EXPORT_SYMBOL(nl80211_send_chandef); 3958 3959 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags, 3960 struct cfg80211_registered_device *rdev, 3961 struct wireless_dev *wdev, 3962 enum nl80211_commands cmd) 3963 { 3964 struct net_device *dev = wdev->netdev; 3965 void *hdr; 3966 3967 lockdep_assert_wiphy(&rdev->wiphy); 3968 3969 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE && 3970 cmd != NL80211_CMD_DEL_INTERFACE && 3971 cmd != NL80211_CMD_SET_INTERFACE); 3972 3973 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 3974 if (!hdr) 3975 return -1; 3976 3977 if (dev && 3978 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 3979 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name))) 3980 goto nla_put_failure; 3981 3982 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 3983 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) || 3984 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 3985 NL80211_ATTR_PAD) || 3986 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) || 3987 nla_put_u32(msg, NL80211_ATTR_GENERATION, 3988 rdev->devlist_generation ^ 3989 (cfg80211_rdev_list_generation << 2)) || 3990 nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr) || 3991 nla_put_u32(msg, NL80211_ATTR_VIF_RADIO_MASK, wdev->radio_mask)) 3992 goto nla_put_failure; 3993 3994 if (rdev->ops->get_channel && !wdev->valid_links) { 3995 struct cfg80211_chan_def chandef = {}; 3996 int ret; 3997 3998 ret = rdev_get_channel(rdev, wdev, 0, &chandef); 3999 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 4000 goto nla_put_failure; 4001 } 4002 4003 if (rdev->ops->get_tx_power && !wdev->valid_links) { 4004 int dbm, ret; 4005 4006 ret = rdev_get_tx_power(rdev, wdev, 0, &dbm); 4007 if (ret == 0 && 4008 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 4009 DBM_TO_MBM(dbm))) 4010 goto nla_put_failure; 4011 } 4012 4013 switch (wdev->iftype) { 4014 case NL80211_IFTYPE_AP: 4015 case NL80211_IFTYPE_P2P_GO: 4016 if (wdev->u.ap.ssid_len && 4017 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 4018 wdev->u.ap.ssid)) 4019 goto nla_put_failure; 4020 break; 4021 case NL80211_IFTYPE_STATION: 4022 case NL80211_IFTYPE_P2P_CLIENT: 4023 if (wdev->u.client.ssid_len && 4024 nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len, 4025 wdev->u.client.ssid)) 4026 goto nla_put_failure; 4027 break; 4028 case NL80211_IFTYPE_ADHOC: 4029 if (wdev->u.ibss.ssid_len && 4030 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len, 4031 wdev->u.ibss.ssid)) 4032 goto nla_put_failure; 4033 break; 4034 default: 4035 /* nothing */ 4036 break; 4037 } 4038 4039 if (rdev->ops->get_txq_stats) { 4040 struct cfg80211_txq_stats txqstats = {}; 4041 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats); 4042 4043 if (ret == 0 && 4044 !nl80211_put_txq_stats(msg, &txqstats, 4045 NL80211_ATTR_TXQ_STATS)) 4046 goto nla_put_failure; 4047 } 4048 4049 if (wdev->valid_links) { 4050 unsigned int link_id; 4051 struct nlattr *links = nla_nest_start(msg, 4052 NL80211_ATTR_MLO_LINKS); 4053 4054 if (!links) 4055 goto nla_put_failure; 4056 4057 for_each_valid_link(wdev, link_id) { 4058 struct nlattr *link = nla_nest_start(msg, link_id + 1); 4059 struct cfg80211_chan_def chandef = {}; 4060 int ret; 4061 4062 if (!link) 4063 goto nla_put_failure; 4064 4065 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 4066 goto nla_put_failure; 4067 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 4068 wdev->links[link_id].addr)) 4069 goto nla_put_failure; 4070 4071 ret = rdev_get_channel(rdev, wdev, link_id, &chandef); 4072 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 4073 goto nla_put_failure; 4074 4075 if (rdev->ops->get_tx_power) { 4076 int dbm, ret; 4077 4078 ret = rdev_get_tx_power(rdev, wdev, link_id, &dbm); 4079 if (ret == 0 && 4080 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 4081 DBM_TO_MBM(dbm))) 4082 goto nla_put_failure; 4083 } 4084 nla_nest_end(msg, link); 4085 } 4086 4087 nla_nest_end(msg, links); 4088 } 4089 4090 genlmsg_end(msg, hdr); 4091 return 0; 4092 4093 nla_put_failure: 4094 genlmsg_cancel(msg, hdr); 4095 return -EMSGSIZE; 4096 } 4097 4098 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb) 4099 { 4100 int wp_idx = 0; 4101 int if_idx = 0; 4102 int wp_start = cb->args[0]; 4103 int if_start = cb->args[1]; 4104 int filter_wiphy = -1; 4105 struct cfg80211_registered_device *rdev; 4106 struct wireless_dev *wdev; 4107 int ret; 4108 4109 rtnl_lock(); 4110 if (!cb->args[2]) { 4111 struct nl80211_dump_wiphy_state state = { 4112 .filter_wiphy = -1, 4113 }; 4114 4115 ret = nl80211_dump_wiphy_parse(skb, cb, &state); 4116 if (ret) 4117 goto out_unlock; 4118 4119 filter_wiphy = state.filter_wiphy; 4120 4121 /* 4122 * if filtering, set cb->args[2] to +1 since 0 is the default 4123 * value needed to determine that parsing is necessary. 4124 */ 4125 if (filter_wiphy >= 0) 4126 cb->args[2] = filter_wiphy + 1; 4127 else 4128 cb->args[2] = -1; 4129 } else if (cb->args[2] > 0) { 4130 filter_wiphy = cb->args[2] - 1; 4131 } 4132 4133 for_each_rdev(rdev) { 4134 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 4135 continue; 4136 if (wp_idx < wp_start) { 4137 wp_idx++; 4138 continue; 4139 } 4140 4141 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx) 4142 continue; 4143 4144 if_idx = 0; 4145 4146 guard(wiphy)(&rdev->wiphy); 4147 4148 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 4149 if (if_idx < if_start) { 4150 if_idx++; 4151 continue; 4152 } 4153 4154 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid, 4155 cb->nlh->nlmsg_seq, NLM_F_MULTI, 4156 rdev, wdev, 4157 NL80211_CMD_NEW_INTERFACE) < 0) 4158 goto out; 4159 4160 if_idx++; 4161 } 4162 4163 if_start = 0; 4164 wp_idx++; 4165 } 4166 out: 4167 cb->args[0] = wp_idx; 4168 cb->args[1] = if_idx; 4169 4170 ret = skb->len; 4171 out_unlock: 4172 rtnl_unlock(); 4173 4174 return ret; 4175 } 4176 4177 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info) 4178 { 4179 struct sk_buff *msg; 4180 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4181 struct wireless_dev *wdev = info->user_ptr[1]; 4182 4183 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4184 if (!msg) 4185 return -ENOMEM; 4186 4187 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4188 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4189 nlmsg_free(msg); 4190 return -ENOBUFS; 4191 } 4192 4193 return genlmsg_reply(msg, info); 4194 } 4195 4196 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = { 4197 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG }, 4198 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG }, 4199 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG }, 4200 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG }, 4201 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG }, 4202 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG }, 4203 [NL80211_MNTR_FLAG_SKIP_TX] = { .type = NLA_FLAG }, 4204 }; 4205 4206 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags) 4207 { 4208 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1]; 4209 int flag; 4210 4211 *mntrflags = 0; 4212 4213 if (!nla) 4214 return -EINVAL; 4215 4216 if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL)) 4217 return -EINVAL; 4218 4219 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++) 4220 if (flags[flag]) 4221 *mntrflags |= (1<<flag); 4222 4223 *mntrflags |= MONITOR_FLAG_CHANGED; 4224 4225 return 0; 4226 } 4227 4228 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev, 4229 enum nl80211_iftype type, 4230 struct genl_info *info, 4231 struct vif_params *params) 4232 { 4233 bool change = false; 4234 int err; 4235 4236 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) { 4237 if (type != NL80211_IFTYPE_MONITOR) 4238 return -EINVAL; 4239 4240 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS], 4241 ¶ms->flags); 4242 if (err) 4243 return err; 4244 4245 change = true; 4246 } 4247 4248 if (params->flags & MONITOR_FLAG_ACTIVE && 4249 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR)) 4250 return -EOPNOTSUPP; 4251 4252 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) { 4253 const u8 *mumimo_groups; 4254 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4255 4256 if (type != NL80211_IFTYPE_MONITOR) 4257 return -EINVAL; 4258 4259 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4260 return -EOPNOTSUPP; 4261 4262 mumimo_groups = 4263 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]); 4264 4265 /* bits 0 and 63 are reserved and must be zero */ 4266 if ((mumimo_groups[0] & BIT(0)) || 4267 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7))) 4268 return -EINVAL; 4269 4270 params->vht_mumimo_groups = mumimo_groups; 4271 change = true; 4272 } 4273 4274 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) { 4275 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4276 4277 if (type != NL80211_IFTYPE_MONITOR) 4278 return -EINVAL; 4279 4280 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4281 return -EOPNOTSUPP; 4282 4283 params->vht_mumimo_follow_addr = 4284 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]); 4285 change = true; 4286 } 4287 4288 return change ? 1 : 0; 4289 } 4290 4291 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev, 4292 struct net_device *netdev, u8 use_4addr, 4293 enum nl80211_iftype iftype) 4294 { 4295 if (!use_4addr) { 4296 if (netdev && netif_is_bridge_port(netdev)) 4297 return -EBUSY; 4298 return 0; 4299 } 4300 4301 switch (iftype) { 4302 case NL80211_IFTYPE_AP_VLAN: 4303 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP) 4304 return 0; 4305 break; 4306 case NL80211_IFTYPE_STATION: 4307 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION) 4308 return 0; 4309 break; 4310 default: 4311 break; 4312 } 4313 4314 return -EOPNOTSUPP; 4315 } 4316 4317 static int nl80211_parse_vif_radio_mask(struct genl_info *info, 4318 u32 *radio_mask) 4319 { 4320 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4321 struct nlattr *attr = info->attrs[NL80211_ATTR_VIF_RADIO_MASK]; 4322 u32 mask, allowed; 4323 4324 if (!attr) { 4325 *radio_mask = 0; 4326 return 0; 4327 } 4328 4329 allowed = BIT(rdev->wiphy.n_radio) - 1; 4330 mask = nla_get_u32(attr); 4331 if (mask & ~allowed) 4332 return -EINVAL; 4333 if (!mask) 4334 mask = allowed; 4335 *radio_mask = mask; 4336 4337 return 1; 4338 } 4339 4340 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info) 4341 { 4342 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4343 struct vif_params params; 4344 int err; 4345 enum nl80211_iftype otype, ntype; 4346 struct net_device *dev = info->user_ptr[1]; 4347 struct wireless_dev *wdev = dev->ieee80211_ptr; 4348 u32 radio_mask = 0; 4349 bool change = false; 4350 4351 memset(¶ms, 0, sizeof(params)); 4352 4353 otype = ntype = dev->ieee80211_ptr->iftype; 4354 4355 if (info->attrs[NL80211_ATTR_IFTYPE]) { 4356 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4357 if (otype != ntype) 4358 change = true; 4359 } 4360 4361 if (info->attrs[NL80211_ATTR_MESH_ID]) { 4362 if (ntype != NL80211_IFTYPE_MESH_POINT) 4363 return -EINVAL; 4364 if (otype != NL80211_IFTYPE_MESH_POINT) 4365 return -EINVAL; 4366 if (netif_running(dev)) 4367 return -EBUSY; 4368 4369 wdev->u.mesh.id_up_len = 4370 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4371 memcpy(wdev->u.mesh.id, 4372 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4373 wdev->u.mesh.id_up_len); 4374 } 4375 4376 if (info->attrs[NL80211_ATTR_4ADDR]) { 4377 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4378 change = true; 4379 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype); 4380 if (err) 4381 return err; 4382 } else { 4383 params.use_4addr = -1; 4384 } 4385 4386 err = nl80211_parse_mon_options(rdev, ntype, info, ¶ms); 4387 if (err < 0) 4388 return err; 4389 if (err > 0) 4390 change = true; 4391 4392 err = nl80211_parse_vif_radio_mask(info, &radio_mask); 4393 if (err < 0) 4394 return err; 4395 if (err && netif_running(dev)) 4396 return -EBUSY; 4397 4398 if (change) 4399 err = cfg80211_change_iface(rdev, dev, ntype, ¶ms); 4400 else 4401 err = 0; 4402 4403 if (!err && params.use_4addr != -1) 4404 dev->ieee80211_ptr->use_4addr = params.use_4addr; 4405 4406 if (radio_mask) 4407 wdev->radio_mask = radio_mask; 4408 4409 if (change && !err) 4410 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE); 4411 4412 return err; 4413 } 4414 4415 static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4416 { 4417 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4418 struct vif_params params; 4419 struct wireless_dev *wdev; 4420 struct sk_buff *msg; 4421 u32 radio_mask; 4422 int err; 4423 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED; 4424 4425 memset(¶ms, 0, sizeof(params)); 4426 4427 if (!info->attrs[NL80211_ATTR_IFNAME]) 4428 return -EINVAL; 4429 4430 if (info->attrs[NL80211_ATTR_IFTYPE]) 4431 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4432 4433 if (!rdev->ops->add_virtual_intf) 4434 return -EOPNOTSUPP; 4435 4436 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN || 4437 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) && 4438 info->attrs[NL80211_ATTR_MAC]) { 4439 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC], 4440 ETH_ALEN); 4441 if (!is_valid_ether_addr(params.macaddr)) 4442 return -EADDRNOTAVAIL; 4443 } 4444 4445 if (info->attrs[NL80211_ATTR_4ADDR]) { 4446 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4447 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type); 4448 if (err) 4449 return err; 4450 } 4451 4452 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0)) 4453 return -EOPNOTSUPP; 4454 4455 err = nl80211_parse_mon_options(rdev, type, info, ¶ms); 4456 if (err < 0) 4457 return err; 4458 4459 err = nl80211_parse_vif_radio_mask(info, &radio_mask); 4460 if (err < 0) 4461 return err; 4462 4463 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4464 if (!msg) 4465 return -ENOMEM; 4466 4467 wdev = rdev_add_virtual_intf(rdev, 4468 nla_data(info->attrs[NL80211_ATTR_IFNAME]), 4469 NET_NAME_USER, type, ¶ms); 4470 if (WARN_ON(!wdev)) { 4471 nlmsg_free(msg); 4472 return -EPROTO; 4473 } else if (IS_ERR(wdev)) { 4474 nlmsg_free(msg); 4475 return PTR_ERR(wdev); 4476 } 4477 4478 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 4479 wdev->owner_nlportid = info->snd_portid; 4480 4481 switch (type) { 4482 case NL80211_IFTYPE_MESH_POINT: 4483 if (!info->attrs[NL80211_ATTR_MESH_ID]) 4484 break; 4485 wdev->u.mesh.id_up_len = 4486 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4487 memcpy(wdev->u.mesh.id, 4488 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4489 wdev->u.mesh.id_up_len); 4490 break; 4491 case NL80211_IFTYPE_NAN: 4492 case NL80211_IFTYPE_P2P_DEVICE: 4493 /* 4494 * P2P Device and NAN do not have a netdev, so don't go 4495 * through the netdev notifier and must be added here 4496 */ 4497 cfg80211_init_wdev(wdev); 4498 cfg80211_register_wdev(rdev, wdev); 4499 break; 4500 default: 4501 break; 4502 } 4503 4504 if (radio_mask) 4505 wdev->radio_mask = radio_mask; 4506 4507 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4508 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4509 nlmsg_free(msg); 4510 return -ENOBUFS; 4511 } 4512 4513 return genlmsg_reply(msg, info); 4514 } 4515 4516 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4517 { 4518 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4519 4520 /* to avoid failing a new interface creation due to pending removal */ 4521 cfg80211_destroy_ifaces(rdev); 4522 4523 guard(wiphy)(&rdev->wiphy); 4524 4525 return _nl80211_new_interface(skb, info); 4526 } 4527 4528 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info) 4529 { 4530 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4531 struct wireless_dev *wdev = info->user_ptr[1]; 4532 4533 if (!rdev->ops->del_virtual_intf) 4534 return -EOPNOTSUPP; 4535 4536 /* 4537 * We hold RTNL, so this is safe, without RTNL opencount cannot 4538 * reach 0, and thus the rdev cannot be deleted. 4539 * 4540 * We need to do it for the dev_close(), since that will call 4541 * the netdev notifiers, and we need to acquire the mutex there 4542 * but don't know if we get there from here or from some other 4543 * place (e.g. "ip link set ... down"). 4544 */ 4545 mutex_unlock(&rdev->wiphy.mtx); 4546 4547 /* 4548 * If we remove a wireless device without a netdev then clear 4549 * user_ptr[1] so that nl80211_post_doit won't dereference it 4550 * to check if it needs to do dev_put(). Otherwise it crashes 4551 * since the wdev has been freed, unlike with a netdev where 4552 * we need the dev_put() for the netdev to really be freed. 4553 */ 4554 if (!wdev->netdev) 4555 info->user_ptr[1] = NULL; 4556 else 4557 dev_close(wdev->netdev); 4558 4559 mutex_lock(&rdev->wiphy.mtx); 4560 4561 return cfg80211_remove_virtual_intf(rdev, wdev); 4562 } 4563 4564 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info) 4565 { 4566 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4567 struct net_device *dev = info->user_ptr[1]; 4568 u16 noack_map; 4569 4570 if (!info->attrs[NL80211_ATTR_NOACK_MAP]) 4571 return -EINVAL; 4572 4573 if (!rdev->ops->set_noack_map) 4574 return -EOPNOTSUPP; 4575 4576 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]); 4577 4578 return rdev_set_noack_map(rdev, dev, noack_map); 4579 } 4580 4581 static int nl80211_validate_key_link_id(struct genl_info *info, 4582 struct wireless_dev *wdev, 4583 int link_id, bool pairwise) 4584 { 4585 if (pairwise) { 4586 if (link_id != -1) { 4587 GENL_SET_ERR_MSG(info, 4588 "link ID not allowed for pairwise key"); 4589 return -EINVAL; 4590 } 4591 4592 return 0; 4593 } 4594 4595 if (wdev->valid_links) { 4596 if (link_id == -1) { 4597 GENL_SET_ERR_MSG(info, 4598 "link ID must for MLO group key"); 4599 return -EINVAL; 4600 } 4601 if (!(wdev->valid_links & BIT(link_id))) { 4602 GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key"); 4603 return -EINVAL; 4604 } 4605 } else if (link_id != -1) { 4606 GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key"); 4607 return -EINVAL; 4608 } 4609 4610 return 0; 4611 } 4612 4613 struct get_key_cookie { 4614 struct sk_buff *msg; 4615 int error; 4616 int idx; 4617 }; 4618 4619 static void get_key_callback(void *c, struct key_params *params) 4620 { 4621 struct nlattr *key; 4622 struct get_key_cookie *cookie = c; 4623 4624 if ((params->seq && 4625 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ, 4626 params->seq_len, params->seq)) || 4627 (params->cipher && 4628 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER, 4629 params->cipher))) 4630 goto nla_put_failure; 4631 4632 key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY); 4633 if (!key) 4634 goto nla_put_failure; 4635 4636 if ((params->seq && 4637 nla_put(cookie->msg, NL80211_KEY_SEQ, 4638 params->seq_len, params->seq)) || 4639 (params->cipher && 4640 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER, 4641 params->cipher))) 4642 goto nla_put_failure; 4643 4644 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx)) 4645 goto nla_put_failure; 4646 4647 nla_nest_end(cookie->msg, key); 4648 4649 return; 4650 nla_put_failure: 4651 cookie->error = 1; 4652 } 4653 4654 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info) 4655 { 4656 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4657 int err; 4658 struct net_device *dev = info->user_ptr[1]; 4659 u8 key_idx = 0; 4660 const u8 *mac_addr = NULL; 4661 bool pairwise; 4662 struct get_key_cookie cookie = { 4663 .error = 0, 4664 }; 4665 void *hdr; 4666 struct sk_buff *msg; 4667 bool bigtk_support = false; 4668 int link_id = nl80211_link_id_or_invalid(info->attrs); 4669 struct wireless_dev *wdev = dev->ieee80211_ptr; 4670 4671 if (wiphy_ext_feature_isset(&rdev->wiphy, 4672 NL80211_EXT_FEATURE_BEACON_PROTECTION)) 4673 bigtk_support = true; 4674 4675 if ((wdev->iftype == NL80211_IFTYPE_STATION || 4676 wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) && 4677 wiphy_ext_feature_isset(&rdev->wiphy, 4678 NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT)) 4679 bigtk_support = true; 4680 4681 if (info->attrs[NL80211_ATTR_KEY_IDX]) { 4682 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 4683 4684 if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) { 4685 GENL_SET_ERR_MSG(info, "BIGTK not supported"); 4686 return -EINVAL; 4687 } 4688 } 4689 4690 if (info->attrs[NL80211_ATTR_MAC]) 4691 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4692 4693 pairwise = !!mac_addr; 4694 if (info->attrs[NL80211_ATTR_KEY_TYPE]) { 4695 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 4696 4697 if (kt != NL80211_KEYTYPE_GROUP && 4698 kt != NL80211_KEYTYPE_PAIRWISE) 4699 return -EINVAL; 4700 pairwise = kt == NL80211_KEYTYPE_PAIRWISE; 4701 } 4702 4703 if (!rdev->ops->get_key) 4704 return -EOPNOTSUPP; 4705 4706 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4707 return -ENOENT; 4708 4709 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4710 if (!msg) 4711 return -ENOMEM; 4712 4713 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 4714 NL80211_CMD_NEW_KEY); 4715 if (!hdr) 4716 goto nla_put_failure; 4717 4718 cookie.msg = msg; 4719 cookie.idx = key_idx; 4720 4721 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4722 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx)) 4723 goto nla_put_failure; 4724 if (mac_addr && 4725 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr)) 4726 goto nla_put_failure; 4727 4728 err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise); 4729 if (err) 4730 goto free_msg; 4731 4732 err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr, 4733 &cookie, get_key_callback); 4734 4735 if (err) 4736 goto free_msg; 4737 4738 if (cookie.error) 4739 goto nla_put_failure; 4740 4741 genlmsg_end(msg, hdr); 4742 return genlmsg_reply(msg, info); 4743 4744 nla_put_failure: 4745 err = -ENOBUFS; 4746 free_msg: 4747 nlmsg_free(msg); 4748 return err; 4749 } 4750 4751 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info) 4752 { 4753 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4754 struct key_parse key; 4755 int err; 4756 struct net_device *dev = info->user_ptr[1]; 4757 int link_id = nl80211_link_id_or_invalid(info->attrs); 4758 struct wireless_dev *wdev = dev->ieee80211_ptr; 4759 4760 err = nl80211_parse_key(info, &key); 4761 if (err) 4762 return err; 4763 4764 if (key.idx < 0) 4765 return -EINVAL; 4766 4767 /* Only support setting default key and 4768 * Extended Key ID action NL80211_KEY_SET_TX. 4769 */ 4770 if (!key.def && !key.defmgmt && !key.defbeacon && 4771 !(key.p.mode == NL80211_KEY_SET_TX)) 4772 return -EINVAL; 4773 4774 if (key.def) { 4775 if (!rdev->ops->set_default_key) 4776 return -EOPNOTSUPP; 4777 4778 err = nl80211_key_allowed(wdev); 4779 if (err) 4780 return err; 4781 4782 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4783 if (err) 4784 return err; 4785 4786 err = rdev_set_default_key(rdev, dev, link_id, key.idx, 4787 key.def_uni, key.def_multi); 4788 4789 if (err) 4790 return err; 4791 4792 #ifdef CONFIG_CFG80211_WEXT 4793 wdev->wext.default_key = key.idx; 4794 #endif 4795 return 0; 4796 } else if (key.defmgmt) { 4797 if (key.def_uni || !key.def_multi) 4798 return -EINVAL; 4799 4800 if (!rdev->ops->set_default_mgmt_key) 4801 return -EOPNOTSUPP; 4802 4803 err = nl80211_key_allowed(wdev); 4804 if (err) 4805 return err; 4806 4807 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4808 if (err) 4809 return err; 4810 4811 err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx); 4812 if (err) 4813 return err; 4814 4815 #ifdef CONFIG_CFG80211_WEXT 4816 wdev->wext.default_mgmt_key = key.idx; 4817 #endif 4818 return 0; 4819 } else if (key.defbeacon) { 4820 if (key.def_uni || !key.def_multi) 4821 return -EINVAL; 4822 4823 if (!rdev->ops->set_default_beacon_key) 4824 return -EOPNOTSUPP; 4825 4826 err = nl80211_key_allowed(wdev); 4827 if (err) 4828 return err; 4829 4830 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4831 if (err) 4832 return err; 4833 4834 return rdev_set_default_beacon_key(rdev, dev, link_id, key.idx); 4835 } else if (key.p.mode == NL80211_KEY_SET_TX && 4836 wiphy_ext_feature_isset(&rdev->wiphy, 4837 NL80211_EXT_FEATURE_EXT_KEY_ID)) { 4838 u8 *mac_addr = NULL; 4839 4840 if (info->attrs[NL80211_ATTR_MAC]) 4841 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4842 4843 if (!mac_addr || key.idx < 0 || key.idx > 1) 4844 return -EINVAL; 4845 4846 err = nl80211_validate_key_link_id(info, wdev, link_id, true); 4847 if (err) 4848 return err; 4849 4850 return rdev_add_key(rdev, dev, link_id, key.idx, 4851 NL80211_KEYTYPE_PAIRWISE, 4852 mac_addr, &key.p); 4853 } 4854 4855 return -EINVAL; 4856 } 4857 4858 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info) 4859 { 4860 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4861 int err; 4862 struct net_device *dev = info->user_ptr[1]; 4863 struct key_parse key; 4864 const u8 *mac_addr = NULL; 4865 int link_id = nl80211_link_id_or_invalid(info->attrs); 4866 struct wireless_dev *wdev = dev->ieee80211_ptr; 4867 4868 err = nl80211_parse_key(info, &key); 4869 if (err) 4870 return err; 4871 4872 if (!key.p.key) { 4873 GENL_SET_ERR_MSG(info, "no key"); 4874 return -EINVAL; 4875 } 4876 4877 if (info->attrs[NL80211_ATTR_MAC]) 4878 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4879 4880 if (key.type == -1) { 4881 if (mac_addr) 4882 key.type = NL80211_KEYTYPE_PAIRWISE; 4883 else 4884 key.type = NL80211_KEYTYPE_GROUP; 4885 } 4886 4887 /* for now */ 4888 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4889 key.type != NL80211_KEYTYPE_GROUP) { 4890 GENL_SET_ERR_MSG(info, "key type not pairwise or group"); 4891 return -EINVAL; 4892 } 4893 4894 if (key.type == NL80211_KEYTYPE_GROUP && 4895 info->attrs[NL80211_ATTR_VLAN_ID]) 4896 key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 4897 4898 if (!rdev->ops->add_key) 4899 return -EOPNOTSUPP; 4900 4901 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, 4902 key.type == NL80211_KEYTYPE_PAIRWISE, 4903 mac_addr)) { 4904 GENL_SET_ERR_MSG(info, "key setting validation failed"); 4905 return -EINVAL; 4906 } 4907 4908 err = nl80211_key_allowed(wdev); 4909 if (err) 4910 GENL_SET_ERR_MSG(info, "key not allowed"); 4911 4912 if (!err) 4913 err = nl80211_validate_key_link_id(info, wdev, link_id, 4914 key.type == NL80211_KEYTYPE_PAIRWISE); 4915 4916 if (!err) { 4917 err = rdev_add_key(rdev, dev, link_id, key.idx, 4918 key.type == NL80211_KEYTYPE_PAIRWISE, 4919 mac_addr, &key.p); 4920 if (err) 4921 GENL_SET_ERR_MSG(info, "key addition failed"); 4922 } 4923 4924 return err; 4925 } 4926 4927 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info) 4928 { 4929 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4930 int err; 4931 struct net_device *dev = info->user_ptr[1]; 4932 u8 *mac_addr = NULL; 4933 struct key_parse key; 4934 int link_id = nl80211_link_id_or_invalid(info->attrs); 4935 struct wireless_dev *wdev = dev->ieee80211_ptr; 4936 4937 err = nl80211_parse_key(info, &key); 4938 if (err) 4939 return err; 4940 4941 if (info->attrs[NL80211_ATTR_MAC]) 4942 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4943 4944 if (key.type == -1) { 4945 if (mac_addr) 4946 key.type = NL80211_KEYTYPE_PAIRWISE; 4947 else 4948 key.type = NL80211_KEYTYPE_GROUP; 4949 } 4950 4951 /* for now */ 4952 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4953 key.type != NL80211_KEYTYPE_GROUP) 4954 return -EINVAL; 4955 4956 if (!cfg80211_valid_key_idx(rdev, key.idx, 4957 key.type == NL80211_KEYTYPE_PAIRWISE)) 4958 return -EINVAL; 4959 4960 if (!rdev->ops->del_key) 4961 return -EOPNOTSUPP; 4962 4963 err = nl80211_key_allowed(wdev); 4964 4965 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr && 4966 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4967 err = -ENOENT; 4968 4969 if (!err) 4970 err = nl80211_validate_key_link_id(info, wdev, link_id, 4971 key.type == NL80211_KEYTYPE_PAIRWISE); 4972 4973 if (!err) 4974 err = rdev_del_key(rdev, dev, link_id, key.idx, 4975 key.type == NL80211_KEYTYPE_PAIRWISE, 4976 mac_addr); 4977 4978 #ifdef CONFIG_CFG80211_WEXT 4979 if (!err) { 4980 if (key.idx == wdev->wext.default_key) 4981 wdev->wext.default_key = -1; 4982 else if (key.idx == wdev->wext.default_mgmt_key) 4983 wdev->wext.default_mgmt_key = -1; 4984 } 4985 #endif 4986 4987 return err; 4988 } 4989 4990 /* This function returns an error or the number of nested attributes */ 4991 static int validate_acl_mac_addrs(struct nlattr *nl_attr) 4992 { 4993 struct nlattr *attr; 4994 int n_entries = 0, tmp; 4995 4996 nla_for_each_nested(attr, nl_attr, tmp) { 4997 if (nla_len(attr) != ETH_ALEN) 4998 return -EINVAL; 4999 5000 n_entries++; 5001 } 5002 5003 return n_entries; 5004 } 5005 5006 /* 5007 * This function parses ACL information and allocates memory for ACL data. 5008 * On successful return, the calling function is responsible to free the 5009 * ACL buffer returned by this function. 5010 */ 5011 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy, 5012 struct genl_info *info) 5013 { 5014 enum nl80211_acl_policy acl_policy; 5015 struct nlattr *attr; 5016 struct cfg80211_acl_data *acl; 5017 int i = 0, n_entries, tmp; 5018 5019 if (!wiphy->max_acl_mac_addrs) 5020 return ERR_PTR(-EOPNOTSUPP); 5021 5022 if (!info->attrs[NL80211_ATTR_ACL_POLICY]) 5023 return ERR_PTR(-EINVAL); 5024 5025 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]); 5026 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED && 5027 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED) 5028 return ERR_PTR(-EINVAL); 5029 5030 if (!info->attrs[NL80211_ATTR_MAC_ADDRS]) 5031 return ERR_PTR(-EINVAL); 5032 5033 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]); 5034 if (n_entries < 0) 5035 return ERR_PTR(n_entries); 5036 5037 if (n_entries > wiphy->max_acl_mac_addrs) 5038 return ERR_PTR(-EOPNOTSUPP); 5039 5040 acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL); 5041 if (!acl) 5042 return ERR_PTR(-ENOMEM); 5043 acl->n_acl_entries = n_entries; 5044 5045 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) { 5046 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN); 5047 i++; 5048 } 5049 acl->acl_policy = acl_policy; 5050 5051 return acl; 5052 } 5053 5054 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info) 5055 { 5056 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5057 struct net_device *dev = info->user_ptr[1]; 5058 struct cfg80211_acl_data *acl; 5059 int err; 5060 5061 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 5062 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 5063 return -EOPNOTSUPP; 5064 5065 if (!dev->ieee80211_ptr->links[0].ap.beacon_interval) 5066 return -EINVAL; 5067 5068 acl = parse_acl_data(&rdev->wiphy, info); 5069 if (IS_ERR(acl)) 5070 return PTR_ERR(acl); 5071 5072 err = rdev_set_mac_acl(rdev, dev, acl); 5073 5074 kfree(acl); 5075 5076 return err; 5077 } 5078 5079 static u32 rateset_to_mask(struct ieee80211_supported_band *sband, 5080 u8 *rates, u8 rates_len) 5081 { 5082 u8 i; 5083 u32 mask = 0; 5084 5085 for (i = 0; i < rates_len; i++) { 5086 int rate = (rates[i] & 0x7f) * 5; 5087 int ridx; 5088 5089 for (ridx = 0; ridx < sband->n_bitrates; ridx++) { 5090 struct ieee80211_rate *srate = 5091 &sband->bitrates[ridx]; 5092 if (rate == srate->bitrate) { 5093 mask |= 1 << ridx; 5094 break; 5095 } 5096 } 5097 if (ridx == sband->n_bitrates) 5098 return 0; /* rate not found */ 5099 } 5100 5101 return mask; 5102 } 5103 5104 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband, 5105 u8 *rates, u8 rates_len, 5106 u8 mcs[IEEE80211_HT_MCS_MASK_LEN]) 5107 { 5108 u8 i; 5109 5110 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN); 5111 5112 for (i = 0; i < rates_len; i++) { 5113 int ridx, rbit; 5114 5115 ridx = rates[i] / 8; 5116 rbit = BIT(rates[i] % 8); 5117 5118 /* check validity */ 5119 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN)) 5120 return false; 5121 5122 /* check availability */ 5123 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN); 5124 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit) 5125 mcs[ridx] |= rbit; 5126 else 5127 return false; 5128 } 5129 5130 return true; 5131 } 5132 5133 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map) 5134 { 5135 u16 mcs_mask = 0; 5136 5137 switch (vht_mcs_map) { 5138 case IEEE80211_VHT_MCS_NOT_SUPPORTED: 5139 break; 5140 case IEEE80211_VHT_MCS_SUPPORT_0_7: 5141 mcs_mask = 0x00FF; 5142 break; 5143 case IEEE80211_VHT_MCS_SUPPORT_0_8: 5144 mcs_mask = 0x01FF; 5145 break; 5146 case IEEE80211_VHT_MCS_SUPPORT_0_9: 5147 mcs_mask = 0x03FF; 5148 break; 5149 default: 5150 break; 5151 } 5152 5153 return mcs_mask; 5154 } 5155 5156 static void vht_build_mcs_mask(u16 vht_mcs_map, 5157 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX]) 5158 { 5159 u8 nss; 5160 5161 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) { 5162 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03); 5163 vht_mcs_map >>= 2; 5164 } 5165 } 5166 5167 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband, 5168 struct nl80211_txrate_vht *txrate, 5169 u16 mcs[NL80211_VHT_NSS_MAX]) 5170 { 5171 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5172 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {}; 5173 u8 i; 5174 5175 if (!sband->vht_cap.vht_supported) 5176 return false; 5177 5178 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX); 5179 5180 /* Build vht_mcs_mask from VHT capabilities */ 5181 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5182 5183 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5184 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5185 mcs[i] = txrate->mcs[i]; 5186 else 5187 return false; 5188 } 5189 5190 return true; 5191 } 5192 5193 static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map) 5194 { 5195 switch (he_mcs_map) { 5196 case IEEE80211_HE_MCS_NOT_SUPPORTED: 5197 return 0; 5198 case IEEE80211_HE_MCS_SUPPORT_0_7: 5199 return 0x00FF; 5200 case IEEE80211_HE_MCS_SUPPORT_0_9: 5201 return 0x03FF; 5202 case IEEE80211_HE_MCS_SUPPORT_0_11: 5203 return 0xFFF; 5204 default: 5205 break; 5206 } 5207 return 0; 5208 } 5209 5210 static void he_build_mcs_mask(u16 he_mcs_map, 5211 u16 he_mcs_mask[NL80211_HE_NSS_MAX]) 5212 { 5213 u8 nss; 5214 5215 for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) { 5216 he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03); 5217 he_mcs_map >>= 2; 5218 } 5219 } 5220 5221 static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id, 5222 const struct ieee80211_sta_he_cap *he_cap) 5223 { 5224 struct net_device *dev = info->user_ptr[1]; 5225 struct wireless_dev *wdev = dev->ieee80211_ptr; 5226 struct cfg80211_chan_def *chandef; 5227 __le16 tx_mcs; 5228 5229 chandef = wdev_chandef(wdev, link_id); 5230 if (!chandef) { 5231 /* 5232 * This is probably broken, but we never maintained 5233 * a chandef in these cases, so it always was. 5234 */ 5235 return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80); 5236 } 5237 5238 switch (chandef->width) { 5239 case NL80211_CHAN_WIDTH_80P80: 5240 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80; 5241 break; 5242 case NL80211_CHAN_WIDTH_160: 5243 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160; 5244 break; 5245 default: 5246 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80; 5247 break; 5248 } 5249 5250 return le16_to_cpu(tx_mcs); 5251 } 5252 5253 static bool he_set_mcs_mask(struct genl_info *info, 5254 struct wireless_dev *wdev, 5255 struct ieee80211_supported_band *sband, 5256 struct nl80211_txrate_he *txrate, 5257 u16 mcs[NL80211_HE_NSS_MAX], 5258 unsigned int link_id) 5259 { 5260 const struct ieee80211_sta_he_cap *he_cap; 5261 u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {}; 5262 u16 tx_mcs_map = 0; 5263 u8 i; 5264 5265 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5266 if (!he_cap) 5267 return false; 5268 5269 memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX); 5270 5271 tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5272 5273 /* Build he_mcs_mask from HE capabilities */ 5274 he_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5275 5276 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5277 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5278 mcs[i] = txrate->mcs[i]; 5279 else 5280 return false; 5281 } 5282 5283 return true; 5284 } 5285 5286 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info, 5287 struct nlattr *attrs[], 5288 enum nl80211_attrs attr, 5289 struct cfg80211_bitrate_mask *mask, 5290 struct net_device *dev, 5291 bool default_all_enabled, 5292 unsigned int link_id) 5293 { 5294 struct nlattr *tb[NL80211_TXRATE_MAX + 1]; 5295 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5296 struct wireless_dev *wdev = dev->ieee80211_ptr; 5297 int rem, i; 5298 struct nlattr *tx_rates; 5299 struct ieee80211_supported_band *sband; 5300 u16 vht_tx_mcs_map, he_tx_mcs_map; 5301 5302 memset(mask, 0, sizeof(*mask)); 5303 /* Default to all rates enabled */ 5304 for (i = 0; i < NUM_NL80211_BANDS; i++) { 5305 const struct ieee80211_sta_he_cap *he_cap; 5306 5307 if (!default_all_enabled) 5308 break; 5309 5310 sband = rdev->wiphy.bands[i]; 5311 5312 if (!sband) 5313 continue; 5314 5315 mask->control[i].legacy = (1 << sband->n_bitrates) - 1; 5316 memcpy(mask->control[i].ht_mcs, 5317 sband->ht_cap.mcs.rx_mask, 5318 sizeof(mask->control[i].ht_mcs)); 5319 5320 if (sband->vht_cap.vht_supported) { 5321 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5322 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs); 5323 } 5324 5325 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5326 if (!he_cap) 5327 continue; 5328 5329 he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5330 he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs); 5331 5332 mask->control[i].he_gi = 0xFF; 5333 mask->control[i].he_ltf = 0xFF; 5334 } 5335 5336 /* if no rates are given set it back to the defaults */ 5337 if (!attrs[attr]) 5338 goto out; 5339 5340 /* The nested attribute uses enum nl80211_band as the index. This maps 5341 * directly to the enum nl80211_band values used in cfg80211. 5342 */ 5343 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8); 5344 nla_for_each_nested(tx_rates, attrs[attr], rem) { 5345 enum nl80211_band band = nla_type(tx_rates); 5346 int err; 5347 5348 if (band < 0 || band >= NUM_NL80211_BANDS) 5349 return -EINVAL; 5350 sband = rdev->wiphy.bands[band]; 5351 if (sband == NULL) 5352 return -EINVAL; 5353 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX, 5354 tx_rates, 5355 nl80211_txattr_policy, 5356 info->extack); 5357 if (err) 5358 return err; 5359 if (tb[NL80211_TXRATE_LEGACY]) { 5360 mask->control[band].legacy = rateset_to_mask( 5361 sband, 5362 nla_data(tb[NL80211_TXRATE_LEGACY]), 5363 nla_len(tb[NL80211_TXRATE_LEGACY])); 5364 if ((mask->control[band].legacy == 0) && 5365 nla_len(tb[NL80211_TXRATE_LEGACY])) 5366 return -EINVAL; 5367 } 5368 if (tb[NL80211_TXRATE_HT]) { 5369 if (!ht_rateset_to_mask( 5370 sband, 5371 nla_data(tb[NL80211_TXRATE_HT]), 5372 nla_len(tb[NL80211_TXRATE_HT]), 5373 mask->control[band].ht_mcs)) 5374 return -EINVAL; 5375 } 5376 5377 if (tb[NL80211_TXRATE_VHT]) { 5378 if (!vht_set_mcs_mask( 5379 sband, 5380 nla_data(tb[NL80211_TXRATE_VHT]), 5381 mask->control[band].vht_mcs)) 5382 return -EINVAL; 5383 } 5384 5385 if (tb[NL80211_TXRATE_GI]) { 5386 mask->control[band].gi = 5387 nla_get_u8(tb[NL80211_TXRATE_GI]); 5388 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI) 5389 return -EINVAL; 5390 } 5391 if (tb[NL80211_TXRATE_HE] && 5392 !he_set_mcs_mask(info, wdev, sband, 5393 nla_data(tb[NL80211_TXRATE_HE]), 5394 mask->control[band].he_mcs, 5395 link_id)) 5396 return -EINVAL; 5397 5398 if (tb[NL80211_TXRATE_HE_GI]) 5399 mask->control[band].he_gi = 5400 nla_get_u8(tb[NL80211_TXRATE_HE_GI]); 5401 if (tb[NL80211_TXRATE_HE_LTF]) 5402 mask->control[band].he_ltf = 5403 nla_get_u8(tb[NL80211_TXRATE_HE_LTF]); 5404 5405 if (mask->control[band].legacy == 0) { 5406 /* don't allow empty legacy rates if HT, VHT or HE 5407 * are not even supported. 5408 */ 5409 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported || 5410 rdev->wiphy.bands[band]->vht_cap.vht_supported || 5411 ieee80211_get_he_iftype_cap(sband, wdev->iftype))) 5412 return -EINVAL; 5413 5414 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) 5415 if (mask->control[band].ht_mcs[i]) 5416 goto out; 5417 5418 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) 5419 if (mask->control[band].vht_mcs[i]) 5420 goto out; 5421 5422 for (i = 0; i < NL80211_HE_NSS_MAX; i++) 5423 if (mask->control[band].he_mcs[i]) 5424 goto out; 5425 5426 /* legacy and mcs rates may not be both empty */ 5427 return -EINVAL; 5428 } 5429 } 5430 5431 out: 5432 return 0; 5433 } 5434 5435 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev, 5436 enum nl80211_band band, 5437 struct cfg80211_bitrate_mask *beacon_rate) 5438 { 5439 u32 count_ht, count_vht, count_he, i; 5440 u32 rate = beacon_rate->control[band].legacy; 5441 5442 /* Allow only one rate */ 5443 if (hweight32(rate) > 1) 5444 return -EINVAL; 5445 5446 count_ht = 0; 5447 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) { 5448 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) { 5449 return -EINVAL; 5450 } else if (beacon_rate->control[band].ht_mcs[i]) { 5451 count_ht++; 5452 if (count_ht > 1) 5453 return -EINVAL; 5454 } 5455 if (count_ht && rate) 5456 return -EINVAL; 5457 } 5458 5459 count_vht = 0; 5460 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5461 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) { 5462 return -EINVAL; 5463 } else if (beacon_rate->control[band].vht_mcs[i]) { 5464 count_vht++; 5465 if (count_vht > 1) 5466 return -EINVAL; 5467 } 5468 if (count_vht && rate) 5469 return -EINVAL; 5470 } 5471 5472 count_he = 0; 5473 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5474 if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) { 5475 return -EINVAL; 5476 } else if (beacon_rate->control[band].he_mcs[i]) { 5477 count_he++; 5478 if (count_he > 1) 5479 return -EINVAL; 5480 } 5481 if (count_he && rate) 5482 return -EINVAL; 5483 } 5484 5485 if ((count_ht && count_vht && count_he) || 5486 (!rate && !count_ht && !count_vht && !count_he)) 5487 return -EINVAL; 5488 5489 if (rate && 5490 !wiphy_ext_feature_isset(&rdev->wiphy, 5491 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) 5492 return -EINVAL; 5493 if (count_ht && 5494 !wiphy_ext_feature_isset(&rdev->wiphy, 5495 NL80211_EXT_FEATURE_BEACON_RATE_HT)) 5496 return -EINVAL; 5497 if (count_vht && 5498 !wiphy_ext_feature_isset(&rdev->wiphy, 5499 NL80211_EXT_FEATURE_BEACON_RATE_VHT)) 5500 return -EINVAL; 5501 if (count_he && 5502 !wiphy_ext_feature_isset(&rdev->wiphy, 5503 NL80211_EXT_FEATURE_BEACON_RATE_HE)) 5504 return -EINVAL; 5505 5506 return 0; 5507 } 5508 5509 static int nl80211_parse_mbssid_config(struct wiphy *wiphy, 5510 struct net_device *dev, 5511 struct nlattr *attrs, 5512 struct cfg80211_mbssid_config *config, 5513 u8 num_elems) 5514 { 5515 struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1]; 5516 5517 if (!wiphy->mbssid_max_interfaces) 5518 return -EOPNOTSUPP; 5519 5520 if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL, 5521 NULL) || 5522 !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]) 5523 return -EINVAL; 5524 5525 config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]); 5526 if (config->ema) { 5527 if (!wiphy->ema_max_profile_periodicity) 5528 return -EOPNOTSUPP; 5529 5530 if (num_elems > wiphy->ema_max_profile_periodicity) 5531 return -EINVAL; 5532 } 5533 5534 config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]); 5535 if (config->index >= wiphy->mbssid_max_interfaces || 5536 (!config->index && !num_elems)) 5537 return -EINVAL; 5538 5539 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) { 5540 u32 tx_ifindex = 5541 nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]); 5542 5543 if ((!config->index && tx_ifindex != dev->ifindex) || 5544 (config->index && tx_ifindex == dev->ifindex)) 5545 return -EINVAL; 5546 5547 if (tx_ifindex != dev->ifindex) { 5548 struct net_device *tx_netdev = 5549 dev_get_by_index(wiphy_net(wiphy), tx_ifindex); 5550 5551 if (!tx_netdev || !tx_netdev->ieee80211_ptr || 5552 tx_netdev->ieee80211_ptr->wiphy != wiphy || 5553 tx_netdev->ieee80211_ptr->iftype != 5554 NL80211_IFTYPE_AP) { 5555 dev_put(tx_netdev); 5556 return -EINVAL; 5557 } 5558 5559 config->tx_wdev = tx_netdev->ieee80211_ptr; 5560 } else { 5561 config->tx_wdev = dev->ieee80211_ptr; 5562 } 5563 } else if (!config->index) { 5564 config->tx_wdev = dev->ieee80211_ptr; 5565 } else { 5566 return -EINVAL; 5567 } 5568 5569 return 0; 5570 } 5571 5572 static struct cfg80211_mbssid_elems * 5573 nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs) 5574 { 5575 struct nlattr *nl_elems; 5576 struct cfg80211_mbssid_elems *elems; 5577 int rem_elems; 5578 u8 i = 0, num_elems = 0; 5579 5580 if (!wiphy->mbssid_max_interfaces) 5581 return ERR_PTR(-EINVAL); 5582 5583 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5584 if (num_elems >= 255) 5585 return ERR_PTR(-EINVAL); 5586 num_elems++; 5587 } 5588 5589 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5590 if (!elems) 5591 return ERR_PTR(-ENOMEM); 5592 elems->cnt = num_elems; 5593 5594 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5595 elems->elem[i].data = nla_data(nl_elems); 5596 elems->elem[i].len = nla_len(nl_elems); 5597 i++; 5598 } 5599 return elems; 5600 } 5601 5602 static struct cfg80211_rnr_elems * 5603 nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs, 5604 struct netlink_ext_ack *extack) 5605 { 5606 struct nlattr *nl_elems; 5607 struct cfg80211_rnr_elems *elems; 5608 int rem_elems; 5609 u8 i = 0, num_elems = 0; 5610 5611 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5612 int ret; 5613 5614 ret = validate_ie_attr(nl_elems, extack); 5615 if (ret) 5616 return ERR_PTR(ret); 5617 5618 num_elems++; 5619 } 5620 5621 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5622 if (!elems) 5623 return ERR_PTR(-ENOMEM); 5624 elems->cnt = num_elems; 5625 5626 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5627 elems->elem[i].data = nla_data(nl_elems); 5628 elems->elem[i].len = nla_len(nl_elems); 5629 i++; 5630 } 5631 return elems; 5632 } 5633 5634 static int nl80211_parse_he_bss_color(struct nlattr *attrs, 5635 struct cfg80211_he_bss_color *he_bss_color) 5636 { 5637 struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1]; 5638 int err; 5639 5640 err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs, 5641 he_bss_color_policy, NULL); 5642 if (err) 5643 return err; 5644 5645 if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]) 5646 return -EINVAL; 5647 5648 he_bss_color->color = 5649 nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]); 5650 he_bss_color->enabled = 5651 !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]); 5652 he_bss_color->partial = 5653 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]); 5654 5655 return 0; 5656 } 5657 5658 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev, 5659 struct nlattr *attrs[], 5660 struct cfg80211_beacon_data *bcn, 5661 struct netlink_ext_ack *extack) 5662 { 5663 bool haveinfo = false; 5664 int err; 5665 5666 memset(bcn, 0, sizeof(*bcn)); 5667 5668 bcn->link_id = nl80211_link_id(attrs); 5669 5670 if (attrs[NL80211_ATTR_BEACON_HEAD]) { 5671 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]); 5672 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]); 5673 if (!bcn->head_len) 5674 return -EINVAL; 5675 haveinfo = true; 5676 } 5677 5678 if (attrs[NL80211_ATTR_BEACON_TAIL]) { 5679 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]); 5680 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]); 5681 haveinfo = true; 5682 } 5683 5684 if (!haveinfo) 5685 return -EINVAL; 5686 5687 if (attrs[NL80211_ATTR_IE]) { 5688 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]); 5689 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]); 5690 } 5691 5692 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) { 5693 bcn->proberesp_ies = 5694 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5695 bcn->proberesp_ies_len = 5696 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5697 } 5698 5699 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) { 5700 bcn->assocresp_ies = 5701 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5702 bcn->assocresp_ies_len = 5703 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5704 } 5705 5706 if (attrs[NL80211_ATTR_PROBE_RESP]) { 5707 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]); 5708 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]); 5709 } 5710 5711 if (attrs[NL80211_ATTR_FTM_RESPONDER]) { 5712 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1]; 5713 5714 err = nla_parse_nested_deprecated(tb, 5715 NL80211_FTM_RESP_ATTR_MAX, 5716 attrs[NL80211_ATTR_FTM_RESPONDER], 5717 NULL, NULL); 5718 if (err) 5719 return err; 5720 5721 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] && 5722 wiphy_ext_feature_isset(&rdev->wiphy, 5723 NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER)) 5724 bcn->ftm_responder = 1; 5725 else 5726 return -EOPNOTSUPP; 5727 5728 if (tb[NL80211_FTM_RESP_ATTR_LCI]) { 5729 bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]); 5730 bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]); 5731 } 5732 5733 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) { 5734 bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5735 bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5736 } 5737 } else { 5738 bcn->ftm_responder = -1; 5739 } 5740 5741 if (attrs[NL80211_ATTR_HE_BSS_COLOR]) { 5742 err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR], 5743 &bcn->he_bss_color); 5744 if (err) 5745 return err; 5746 bcn->he_bss_color_valid = true; 5747 } 5748 5749 if (attrs[NL80211_ATTR_MBSSID_ELEMS]) { 5750 struct cfg80211_mbssid_elems *mbssid = 5751 nl80211_parse_mbssid_elems(&rdev->wiphy, 5752 attrs[NL80211_ATTR_MBSSID_ELEMS]); 5753 5754 if (IS_ERR(mbssid)) 5755 return PTR_ERR(mbssid); 5756 5757 bcn->mbssid_ies = mbssid; 5758 5759 if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) { 5760 struct cfg80211_rnr_elems *rnr = 5761 nl80211_parse_rnr_elems(&rdev->wiphy, 5762 attrs[NL80211_ATTR_EMA_RNR_ELEMS], 5763 extack); 5764 5765 if (IS_ERR(rnr)) 5766 return PTR_ERR(rnr); 5767 5768 if (rnr && rnr->cnt < bcn->mbssid_ies->cnt) 5769 return -EINVAL; 5770 5771 bcn->rnr_ies = rnr; 5772 } 5773 } 5774 5775 return 0; 5776 } 5777 5778 static int nl80211_parse_he_obss_pd(struct nlattr *attrs, 5779 struct ieee80211_he_obss_pd *he_obss_pd) 5780 { 5781 struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1]; 5782 int err; 5783 5784 err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs, 5785 he_obss_pd_policy, NULL); 5786 if (err) 5787 return err; 5788 5789 if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]) 5790 return -EINVAL; 5791 5792 he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]); 5793 5794 if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]) 5795 he_obss_pd->min_offset = 5796 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]); 5797 if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]) 5798 he_obss_pd->max_offset = 5799 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]); 5800 if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]) 5801 he_obss_pd->non_srg_max_offset = 5802 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]); 5803 5804 if (he_obss_pd->min_offset > he_obss_pd->max_offset) 5805 return -EINVAL; 5806 5807 if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]) 5808 memcpy(he_obss_pd->bss_color_bitmap, 5809 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]), 5810 sizeof(he_obss_pd->bss_color_bitmap)); 5811 5812 if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]) 5813 memcpy(he_obss_pd->partial_bssid_bitmap, 5814 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]), 5815 sizeof(he_obss_pd->partial_bssid_bitmap)); 5816 5817 he_obss_pd->enable = true; 5818 5819 return 0; 5820 } 5821 5822 static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev, 5823 struct nlattr *attrs, 5824 struct cfg80211_fils_discovery *fd) 5825 { 5826 struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1]; 5827 int ret; 5828 5829 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5830 NL80211_EXT_FEATURE_FILS_DISCOVERY)) 5831 return -EINVAL; 5832 5833 ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs, 5834 NULL, NULL); 5835 if (ret) 5836 return ret; 5837 5838 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] && 5839 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] && 5840 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) { 5841 fd->update = true; 5842 return 0; 5843 } 5844 5845 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] || 5846 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] || 5847 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) 5848 return -EINVAL; 5849 5850 fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5851 fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5852 fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]); 5853 fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]); 5854 fd->update = true; 5855 return 0; 5856 } 5857 5858 static int 5859 nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev, 5860 struct nlattr *attrs, 5861 struct cfg80211_unsol_bcast_probe_resp *presp) 5862 { 5863 struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1]; 5864 int ret; 5865 5866 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5867 NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP)) 5868 return -EINVAL; 5869 5870 ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX, 5871 attrs, NULL, NULL); 5872 if (ret) 5873 return ret; 5874 5875 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] && 5876 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) { 5877 presp->update = true; 5878 return 0; 5879 } 5880 5881 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] || 5882 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) 5883 return -EINVAL; 5884 5885 presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5886 presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5887 presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]); 5888 presp->update = true; 5889 return 0; 5890 } 5891 5892 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params, 5893 const struct element *rates) 5894 { 5895 int i; 5896 5897 if (!rates) 5898 return; 5899 5900 for (i = 0; i < rates->datalen; i++) { 5901 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY) 5902 params->ht_required = true; 5903 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY) 5904 params->vht_required = true; 5905 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY) 5906 params->he_required = true; 5907 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E) 5908 params->sae_h2e_required = true; 5909 } 5910 } 5911 5912 /* 5913 * Since the nl80211 API didn't include, from the beginning, attributes about 5914 * HT/VHT requirements/capabilities, we parse them out of the IEs for the 5915 * benefit of drivers that rebuild IEs in the firmware. 5916 */ 5917 static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params) 5918 { 5919 const struct cfg80211_beacon_data *bcn = ¶ms->beacon; 5920 size_t ies_len = bcn->tail_len; 5921 const u8 *ies = bcn->tail; 5922 const struct element *rates; 5923 const struct element *cap; 5924 5925 rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len); 5926 nl80211_check_ap_rate_selectors(params, rates); 5927 5928 rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len); 5929 nl80211_check_ap_rate_selectors(params, rates); 5930 5931 cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len); 5932 if (cap && cap->datalen >= sizeof(*params->ht_cap)) 5933 params->ht_cap = (void *)cap->data; 5934 cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len); 5935 if (cap && cap->datalen >= sizeof(*params->vht_cap)) 5936 params->vht_cap = (void *)cap->data; 5937 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len); 5938 if (cap && cap->datalen >= sizeof(*params->he_cap) + 1) 5939 params->he_cap = (void *)(cap->data + 1); 5940 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len); 5941 if (cap && cap->datalen >= sizeof(*params->he_oper) + 1) 5942 params->he_oper = (void *)(cap->data + 1); 5943 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len); 5944 if (cap) { 5945 if (!cap->datalen) 5946 return -EINVAL; 5947 params->eht_cap = (void *)(cap->data + 1); 5948 if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap, 5949 (const u8 *)params->eht_cap, 5950 cap->datalen - 1, true)) 5951 return -EINVAL; 5952 } 5953 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len); 5954 if (cap) { 5955 if (!cap->datalen) 5956 return -EINVAL; 5957 params->eht_oper = (void *)(cap->data + 1); 5958 if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper, 5959 cap->datalen - 1)) 5960 return -EINVAL; 5961 } 5962 return 0; 5963 } 5964 5965 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev, 5966 struct cfg80211_ap_settings *params) 5967 { 5968 struct wireless_dev *wdev; 5969 5970 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 5971 if (wdev->iftype != NL80211_IFTYPE_AP && 5972 wdev->iftype != NL80211_IFTYPE_P2P_GO) 5973 continue; 5974 5975 if (!wdev->u.ap.preset_chandef.chan) 5976 continue; 5977 5978 params->chandef = wdev->u.ap.preset_chandef; 5979 return true; 5980 } 5981 5982 return false; 5983 } 5984 5985 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev, 5986 enum nl80211_auth_type auth_type, 5987 enum nl80211_commands cmd) 5988 { 5989 if (auth_type > NL80211_AUTHTYPE_MAX) 5990 return false; 5991 5992 switch (cmd) { 5993 case NL80211_CMD_AUTHENTICATE: 5994 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 5995 auth_type == NL80211_AUTHTYPE_SAE) 5996 return false; 5997 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5998 NL80211_EXT_FEATURE_FILS_STA) && 5999 (auth_type == NL80211_AUTHTYPE_FILS_SK || 6000 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6001 auth_type == NL80211_AUTHTYPE_FILS_PK)) 6002 return false; 6003 return true; 6004 case NL80211_CMD_CONNECT: 6005 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 6006 !wiphy_ext_feature_isset(&rdev->wiphy, 6007 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 6008 auth_type == NL80211_AUTHTYPE_SAE) 6009 return false; 6010 6011 /* FILS with SK PFS or PK not supported yet */ 6012 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6013 auth_type == NL80211_AUTHTYPE_FILS_PK) 6014 return false; 6015 if (!wiphy_ext_feature_isset( 6016 &rdev->wiphy, 6017 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 6018 auth_type == NL80211_AUTHTYPE_FILS_SK) 6019 return false; 6020 return true; 6021 case NL80211_CMD_START_AP: 6022 if (!wiphy_ext_feature_isset(&rdev->wiphy, 6023 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) && 6024 auth_type == NL80211_AUTHTYPE_SAE) 6025 return false; 6026 /* FILS not supported yet */ 6027 if (auth_type == NL80211_AUTHTYPE_FILS_SK || 6028 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 6029 auth_type == NL80211_AUTHTYPE_FILS_PK) 6030 return false; 6031 return true; 6032 default: 6033 return false; 6034 } 6035 } 6036 6037 static void nl80211_send_ap_started(struct wireless_dev *wdev, 6038 unsigned int link_id) 6039 { 6040 struct wiphy *wiphy = wdev->wiphy; 6041 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 6042 struct sk_buff *msg; 6043 void *hdr; 6044 6045 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6046 if (!msg) 6047 return; 6048 6049 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP); 6050 if (!hdr) 6051 goto out; 6052 6053 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 6054 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 6055 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 6056 NL80211_ATTR_PAD) || 6057 (wdev->u.ap.ssid_len && 6058 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 6059 wdev->u.ap.ssid)) || 6060 (wdev->valid_links && 6061 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 6062 goto out; 6063 6064 genlmsg_end(msg, hdr); 6065 6066 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 6067 NL80211_MCGRP_MLME, GFP_KERNEL); 6068 return; 6069 out: 6070 nlmsg_free(msg); 6071 } 6072 6073 static int nl80211_validate_ap_phy_operation(struct cfg80211_ap_settings *params) 6074 { 6075 struct ieee80211_channel *channel = params->chandef.chan; 6076 6077 if ((params->he_cap || params->he_oper) && 6078 (channel->flags & IEEE80211_CHAN_NO_HE)) 6079 return -EOPNOTSUPP; 6080 6081 if ((params->eht_cap || params->eht_oper) && 6082 (channel->flags & IEEE80211_CHAN_NO_EHT)) 6083 return -EOPNOTSUPP; 6084 6085 return 0; 6086 } 6087 6088 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info) 6089 { 6090 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6091 struct cfg80211_beaconing_check_config beacon_check = {}; 6092 unsigned int link_id = nl80211_link_id(info->attrs); 6093 struct net_device *dev = info->user_ptr[1]; 6094 struct wireless_dev *wdev = dev->ieee80211_ptr; 6095 struct cfg80211_ap_settings *params; 6096 int err; 6097 6098 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6099 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6100 return -EOPNOTSUPP; 6101 6102 if (!rdev->ops->start_ap) 6103 return -EOPNOTSUPP; 6104 6105 if (wdev->links[link_id].cac_started) 6106 return -EBUSY; 6107 6108 if (wdev->links[link_id].ap.beacon_interval) 6109 return -EALREADY; 6110 6111 /* these are required for START_AP */ 6112 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] || 6113 !info->attrs[NL80211_ATTR_DTIM_PERIOD] || 6114 !info->attrs[NL80211_ATTR_BEACON_HEAD]) 6115 return -EINVAL; 6116 6117 if (info->attrs[NL80211_ATTR_SMPS_MODE] && 6118 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]) != NL80211_SMPS_OFF) 6119 return -EOPNOTSUPP; 6120 6121 params = kzalloc(sizeof(*params), GFP_KERNEL); 6122 if (!params) 6123 return -ENOMEM; 6124 6125 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6126 info->extack); 6127 if (err) 6128 goto out; 6129 6130 params->beacon_interval = 6131 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 6132 params->dtim_period = 6133 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 6134 6135 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype, 6136 params->beacon_interval); 6137 if (err) 6138 goto out; 6139 6140 /* 6141 * In theory, some of these attributes should be required here 6142 * but since they were not used when the command was originally 6143 * added, keep them optional for old user space programs to let 6144 * them continue to work with drivers that do not need the 6145 * additional information -- drivers must check! 6146 */ 6147 if (info->attrs[NL80211_ATTR_SSID]) { 6148 params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 6149 params->ssid_len = 6150 nla_len(info->attrs[NL80211_ATTR_SSID]); 6151 if (params->ssid_len == 0) { 6152 err = -EINVAL; 6153 goto out; 6154 } 6155 6156 if (wdev->u.ap.ssid_len && 6157 (wdev->u.ap.ssid_len != params->ssid_len || 6158 memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) { 6159 /* require identical SSID for MLO */ 6160 err = -EINVAL; 6161 goto out; 6162 } 6163 } else if (wdev->valid_links) { 6164 /* require SSID for MLO */ 6165 err = -EINVAL; 6166 goto out; 6167 } 6168 6169 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) 6170 params->hidden_ssid = nla_get_u32( 6171 info->attrs[NL80211_ATTR_HIDDEN_SSID]); 6172 6173 params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 6174 6175 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 6176 params->auth_type = nla_get_u32( 6177 info->attrs[NL80211_ATTR_AUTH_TYPE]); 6178 if (!nl80211_valid_auth_type(rdev, params->auth_type, 6179 NL80211_CMD_START_AP)) { 6180 err = -EINVAL; 6181 goto out; 6182 } 6183 } else 6184 params->auth_type = NL80211_AUTHTYPE_AUTOMATIC; 6185 6186 err = nl80211_crypto_settings(rdev, info, ¶ms->crypto, 6187 NL80211_MAX_NR_CIPHER_SUITES); 6188 if (err) 6189 goto out; 6190 6191 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) { 6192 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) { 6193 err = -EOPNOTSUPP; 6194 goto out; 6195 } 6196 params->inactivity_timeout = nla_get_u16( 6197 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]); 6198 } 6199 6200 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 6201 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6202 err = -EINVAL; 6203 goto out; 6204 } 6205 params->p2p_ctwindow = 6206 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 6207 if (params->p2p_ctwindow != 0 && 6208 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) { 6209 err = -EINVAL; 6210 goto out; 6211 } 6212 } 6213 6214 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 6215 u8 tmp; 6216 6217 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6218 err = -EINVAL; 6219 goto out; 6220 } 6221 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 6222 params->p2p_opp_ps = tmp; 6223 if (params->p2p_opp_ps != 0 && 6224 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) { 6225 err = -EINVAL; 6226 goto out; 6227 } 6228 } 6229 6230 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 6231 err = nl80211_parse_chandef(rdev, info, ¶ms->chandef); 6232 if (err) 6233 goto out; 6234 } else if (wdev->valid_links) { 6235 /* with MLD need to specify the channel configuration */ 6236 err = -EINVAL; 6237 goto out; 6238 } else if (wdev->u.ap.preset_chandef.chan) { 6239 params->chandef = wdev->u.ap.preset_chandef; 6240 } else if (!nl80211_get_ap_channel(rdev, params)) { 6241 err = -EINVAL; 6242 goto out; 6243 } 6244 6245 beacon_check.iftype = wdev->iftype; 6246 beacon_check.relax = true; 6247 beacon_check.reg_power = 6248 cfg80211_get_6ghz_power_type(params->beacon.tail, 6249 params->beacon.tail_len); 6250 if (!cfg80211_reg_check_beaconing(&rdev->wiphy, ¶ms->chandef, 6251 &beacon_check)) { 6252 err = -EINVAL; 6253 goto out; 6254 } 6255 6256 if (info->attrs[NL80211_ATTR_TX_RATES]) { 6257 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 6258 NL80211_ATTR_TX_RATES, 6259 ¶ms->beacon_rate, 6260 dev, false, link_id); 6261 if (err) 6262 goto out; 6263 6264 err = validate_beacon_tx_rate(rdev, params->chandef.chan->band, 6265 ¶ms->beacon_rate); 6266 if (err) 6267 goto out; 6268 } 6269 6270 params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 6271 if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 6272 err = -EOPNOTSUPP; 6273 goto out; 6274 } 6275 6276 if (info->attrs[NL80211_ATTR_ACL_POLICY]) { 6277 params->acl = parse_acl_data(&rdev->wiphy, info); 6278 if (IS_ERR(params->acl)) { 6279 err = PTR_ERR(params->acl); 6280 params->acl = NULL; 6281 goto out; 6282 } 6283 } 6284 6285 params->twt_responder = 6286 nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]); 6287 6288 if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) { 6289 err = nl80211_parse_he_obss_pd( 6290 info->attrs[NL80211_ATTR_HE_OBSS_PD], 6291 ¶ms->he_obss_pd); 6292 if (err) 6293 goto out; 6294 } 6295 6296 if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) { 6297 err = nl80211_parse_fils_discovery(rdev, 6298 info->attrs[NL80211_ATTR_FILS_DISCOVERY], 6299 ¶ms->fils_discovery); 6300 if (err) 6301 goto out; 6302 } 6303 6304 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 6305 err = nl80211_parse_unsol_bcast_probe_resp( 6306 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 6307 ¶ms->unsol_bcast_probe_resp); 6308 if (err) 6309 goto out; 6310 } 6311 6312 if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) { 6313 err = nl80211_parse_mbssid_config(&rdev->wiphy, dev, 6314 info->attrs[NL80211_ATTR_MBSSID_CONFIG], 6315 ¶ms->mbssid_config, 6316 params->beacon.mbssid_ies ? 6317 params->beacon.mbssid_ies->cnt : 6318 0); 6319 if (err) 6320 goto out; 6321 } 6322 6323 if (!params->mbssid_config.ema && params->beacon.rnr_ies) { 6324 err = -EINVAL; 6325 goto out; 6326 } 6327 6328 err = nl80211_calculate_ap_params(params); 6329 if (err) 6330 goto out; 6331 6332 err = nl80211_validate_ap_phy_operation(params); 6333 if (err) 6334 goto out; 6335 6336 if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]) 6337 params->flags = nla_get_u32( 6338 info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]); 6339 else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT]) 6340 params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT; 6341 6342 if (wdev->conn_owner_nlportid && 6343 info->attrs[NL80211_ATTR_SOCKET_OWNER] && 6344 wdev->conn_owner_nlportid != info->snd_portid) { 6345 err = -EINVAL; 6346 goto out; 6347 } 6348 6349 /* FIXME: validate MLO/link-id against driver capabilities */ 6350 6351 err = rdev_start_ap(rdev, dev, params); 6352 if (!err) { 6353 wdev->links[link_id].ap.beacon_interval = params->beacon_interval; 6354 wdev->links[link_id].ap.chandef = params->chandef; 6355 wdev->u.ap.ssid_len = params->ssid_len; 6356 memcpy(wdev->u.ap.ssid, params->ssid, 6357 params->ssid_len); 6358 6359 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 6360 wdev->conn_owner_nlportid = info->snd_portid; 6361 6362 nl80211_send_ap_started(wdev, link_id); 6363 } 6364 out: 6365 kfree(params->acl); 6366 kfree(params->beacon.mbssid_ies); 6367 if (params->mbssid_config.tx_wdev && 6368 params->mbssid_config.tx_wdev->netdev && 6369 params->mbssid_config.tx_wdev->netdev != dev) 6370 dev_put(params->mbssid_config.tx_wdev->netdev); 6371 kfree(params->beacon.rnr_ies); 6372 kfree(params); 6373 6374 return err; 6375 } 6376 6377 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info) 6378 { 6379 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6380 struct cfg80211_beaconing_check_config beacon_check = {}; 6381 unsigned int link_id = nl80211_link_id(info->attrs); 6382 struct net_device *dev = info->user_ptr[1]; 6383 struct wireless_dev *wdev = dev->ieee80211_ptr; 6384 struct cfg80211_ap_update *params; 6385 struct nlattr *attr; 6386 int err; 6387 6388 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6389 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6390 return -EOPNOTSUPP; 6391 6392 if (!rdev->ops->change_beacon) 6393 return -EOPNOTSUPP; 6394 6395 if (!wdev->links[link_id].ap.beacon_interval) 6396 return -EINVAL; 6397 6398 params = kzalloc(sizeof(*params), GFP_KERNEL); 6399 if (!params) 6400 return -ENOMEM; 6401 6402 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6403 info->extack); 6404 if (err) 6405 goto out; 6406 6407 /* recheck beaconing is permitted with possibly changed power type */ 6408 beacon_check.iftype = wdev->iftype; 6409 beacon_check.relax = true; 6410 beacon_check.reg_power = 6411 cfg80211_get_6ghz_power_type(params->beacon.tail, 6412 params->beacon.tail_len); 6413 if (!cfg80211_reg_check_beaconing(&rdev->wiphy, 6414 &wdev->links[link_id].ap.chandef, 6415 &beacon_check)) { 6416 err = -EINVAL; 6417 goto out; 6418 } 6419 6420 attr = info->attrs[NL80211_ATTR_FILS_DISCOVERY]; 6421 if (attr) { 6422 err = nl80211_parse_fils_discovery(rdev, attr, 6423 ¶ms->fils_discovery); 6424 if (err) 6425 goto out; 6426 } 6427 6428 attr = info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]; 6429 if (attr) { 6430 err = nl80211_parse_unsol_bcast_probe_resp(rdev, attr, 6431 ¶ms->unsol_bcast_probe_resp); 6432 if (err) 6433 goto out; 6434 } 6435 6436 err = rdev_change_beacon(rdev, dev, params); 6437 6438 out: 6439 kfree(params->beacon.mbssid_ies); 6440 kfree(params->beacon.rnr_ies); 6441 kfree(params); 6442 return err; 6443 } 6444 6445 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info) 6446 { 6447 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6448 unsigned int link_id = nl80211_link_id(info->attrs); 6449 struct net_device *dev = info->user_ptr[1]; 6450 6451 return cfg80211_stop_ap(rdev, dev, link_id, false); 6452 } 6453 6454 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = { 6455 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG }, 6456 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG }, 6457 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG }, 6458 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG }, 6459 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG }, 6460 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG }, 6461 }; 6462 6463 static int parse_station_flags(struct genl_info *info, 6464 enum nl80211_iftype iftype, 6465 struct station_parameters *params) 6466 { 6467 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1]; 6468 struct nlattr *nla; 6469 int flag; 6470 6471 /* 6472 * Try parsing the new attribute first so userspace 6473 * can specify both for older kernels. 6474 */ 6475 nla = info->attrs[NL80211_ATTR_STA_FLAGS2]; 6476 if (nla) { 6477 struct nl80211_sta_flag_update *sta_flags; 6478 6479 sta_flags = nla_data(nla); 6480 params->sta_flags_mask = sta_flags->mask; 6481 params->sta_flags_set = sta_flags->set; 6482 params->sta_flags_set &= params->sta_flags_mask; 6483 if ((params->sta_flags_mask | 6484 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID)) 6485 return -EINVAL; 6486 return 0; 6487 } 6488 6489 /* if present, parse the old attribute */ 6490 6491 nla = info->attrs[NL80211_ATTR_STA_FLAGS]; 6492 if (!nla) 6493 return 0; 6494 6495 if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack)) 6496 return -EINVAL; 6497 6498 /* 6499 * Only allow certain flags for interface types so that 6500 * other attributes are silently ignored. Remember that 6501 * this is backward compatibility code with old userspace 6502 * and shouldn't be hit in other cases anyway. 6503 */ 6504 switch (iftype) { 6505 case NL80211_IFTYPE_AP: 6506 case NL80211_IFTYPE_AP_VLAN: 6507 case NL80211_IFTYPE_P2P_GO: 6508 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6509 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6510 BIT(NL80211_STA_FLAG_WME) | 6511 BIT(NL80211_STA_FLAG_MFP); 6512 break; 6513 case NL80211_IFTYPE_P2P_CLIENT: 6514 case NL80211_IFTYPE_STATION: 6515 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6516 BIT(NL80211_STA_FLAG_TDLS_PEER); 6517 break; 6518 case NL80211_IFTYPE_MESH_POINT: 6519 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6520 BIT(NL80211_STA_FLAG_MFP) | 6521 BIT(NL80211_STA_FLAG_AUTHORIZED); 6522 break; 6523 default: 6524 return -EINVAL; 6525 } 6526 6527 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) { 6528 if (flags[flag]) { 6529 params->sta_flags_set |= (1<<flag); 6530 6531 /* no longer support new API additions in old API */ 6532 if (flag > NL80211_STA_FLAG_MAX_OLD_API) 6533 return -EINVAL; 6534 } 6535 } 6536 6537 return 0; 6538 } 6539 6540 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr) 6541 { 6542 struct nlattr *rate; 6543 u32 bitrate; 6544 u16 bitrate_compat; 6545 enum nl80211_rate_info rate_flg; 6546 6547 rate = nla_nest_start_noflag(msg, attr); 6548 if (!rate) 6549 return false; 6550 6551 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */ 6552 bitrate = cfg80211_calculate_bitrate(info); 6553 /* report 16-bit bitrate only if we can */ 6554 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0; 6555 if (bitrate > 0 && 6556 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate)) 6557 return false; 6558 if (bitrate_compat > 0 && 6559 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat)) 6560 return false; 6561 6562 switch (info->bw) { 6563 case RATE_INFO_BW_1: 6564 rate_flg = NL80211_RATE_INFO_1_MHZ_WIDTH; 6565 break; 6566 case RATE_INFO_BW_2: 6567 rate_flg = NL80211_RATE_INFO_2_MHZ_WIDTH; 6568 break; 6569 case RATE_INFO_BW_4: 6570 rate_flg = NL80211_RATE_INFO_4_MHZ_WIDTH; 6571 break; 6572 case RATE_INFO_BW_5: 6573 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH; 6574 break; 6575 case RATE_INFO_BW_8: 6576 rate_flg = NL80211_RATE_INFO_8_MHZ_WIDTH; 6577 break; 6578 case RATE_INFO_BW_10: 6579 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH; 6580 break; 6581 case RATE_INFO_BW_16: 6582 rate_flg = NL80211_RATE_INFO_16_MHZ_WIDTH; 6583 break; 6584 default: 6585 WARN_ON(1); 6586 fallthrough; 6587 case RATE_INFO_BW_20: 6588 rate_flg = 0; 6589 break; 6590 case RATE_INFO_BW_40: 6591 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH; 6592 break; 6593 case RATE_INFO_BW_80: 6594 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH; 6595 break; 6596 case RATE_INFO_BW_160: 6597 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH; 6598 break; 6599 case RATE_INFO_BW_HE_RU: 6600 rate_flg = 0; 6601 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS)); 6602 break; 6603 case RATE_INFO_BW_320: 6604 rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH; 6605 break; 6606 case RATE_INFO_BW_EHT_RU: 6607 rate_flg = 0; 6608 WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS)); 6609 break; 6610 } 6611 6612 if (rate_flg && nla_put_flag(msg, rate_flg)) 6613 return false; 6614 6615 if (info->flags & RATE_INFO_FLAGS_MCS) { 6616 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs)) 6617 return false; 6618 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6619 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6620 return false; 6621 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) { 6622 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs)) 6623 return false; 6624 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss)) 6625 return false; 6626 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6627 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6628 return false; 6629 } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) { 6630 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs)) 6631 return false; 6632 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss)) 6633 return false; 6634 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi)) 6635 return false; 6636 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm)) 6637 return false; 6638 if (info->bw == RATE_INFO_BW_HE_RU && 6639 nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC, 6640 info->he_ru_alloc)) 6641 return false; 6642 } else if (info->flags & RATE_INFO_FLAGS_S1G_MCS) { 6643 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_MCS, info->mcs)) 6644 return false; 6645 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_NSS, info->nss)) 6646 return false; 6647 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6648 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6649 return false; 6650 } else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) { 6651 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs)) 6652 return false; 6653 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss)) 6654 return false; 6655 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi)) 6656 return false; 6657 if (info->bw == RATE_INFO_BW_EHT_RU && 6658 nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC, 6659 info->eht_ru_alloc)) 6660 return false; 6661 } 6662 6663 nla_nest_end(msg, rate); 6664 return true; 6665 } 6666 6667 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal, 6668 int id) 6669 { 6670 void *attr; 6671 int i = 0; 6672 6673 if (!mask) 6674 return true; 6675 6676 attr = nla_nest_start_noflag(msg, id); 6677 if (!attr) 6678 return false; 6679 6680 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { 6681 if (!(mask & BIT(i))) 6682 continue; 6683 6684 if (nla_put_u8(msg, i, signal[i])) 6685 return false; 6686 } 6687 6688 nla_nest_end(msg, attr); 6689 6690 return true; 6691 } 6692 6693 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid, 6694 u32 seq, int flags, 6695 struct cfg80211_registered_device *rdev, 6696 struct net_device *dev, 6697 const u8 *mac_addr, struct station_info *sinfo) 6698 { 6699 void *hdr; 6700 struct nlattr *sinfoattr, *bss_param; 6701 6702 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 6703 if (!hdr) { 6704 cfg80211_sinfo_release_content(sinfo); 6705 return -1; 6706 } 6707 6708 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 6709 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 6710 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation)) 6711 goto nla_put_failure; 6712 6713 sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 6714 if (!sinfoattr) 6715 goto nla_put_failure; 6716 6717 #define PUT_SINFO(attr, memb, type) do { \ 6718 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 6719 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6720 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 6721 sinfo->memb)) \ 6722 goto nla_put_failure; \ 6723 } while (0) 6724 #define PUT_SINFO_U64(attr, memb) do { \ 6725 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6726 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 6727 sinfo->memb, NL80211_STA_INFO_PAD)) \ 6728 goto nla_put_failure; \ 6729 } while (0) 6730 6731 PUT_SINFO(CONNECTED_TIME, connected_time, u32); 6732 PUT_SINFO(INACTIVE_TIME, inactive_time, u32); 6733 PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at); 6734 6735 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 6736 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 6737 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 6738 (u32)sinfo->rx_bytes)) 6739 goto nla_put_failure; 6740 6741 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 6742 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 6743 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 6744 (u32)sinfo->tx_bytes)) 6745 goto nla_put_failure; 6746 6747 PUT_SINFO_U64(RX_BYTES64, rx_bytes); 6748 PUT_SINFO_U64(TX_BYTES64, tx_bytes); 6749 PUT_SINFO(LLID, llid, u16); 6750 PUT_SINFO(PLID, plid, u16); 6751 PUT_SINFO(PLINK_STATE, plink_state, u8); 6752 PUT_SINFO_U64(RX_DURATION, rx_duration); 6753 PUT_SINFO_U64(TX_DURATION, tx_duration); 6754 6755 if (wiphy_ext_feature_isset(&rdev->wiphy, 6756 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 6757 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 6758 6759 switch (rdev->wiphy.signal_type) { 6760 case CFG80211_SIGNAL_TYPE_MBM: 6761 PUT_SINFO(SIGNAL, signal, u8); 6762 PUT_SINFO(SIGNAL_AVG, signal_avg, u8); 6763 break; 6764 default: 6765 break; 6766 } 6767 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 6768 if (!nl80211_put_signal(msg, sinfo->chains, 6769 sinfo->chain_signal, 6770 NL80211_STA_INFO_CHAIN_SIGNAL)) 6771 goto nla_put_failure; 6772 } 6773 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 6774 if (!nl80211_put_signal(msg, sinfo->chains, 6775 sinfo->chain_signal_avg, 6776 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 6777 goto nla_put_failure; 6778 } 6779 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 6780 if (!nl80211_put_sta_rate(msg, &sinfo->txrate, 6781 NL80211_STA_INFO_TX_BITRATE)) 6782 goto nla_put_failure; 6783 } 6784 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 6785 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate, 6786 NL80211_STA_INFO_RX_BITRATE)) 6787 goto nla_put_failure; 6788 } 6789 6790 PUT_SINFO(RX_PACKETS, rx_packets, u32); 6791 PUT_SINFO(TX_PACKETS, tx_packets, u32); 6792 PUT_SINFO(TX_RETRIES, tx_retries, u32); 6793 PUT_SINFO(TX_FAILED, tx_failed, u32); 6794 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 6795 PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32); 6796 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32); 6797 PUT_SINFO(LOCAL_PM, local_pm, u32); 6798 PUT_SINFO(PEER_PM, peer_pm, u32); 6799 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32); 6800 PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8); 6801 PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8); 6802 6803 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 6804 bss_param = nla_nest_start_noflag(msg, 6805 NL80211_STA_INFO_BSS_PARAM); 6806 if (!bss_param) 6807 goto nla_put_failure; 6808 6809 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) && 6810 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 6811 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 6812 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 6813 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 6814 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 6815 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 6816 sinfo->bss_param.dtim_period) || 6817 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 6818 sinfo->bss_param.beacon_interval)) 6819 goto nla_put_failure; 6820 6821 nla_nest_end(msg, bss_param); 6822 } 6823 if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) && 6824 nla_put(msg, NL80211_STA_INFO_STA_FLAGS, 6825 sizeof(struct nl80211_sta_flag_update), 6826 &sinfo->sta_flags)) 6827 goto nla_put_failure; 6828 6829 PUT_SINFO_U64(T_OFFSET, t_offset); 6830 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 6831 PUT_SINFO_U64(BEACON_RX, rx_beacon); 6832 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 6833 PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32); 6834 PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 6835 if (wiphy_ext_feature_isset(&rdev->wiphy, 6836 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 6837 PUT_SINFO(ACK_SIGNAL, ack_signal, u8); 6838 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 6839 } 6840 6841 #undef PUT_SINFO 6842 #undef PUT_SINFO_U64 6843 6844 if (sinfo->pertid) { 6845 struct nlattr *tidsattr; 6846 int tid; 6847 6848 tidsattr = nla_nest_start_noflag(msg, 6849 NL80211_STA_INFO_TID_STATS); 6850 if (!tidsattr) 6851 goto nla_put_failure; 6852 6853 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 6854 struct cfg80211_tid_stats *tidstats; 6855 struct nlattr *tidattr; 6856 6857 tidstats = &sinfo->pertid[tid]; 6858 6859 if (!tidstats->filled) 6860 continue; 6861 6862 tidattr = nla_nest_start_noflag(msg, tid + 1); 6863 if (!tidattr) 6864 goto nla_put_failure; 6865 6866 #define PUT_TIDVAL_U64(attr, memb) do { \ 6867 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 6868 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 6869 tidstats->memb, NL80211_TID_STATS_PAD)) \ 6870 goto nla_put_failure; \ 6871 } while (0) 6872 6873 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 6874 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 6875 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 6876 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 6877 6878 #undef PUT_TIDVAL_U64 6879 if ((tidstats->filled & 6880 BIT(NL80211_TID_STATS_TXQ_STATS)) && 6881 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 6882 NL80211_TID_STATS_TXQ_STATS)) 6883 goto nla_put_failure; 6884 6885 nla_nest_end(msg, tidattr); 6886 } 6887 6888 nla_nest_end(msg, tidsattr); 6889 } 6890 6891 nla_nest_end(msg, sinfoattr); 6892 6893 if (sinfo->assoc_req_ies_len && 6894 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len, 6895 sinfo->assoc_req_ies)) 6896 goto nla_put_failure; 6897 6898 if (sinfo->assoc_resp_ies_len && 6899 nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len, 6900 sinfo->assoc_resp_ies)) 6901 goto nla_put_failure; 6902 6903 if (sinfo->mlo_params_valid) { 6904 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 6905 sinfo->assoc_link_id)) 6906 goto nla_put_failure; 6907 6908 if (!is_zero_ether_addr(sinfo->mld_addr) && 6909 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 6910 sinfo->mld_addr)) 6911 goto nla_put_failure; 6912 } 6913 6914 cfg80211_sinfo_release_content(sinfo); 6915 genlmsg_end(msg, hdr); 6916 return 0; 6917 6918 nla_put_failure: 6919 cfg80211_sinfo_release_content(sinfo); 6920 genlmsg_cancel(msg, hdr); 6921 return -EMSGSIZE; 6922 } 6923 6924 static int nl80211_dump_station(struct sk_buff *skb, 6925 struct netlink_callback *cb) 6926 { 6927 struct station_info sinfo; 6928 struct cfg80211_registered_device *rdev; 6929 struct wireless_dev *wdev; 6930 u8 mac_addr[ETH_ALEN]; 6931 int sta_idx = cb->args[2]; 6932 int err; 6933 6934 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 6935 if (err) 6936 return err; 6937 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 6938 __acquire(&rdev->wiphy.mtx); 6939 6940 if (!wdev->netdev) { 6941 err = -EINVAL; 6942 goto out_err; 6943 } 6944 6945 if (!rdev->ops->dump_station) { 6946 err = -EOPNOTSUPP; 6947 goto out_err; 6948 } 6949 6950 while (1) { 6951 memset(&sinfo, 0, sizeof(sinfo)); 6952 err = rdev_dump_station(rdev, wdev->netdev, sta_idx, 6953 mac_addr, &sinfo); 6954 if (err == -ENOENT) 6955 break; 6956 if (err) 6957 goto out_err; 6958 6959 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION, 6960 NETLINK_CB(cb->skb).portid, 6961 cb->nlh->nlmsg_seq, NLM_F_MULTI, 6962 rdev, wdev->netdev, mac_addr, 6963 &sinfo) < 0) 6964 goto out; 6965 6966 sta_idx++; 6967 } 6968 6969 out: 6970 cb->args[2] = sta_idx; 6971 err = skb->len; 6972 out_err: 6973 wiphy_unlock(&rdev->wiphy); 6974 6975 return err; 6976 } 6977 6978 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info) 6979 { 6980 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6981 struct net_device *dev = info->user_ptr[1]; 6982 struct station_info sinfo; 6983 struct sk_buff *msg; 6984 u8 *mac_addr = NULL; 6985 int err; 6986 6987 memset(&sinfo, 0, sizeof(sinfo)); 6988 6989 if (!info->attrs[NL80211_ATTR_MAC]) 6990 return -EINVAL; 6991 6992 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 6993 6994 if (!rdev->ops->get_station) 6995 return -EOPNOTSUPP; 6996 6997 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 6998 if (err) 6999 return err; 7000 7001 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7002 if (!msg) { 7003 cfg80211_sinfo_release_content(&sinfo); 7004 return -ENOMEM; 7005 } 7006 7007 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 7008 info->snd_portid, info->snd_seq, 0, 7009 rdev, dev, mac_addr, &sinfo) < 0) { 7010 nlmsg_free(msg); 7011 return -ENOBUFS; 7012 } 7013 7014 return genlmsg_reply(msg, info); 7015 } 7016 7017 int cfg80211_check_station_change(struct wiphy *wiphy, 7018 struct station_parameters *params, 7019 enum cfg80211_station_type statype) 7020 { 7021 if (params->listen_interval != -1 && 7022 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 7023 return -EINVAL; 7024 7025 if (params->support_p2p_ps != -1 && 7026 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 7027 return -EINVAL; 7028 7029 if (params->aid && 7030 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && 7031 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 7032 return -EINVAL; 7033 7034 /* When you run into this, adjust the code below for the new flag */ 7035 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 7036 7037 switch (statype) { 7038 case CFG80211_STA_MESH_PEER_KERNEL: 7039 case CFG80211_STA_MESH_PEER_USER: 7040 /* 7041 * No ignoring the TDLS flag here -- the userspace mesh 7042 * code doesn't have the bug of including TDLS in the 7043 * mask everywhere. 7044 */ 7045 if (params->sta_flags_mask & 7046 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7047 BIT(NL80211_STA_FLAG_MFP) | 7048 BIT(NL80211_STA_FLAG_AUTHORIZED))) 7049 return -EINVAL; 7050 break; 7051 case CFG80211_STA_TDLS_PEER_SETUP: 7052 case CFG80211_STA_TDLS_PEER_ACTIVE: 7053 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 7054 return -EINVAL; 7055 /* ignore since it can't change */ 7056 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7057 break; 7058 default: 7059 /* disallow mesh-specific things */ 7060 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) 7061 return -EINVAL; 7062 if (params->local_pm) 7063 return -EINVAL; 7064 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 7065 return -EINVAL; 7066 } 7067 7068 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 7069 statype != CFG80211_STA_TDLS_PEER_ACTIVE) { 7070 /* TDLS can't be set, ... */ 7071 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) 7072 return -EINVAL; 7073 /* 7074 * ... but don't bother the driver with it. This works around 7075 * a hostapd/wpa_supplicant issue -- it always includes the 7076 * TLDS_PEER flag in the mask even for AP mode. 7077 */ 7078 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7079 } 7080 7081 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 7082 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 7083 /* reject other things that can't change */ 7084 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) 7085 return -EINVAL; 7086 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) 7087 return -EINVAL; 7088 if (params->link_sta_params.supported_rates) 7089 return -EINVAL; 7090 if (params->ext_capab || params->link_sta_params.ht_capa || 7091 params->link_sta_params.vht_capa || 7092 params->link_sta_params.he_capa || 7093 params->link_sta_params.eht_capa) 7094 return -EINVAL; 7095 if (params->sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 7096 return -EINVAL; 7097 } 7098 7099 if (statype != CFG80211_STA_AP_CLIENT && 7100 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 7101 if (params->vlan) 7102 return -EINVAL; 7103 } 7104 7105 switch (statype) { 7106 case CFG80211_STA_AP_MLME_CLIENT: 7107 /* Use this only for authorizing/unauthorizing a station */ 7108 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 7109 return -EOPNOTSUPP; 7110 break; 7111 case CFG80211_STA_AP_CLIENT: 7112 case CFG80211_STA_AP_CLIENT_UNASSOC: 7113 /* accept only the listed bits */ 7114 if (params->sta_flags_mask & 7115 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 7116 BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7117 BIT(NL80211_STA_FLAG_ASSOCIATED) | 7118 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 7119 BIT(NL80211_STA_FLAG_WME) | 7120 BIT(NL80211_STA_FLAG_MFP) | 7121 BIT(NL80211_STA_FLAG_SPP_AMSDU))) 7122 return -EINVAL; 7123 7124 /* but authenticated/associated only if driver handles it */ 7125 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 7126 params->sta_flags_mask & 7127 (BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7128 BIT(NL80211_STA_FLAG_ASSOCIATED))) 7129 return -EINVAL; 7130 break; 7131 case CFG80211_STA_IBSS: 7132 case CFG80211_STA_AP_STA: 7133 /* reject any changes other than AUTHORIZED */ 7134 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED)) 7135 return -EINVAL; 7136 break; 7137 case CFG80211_STA_TDLS_PEER_SETUP: 7138 /* reject any changes other than AUTHORIZED or WME */ 7139 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 7140 BIT(NL80211_STA_FLAG_WME))) 7141 return -EINVAL; 7142 /* force (at least) rates when authorizing */ 7143 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) && 7144 !params->link_sta_params.supported_rates) 7145 return -EINVAL; 7146 break; 7147 case CFG80211_STA_TDLS_PEER_ACTIVE: 7148 /* reject any changes */ 7149 return -EINVAL; 7150 case CFG80211_STA_MESH_PEER_KERNEL: 7151 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 7152 return -EINVAL; 7153 break; 7154 case CFG80211_STA_MESH_PEER_USER: 7155 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION && 7156 params->plink_action != NL80211_PLINK_ACTION_BLOCK) 7157 return -EINVAL; 7158 break; 7159 } 7160 7161 /* 7162 * Older kernel versions ignored this attribute entirely, so don't 7163 * reject attempts to update it but mark it as unused instead so the 7164 * driver won't look at the data. 7165 */ 7166 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 7167 statype != CFG80211_STA_TDLS_PEER_SETUP) 7168 params->link_sta_params.opmode_notif_used = false; 7169 7170 return 0; 7171 } 7172 EXPORT_SYMBOL(cfg80211_check_station_change); 7173 7174 /* 7175 * Get vlan interface making sure it is running and on the right wiphy. 7176 */ 7177 static struct net_device *get_vlan(struct genl_info *info, 7178 struct cfg80211_registered_device *rdev) 7179 { 7180 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN]; 7181 struct net_device *v; 7182 int ret; 7183 7184 if (!vlanattr) 7185 return NULL; 7186 7187 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr)); 7188 if (!v) 7189 return ERR_PTR(-ENODEV); 7190 7191 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) { 7192 ret = -EINVAL; 7193 goto error; 7194 } 7195 7196 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 7197 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 7198 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 7199 ret = -EINVAL; 7200 goto error; 7201 } 7202 7203 if (!netif_running(v)) { 7204 ret = -ENETDOWN; 7205 goto error; 7206 } 7207 7208 return v; 7209 error: 7210 dev_put(v); 7211 return ERR_PTR(ret); 7212 } 7213 7214 static int nl80211_parse_sta_wme(struct genl_info *info, 7215 struct station_parameters *params) 7216 { 7217 struct nlattr *tb[NL80211_STA_WME_MAX + 1]; 7218 struct nlattr *nla; 7219 int err; 7220 7221 /* parse WME attributes if present */ 7222 if (!info->attrs[NL80211_ATTR_STA_WME]) 7223 return 0; 7224 7225 nla = info->attrs[NL80211_ATTR_STA_WME]; 7226 err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla, 7227 nl80211_sta_wme_policy, 7228 info->extack); 7229 if (err) 7230 return err; 7231 7232 if (tb[NL80211_STA_WME_UAPSD_QUEUES]) 7233 params->uapsd_queues = nla_get_u8( 7234 tb[NL80211_STA_WME_UAPSD_QUEUES]); 7235 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) 7236 return -EINVAL; 7237 7238 if (tb[NL80211_STA_WME_MAX_SP]) 7239 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]); 7240 7241 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) 7242 return -EINVAL; 7243 7244 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD; 7245 7246 return 0; 7247 } 7248 7249 static int nl80211_parse_sta_channel_info(struct genl_info *info, 7250 struct station_parameters *params) 7251 { 7252 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) { 7253 params->supported_channels = 7254 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7255 params->supported_channels_len = 7256 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7257 /* 7258 * Need to include at least one (first channel, number of 7259 * channels) tuple for each subband (checked in policy), 7260 * and must have proper tuples for the rest of the data as well. 7261 */ 7262 if (params->supported_channels_len % 2) 7263 return -EINVAL; 7264 } 7265 7266 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) { 7267 params->supported_oper_classes = 7268 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7269 params->supported_oper_classes_len = 7270 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7271 } 7272 return 0; 7273 } 7274 7275 static int nl80211_set_station_tdls(struct genl_info *info, 7276 struct station_parameters *params) 7277 { 7278 int err; 7279 /* Dummy STA entry gets updated once the peer capabilities are known */ 7280 if (info->attrs[NL80211_ATTR_PEER_AID]) 7281 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7282 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7283 params->link_sta_params.ht_capa = 7284 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7285 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7286 params->link_sta_params.vht_capa = 7287 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7288 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7289 params->link_sta_params.he_capa = 7290 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7291 params->link_sta_params.he_capa_len = 7292 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7293 7294 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7295 params->link_sta_params.eht_capa = 7296 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7297 params->link_sta_params.eht_capa_len = 7298 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7299 7300 if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa, 7301 (const u8 *)params->link_sta_params.eht_capa, 7302 params->link_sta_params.eht_capa_len, 7303 false)) 7304 return -EINVAL; 7305 } 7306 } 7307 7308 err = nl80211_parse_sta_channel_info(info, params); 7309 if (err) 7310 return err; 7311 7312 return nl80211_parse_sta_wme(info, params); 7313 } 7314 7315 static int nl80211_parse_sta_txpower_setting(struct genl_info *info, 7316 struct sta_txpwr *txpwr, 7317 bool *txpwr_set) 7318 { 7319 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7320 int idx; 7321 7322 if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) { 7323 if (!rdev->ops->set_tx_power || 7324 !wiphy_ext_feature_isset(&rdev->wiphy, 7325 NL80211_EXT_FEATURE_STA_TX_PWR)) 7326 return -EOPNOTSUPP; 7327 7328 idx = NL80211_ATTR_STA_TX_POWER_SETTING; 7329 txpwr->type = nla_get_u8(info->attrs[idx]); 7330 7331 if (txpwr->type == NL80211_TX_POWER_LIMITED) { 7332 idx = NL80211_ATTR_STA_TX_POWER; 7333 7334 if (info->attrs[idx]) 7335 txpwr->power = nla_get_s16(info->attrs[idx]); 7336 else 7337 return -EINVAL; 7338 } 7339 7340 *txpwr_set = true; 7341 } else { 7342 *txpwr_set = false; 7343 } 7344 7345 return 0; 7346 } 7347 7348 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info) 7349 { 7350 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7351 struct net_device *dev = info->user_ptr[1]; 7352 struct station_parameters params; 7353 u8 *mac_addr; 7354 int err; 7355 7356 memset(¶ms, 0, sizeof(params)); 7357 7358 if (!rdev->ops->change_station) 7359 return -EOPNOTSUPP; 7360 7361 /* 7362 * AID and listen_interval properties can be set only for unassociated 7363 * station. Include these parameters here and will check them in 7364 * cfg80211_check_station_change(). 7365 */ 7366 if (info->attrs[NL80211_ATTR_STA_AID]) 7367 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7368 7369 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7370 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7371 7372 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7373 params.listen_interval = 7374 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7375 else 7376 params.listen_interval = -1; 7377 7378 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) 7379 params.support_p2p_ps = 7380 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7381 else 7382 params.support_p2p_ps = -1; 7383 7384 if (!info->attrs[NL80211_ATTR_MAC]) 7385 return -EINVAL; 7386 7387 params.link_sta_params.link_id = 7388 nl80211_link_id_or_invalid(info->attrs); 7389 7390 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7391 /* If MLD_ADDR attribute is set then this is an MLD station 7392 * and the MLD_ADDR attribute holds the MLD address and the 7393 * MAC attribute holds for the LINK address. 7394 * In that case, the link_id is also expected to be valid. 7395 */ 7396 if (params.link_sta_params.link_id < 0) 7397 return -EINVAL; 7398 7399 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7400 params.link_sta_params.mld_mac = mac_addr; 7401 params.link_sta_params.link_mac = 7402 nla_data(info->attrs[NL80211_ATTR_MAC]); 7403 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7404 return -EINVAL; 7405 } else { 7406 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7407 } 7408 7409 7410 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 7411 params.link_sta_params.supported_rates = 7412 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7413 params.link_sta_params.supported_rates_len = 7414 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7415 } 7416 7417 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7418 params.capability = 7419 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7420 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7421 } 7422 7423 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7424 params.ext_capab = 7425 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7426 params.ext_capab_len = 7427 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7428 } 7429 7430 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7431 return -EINVAL; 7432 7433 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7434 params.plink_action = 7435 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7436 7437 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) { 7438 params.plink_state = 7439 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]); 7440 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) 7441 params.peer_aid = nla_get_u16( 7442 info->attrs[NL80211_ATTR_MESH_PEER_AID]); 7443 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE; 7444 } 7445 7446 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) 7447 params.local_pm = nla_get_u32( 7448 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]); 7449 7450 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7451 params.link_sta_params.opmode_notif_used = true; 7452 params.link_sta_params.opmode_notif = 7453 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7454 } 7455 7456 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7457 params.link_sta_params.he_6ghz_capa = 7458 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7459 7460 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7461 params.airtime_weight = 7462 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7463 7464 if (params.airtime_weight && 7465 !wiphy_ext_feature_isset(&rdev->wiphy, 7466 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7467 return -EOPNOTSUPP; 7468 7469 err = nl80211_parse_sta_txpower_setting(info, 7470 ¶ms.link_sta_params.txpwr, 7471 ¶ms.link_sta_params.txpwr_set); 7472 if (err) 7473 return err; 7474 7475 /* Include parameters for TDLS peer (will check later) */ 7476 err = nl80211_set_station_tdls(info, ¶ms); 7477 if (err) 7478 return err; 7479 7480 params.vlan = get_vlan(info, rdev); 7481 if (IS_ERR(params.vlan)) 7482 return PTR_ERR(params.vlan); 7483 7484 switch (dev->ieee80211_ptr->iftype) { 7485 case NL80211_IFTYPE_AP: 7486 case NL80211_IFTYPE_AP_VLAN: 7487 case NL80211_IFTYPE_P2P_GO: 7488 case NL80211_IFTYPE_P2P_CLIENT: 7489 case NL80211_IFTYPE_STATION: 7490 case NL80211_IFTYPE_ADHOC: 7491 case NL80211_IFTYPE_MESH_POINT: 7492 break; 7493 default: 7494 err = -EOPNOTSUPP; 7495 goto out_put_vlan; 7496 } 7497 7498 /* driver will call cfg80211_check_station_change() */ 7499 err = rdev_change_station(rdev, dev, mac_addr, ¶ms); 7500 7501 out_put_vlan: 7502 dev_put(params.vlan); 7503 7504 return err; 7505 } 7506 7507 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info) 7508 { 7509 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7510 int err; 7511 struct net_device *dev = info->user_ptr[1]; 7512 struct wireless_dev *wdev = dev->ieee80211_ptr; 7513 struct station_parameters params; 7514 u8 *mac_addr = NULL; 7515 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7516 BIT(NL80211_STA_FLAG_ASSOCIATED); 7517 7518 memset(¶ms, 0, sizeof(params)); 7519 7520 if (!rdev->ops->add_station) 7521 return -EOPNOTSUPP; 7522 7523 if (!info->attrs[NL80211_ATTR_MAC]) 7524 return -EINVAL; 7525 7526 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7527 return -EINVAL; 7528 7529 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 7530 return -EINVAL; 7531 7532 if (!info->attrs[NL80211_ATTR_STA_AID] && 7533 !info->attrs[NL80211_ATTR_PEER_AID]) 7534 return -EINVAL; 7535 7536 params.link_sta_params.link_id = 7537 nl80211_link_id_or_invalid(info->attrs); 7538 7539 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7540 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7541 params.link_sta_params.mld_mac = mac_addr; 7542 params.link_sta_params.link_mac = 7543 nla_data(info->attrs[NL80211_ATTR_MAC]); 7544 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7545 return -EINVAL; 7546 } else { 7547 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7548 } 7549 7550 params.link_sta_params.supported_rates = 7551 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7552 params.link_sta_params.supported_rates_len = 7553 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7554 params.listen_interval = 7555 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7556 7557 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7558 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7559 7560 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) { 7561 params.support_p2p_ps = 7562 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7563 } else { 7564 /* 7565 * if not specified, assume it's supported for P2P GO interface, 7566 * and is NOT supported for AP interface 7567 */ 7568 params.support_p2p_ps = 7569 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO; 7570 } 7571 7572 if (info->attrs[NL80211_ATTR_PEER_AID]) 7573 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7574 else 7575 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7576 7577 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7578 params.capability = 7579 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7580 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7581 } 7582 7583 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7584 params.ext_capab = 7585 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7586 params.ext_capab_len = 7587 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7588 } 7589 7590 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7591 params.link_sta_params.ht_capa = 7592 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7593 7594 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7595 params.link_sta_params.vht_capa = 7596 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7597 7598 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7599 params.link_sta_params.he_capa = 7600 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7601 params.link_sta_params.he_capa_len = 7602 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7603 7604 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7605 params.link_sta_params.eht_capa = 7606 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7607 params.link_sta_params.eht_capa_len = 7608 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7609 7610 if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa, 7611 (const u8 *)params.link_sta_params.eht_capa, 7612 params.link_sta_params.eht_capa_len, 7613 false)) 7614 return -EINVAL; 7615 } 7616 } 7617 7618 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7619 params.link_sta_params.he_6ghz_capa = 7620 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7621 7622 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7623 params.link_sta_params.opmode_notif_used = true; 7624 params.link_sta_params.opmode_notif = 7625 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7626 } 7627 7628 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7629 params.plink_action = 7630 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7631 7632 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7633 params.airtime_weight = 7634 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7635 7636 if (params.airtime_weight && 7637 !wiphy_ext_feature_isset(&rdev->wiphy, 7638 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7639 return -EOPNOTSUPP; 7640 7641 err = nl80211_parse_sta_txpower_setting(info, 7642 ¶ms.link_sta_params.txpwr, 7643 ¶ms.link_sta_params.txpwr_set); 7644 if (err) 7645 return err; 7646 7647 err = nl80211_parse_sta_channel_info(info, ¶ms); 7648 if (err) 7649 return err; 7650 7651 err = nl80211_parse_sta_wme(info, ¶ms); 7652 if (err) 7653 return err; 7654 7655 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7656 return -EINVAL; 7657 7658 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT 7659 * as userspace might just pass through the capabilities from the IEs 7660 * directly, rather than enforcing this restriction and returning an 7661 * error in this case. 7662 */ 7663 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) { 7664 params.link_sta_params.ht_capa = NULL; 7665 params.link_sta_params.vht_capa = NULL; 7666 7667 /* HE and EHT require WME */ 7668 if (params.link_sta_params.he_capa_len || 7669 params.link_sta_params.he_6ghz_capa || 7670 params.link_sta_params.eht_capa_len) 7671 return -EINVAL; 7672 } 7673 7674 /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */ 7675 if (params.link_sta_params.he_6ghz_capa && 7676 (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa)) 7677 return -EINVAL; 7678 7679 /* When you run into this, adjust the code below for the new flag */ 7680 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 7681 7682 switch (dev->ieee80211_ptr->iftype) { 7683 case NL80211_IFTYPE_AP: 7684 case NL80211_IFTYPE_AP_VLAN: 7685 case NL80211_IFTYPE_P2P_GO: 7686 /* ignore WME attributes if iface/sta is not capable */ 7687 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) || 7688 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) 7689 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7690 7691 /* TDLS peers cannot be added */ 7692 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7693 info->attrs[NL80211_ATTR_PEER_AID]) 7694 return -EINVAL; 7695 /* but don't bother the driver with it */ 7696 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7697 7698 /* allow authenticated/associated only if driver handles it */ 7699 if (!(rdev->wiphy.features & 7700 NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 7701 params.sta_flags_mask & auth_assoc) 7702 return -EINVAL; 7703 7704 if (!wiphy_ext_feature_isset(&rdev->wiphy, 7705 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT) && 7706 params.sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 7707 return -EINVAL; 7708 7709 /* Older userspace, or userspace wanting to be compatible with 7710 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth 7711 * and assoc flags in the mask, but assumes the station will be 7712 * added as associated anyway since this was the required driver 7713 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was 7714 * introduced. 7715 * In order to not bother drivers with this quirk in the API 7716 * set the flags in both the mask and set for new stations in 7717 * this case. 7718 */ 7719 if (!(params.sta_flags_mask & auth_assoc)) { 7720 params.sta_flags_mask |= auth_assoc; 7721 params.sta_flags_set |= auth_assoc; 7722 } 7723 7724 /* must be last in here for error handling */ 7725 params.vlan = get_vlan(info, rdev); 7726 if (IS_ERR(params.vlan)) 7727 return PTR_ERR(params.vlan); 7728 break; 7729 case NL80211_IFTYPE_MESH_POINT: 7730 /* ignore uAPSD data */ 7731 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7732 7733 /* associated is disallowed */ 7734 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) 7735 return -EINVAL; 7736 /* TDLS peers cannot be added */ 7737 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7738 info->attrs[NL80211_ATTR_PEER_AID]) 7739 return -EINVAL; 7740 break; 7741 case NL80211_IFTYPE_STATION: 7742 case NL80211_IFTYPE_P2P_CLIENT: 7743 /* ignore uAPSD data */ 7744 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7745 7746 /* these are disallowed */ 7747 if (params.sta_flags_mask & 7748 (BIT(NL80211_STA_FLAG_ASSOCIATED) | 7749 BIT(NL80211_STA_FLAG_AUTHENTICATED))) 7750 return -EINVAL; 7751 /* Only TDLS peers can be added */ 7752 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 7753 return -EINVAL; 7754 /* Can only add if TDLS ... */ 7755 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS)) 7756 return -EOPNOTSUPP; 7757 /* ... with external setup is supported */ 7758 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP)) 7759 return -EOPNOTSUPP; 7760 /* 7761 * Older wpa_supplicant versions always mark the TDLS peer 7762 * as authorized, but it shouldn't yet be. 7763 */ 7764 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED); 7765 break; 7766 default: 7767 return -EOPNOTSUPP; 7768 } 7769 7770 /* be aware of params.vlan when changing code here */ 7771 7772 if (wdev->valid_links) { 7773 if (params.link_sta_params.link_id < 0) { 7774 err = -EINVAL; 7775 goto out; 7776 } 7777 if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) { 7778 err = -ENOLINK; 7779 goto out; 7780 } 7781 } else { 7782 if (params.link_sta_params.link_id >= 0) { 7783 err = -EINVAL; 7784 goto out; 7785 } 7786 } 7787 err = rdev_add_station(rdev, dev, mac_addr, ¶ms); 7788 out: 7789 dev_put(params.vlan); 7790 return err; 7791 } 7792 7793 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info) 7794 { 7795 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7796 struct net_device *dev = info->user_ptr[1]; 7797 struct wireless_dev *wdev = dev->ieee80211_ptr; 7798 struct station_del_parameters params; 7799 int link_id = nl80211_link_id_or_invalid(info->attrs); 7800 7801 memset(¶ms, 0, sizeof(params)); 7802 7803 if (info->attrs[NL80211_ATTR_MAC]) 7804 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 7805 7806 switch (wdev->iftype) { 7807 case NL80211_IFTYPE_AP: 7808 case NL80211_IFTYPE_AP_VLAN: 7809 case NL80211_IFTYPE_MESH_POINT: 7810 case NL80211_IFTYPE_P2P_GO: 7811 /* always accept these */ 7812 break; 7813 case NL80211_IFTYPE_ADHOC: 7814 /* conditionally accept */ 7815 if (wiphy_ext_feature_isset(&rdev->wiphy, 7816 NL80211_EXT_FEATURE_DEL_IBSS_STA)) 7817 break; 7818 return -EINVAL; 7819 default: 7820 return -EINVAL; 7821 } 7822 7823 if (!rdev->ops->del_station) 7824 return -EOPNOTSUPP; 7825 7826 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) { 7827 params.subtype = 7828 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]); 7829 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 && 7830 params.subtype != IEEE80211_STYPE_DEAUTH >> 4) 7831 return -EINVAL; 7832 } else { 7833 /* Default to Deauthentication frame */ 7834 params.subtype = IEEE80211_STYPE_DEAUTH >> 4; 7835 } 7836 7837 if (info->attrs[NL80211_ATTR_REASON_CODE]) { 7838 params.reason_code = 7839 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 7840 if (params.reason_code == 0) 7841 return -EINVAL; /* 0 is reserved */ 7842 } else { 7843 /* Default to reason code 2 */ 7844 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID; 7845 } 7846 7847 /* Link ID not expected in case of non-ML operation */ 7848 if (!wdev->valid_links && link_id != -1) 7849 return -EINVAL; 7850 7851 /* If given, a valid link ID should be passed during MLO */ 7852 if (wdev->valid_links && link_id >= 0 && 7853 !(wdev->valid_links & BIT(link_id))) 7854 return -EINVAL; 7855 7856 params.link_id = link_id; 7857 7858 return rdev_del_station(rdev, dev, ¶ms); 7859 } 7860 7861 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq, 7862 int flags, struct net_device *dev, 7863 u8 *dst, u8 *next_hop, 7864 struct mpath_info *pinfo) 7865 { 7866 void *hdr; 7867 struct nlattr *pinfoattr; 7868 7869 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH); 7870 if (!hdr) 7871 return -1; 7872 7873 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 7874 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) || 7875 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) || 7876 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation)) 7877 goto nla_put_failure; 7878 7879 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO); 7880 if (!pinfoattr) 7881 goto nla_put_failure; 7882 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) && 7883 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN, 7884 pinfo->frame_qlen)) 7885 goto nla_put_failure; 7886 if (((pinfo->filled & MPATH_INFO_SN) && 7887 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) || 7888 ((pinfo->filled & MPATH_INFO_METRIC) && 7889 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC, 7890 pinfo->metric)) || 7891 ((pinfo->filled & MPATH_INFO_EXPTIME) && 7892 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME, 7893 pinfo->exptime)) || 7894 ((pinfo->filled & MPATH_INFO_FLAGS) && 7895 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS, 7896 pinfo->flags)) || 7897 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) && 7898 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT, 7899 pinfo->discovery_timeout)) || 7900 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) && 7901 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES, 7902 pinfo->discovery_retries)) || 7903 ((pinfo->filled & MPATH_INFO_HOP_COUNT) && 7904 nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT, 7905 pinfo->hop_count)) || 7906 ((pinfo->filled & MPATH_INFO_PATH_CHANGE) && 7907 nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE, 7908 pinfo->path_change_count))) 7909 goto nla_put_failure; 7910 7911 nla_nest_end(msg, pinfoattr); 7912 7913 genlmsg_end(msg, hdr); 7914 return 0; 7915 7916 nla_put_failure: 7917 genlmsg_cancel(msg, hdr); 7918 return -EMSGSIZE; 7919 } 7920 7921 static int nl80211_dump_mpath(struct sk_buff *skb, 7922 struct netlink_callback *cb) 7923 { 7924 struct mpath_info pinfo; 7925 struct cfg80211_registered_device *rdev; 7926 struct wireless_dev *wdev; 7927 u8 dst[ETH_ALEN]; 7928 u8 next_hop[ETH_ALEN]; 7929 int path_idx = cb->args[2]; 7930 int err; 7931 7932 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7933 if (err) 7934 return err; 7935 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7936 __acquire(&rdev->wiphy.mtx); 7937 7938 if (!rdev->ops->dump_mpath) { 7939 err = -EOPNOTSUPP; 7940 goto out_err; 7941 } 7942 7943 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 7944 err = -EOPNOTSUPP; 7945 goto out_err; 7946 } 7947 7948 while (1) { 7949 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst, 7950 next_hop, &pinfo); 7951 if (err == -ENOENT) 7952 break; 7953 if (err) 7954 goto out_err; 7955 7956 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 7957 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7958 wdev->netdev, dst, next_hop, 7959 &pinfo) < 0) 7960 goto out; 7961 7962 path_idx++; 7963 } 7964 7965 out: 7966 cb->args[2] = path_idx; 7967 err = skb->len; 7968 out_err: 7969 wiphy_unlock(&rdev->wiphy); 7970 return err; 7971 } 7972 7973 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info) 7974 { 7975 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7976 int err; 7977 struct net_device *dev = info->user_ptr[1]; 7978 struct mpath_info pinfo; 7979 struct sk_buff *msg; 7980 u8 *dst = NULL; 7981 u8 next_hop[ETH_ALEN]; 7982 7983 memset(&pinfo, 0, sizeof(pinfo)); 7984 7985 if (!info->attrs[NL80211_ATTR_MAC]) 7986 return -EINVAL; 7987 7988 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7989 7990 if (!rdev->ops->get_mpath) 7991 return -EOPNOTSUPP; 7992 7993 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7994 return -EOPNOTSUPP; 7995 7996 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo); 7997 if (err) 7998 return err; 7999 8000 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8001 if (!msg) 8002 return -ENOMEM; 8003 8004 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 8005 dev, dst, next_hop, &pinfo) < 0) { 8006 nlmsg_free(msg); 8007 return -ENOBUFS; 8008 } 8009 8010 return genlmsg_reply(msg, info); 8011 } 8012 8013 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info) 8014 { 8015 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8016 struct net_device *dev = info->user_ptr[1]; 8017 u8 *dst = NULL; 8018 u8 *next_hop = NULL; 8019 8020 if (!info->attrs[NL80211_ATTR_MAC]) 8021 return -EINVAL; 8022 8023 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 8024 return -EINVAL; 8025 8026 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8027 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 8028 8029 if (!rdev->ops->change_mpath) 8030 return -EOPNOTSUPP; 8031 8032 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8033 return -EOPNOTSUPP; 8034 8035 return rdev_change_mpath(rdev, dev, dst, next_hop); 8036 } 8037 8038 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info) 8039 { 8040 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8041 struct net_device *dev = info->user_ptr[1]; 8042 u8 *dst = NULL; 8043 u8 *next_hop = NULL; 8044 8045 if (!info->attrs[NL80211_ATTR_MAC]) 8046 return -EINVAL; 8047 8048 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 8049 return -EINVAL; 8050 8051 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8052 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 8053 8054 if (!rdev->ops->add_mpath) 8055 return -EOPNOTSUPP; 8056 8057 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8058 return -EOPNOTSUPP; 8059 8060 return rdev_add_mpath(rdev, dev, dst, next_hop); 8061 } 8062 8063 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info) 8064 { 8065 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8066 struct net_device *dev = info->user_ptr[1]; 8067 u8 *dst = NULL; 8068 8069 if (info->attrs[NL80211_ATTR_MAC]) 8070 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8071 8072 if (!rdev->ops->del_mpath) 8073 return -EOPNOTSUPP; 8074 8075 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8076 return -EOPNOTSUPP; 8077 8078 return rdev_del_mpath(rdev, dev, dst); 8079 } 8080 8081 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info) 8082 { 8083 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8084 int err; 8085 struct net_device *dev = info->user_ptr[1]; 8086 struct mpath_info pinfo; 8087 struct sk_buff *msg; 8088 u8 *dst = NULL; 8089 u8 mpp[ETH_ALEN]; 8090 8091 memset(&pinfo, 0, sizeof(pinfo)); 8092 8093 if (!info->attrs[NL80211_ATTR_MAC]) 8094 return -EINVAL; 8095 8096 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 8097 8098 if (!rdev->ops->get_mpp) 8099 return -EOPNOTSUPP; 8100 8101 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 8102 return -EOPNOTSUPP; 8103 8104 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo); 8105 if (err) 8106 return err; 8107 8108 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8109 if (!msg) 8110 return -ENOMEM; 8111 8112 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 8113 dev, dst, mpp, &pinfo) < 0) { 8114 nlmsg_free(msg); 8115 return -ENOBUFS; 8116 } 8117 8118 return genlmsg_reply(msg, info); 8119 } 8120 8121 static int nl80211_dump_mpp(struct sk_buff *skb, 8122 struct netlink_callback *cb) 8123 { 8124 struct mpath_info pinfo; 8125 struct cfg80211_registered_device *rdev; 8126 struct wireless_dev *wdev; 8127 u8 dst[ETH_ALEN]; 8128 u8 mpp[ETH_ALEN]; 8129 int path_idx = cb->args[2]; 8130 int err; 8131 8132 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 8133 if (err) 8134 return err; 8135 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 8136 __acquire(&rdev->wiphy.mtx); 8137 8138 if (!rdev->ops->dump_mpp) { 8139 err = -EOPNOTSUPP; 8140 goto out_err; 8141 } 8142 8143 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 8144 err = -EOPNOTSUPP; 8145 goto out_err; 8146 } 8147 8148 while (1) { 8149 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst, 8150 mpp, &pinfo); 8151 if (err == -ENOENT) 8152 break; 8153 if (err) 8154 goto out_err; 8155 8156 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 8157 cb->nlh->nlmsg_seq, NLM_F_MULTI, 8158 wdev->netdev, dst, mpp, 8159 &pinfo) < 0) 8160 goto out; 8161 8162 path_idx++; 8163 } 8164 8165 out: 8166 cb->args[2] = path_idx; 8167 err = skb->len; 8168 out_err: 8169 wiphy_unlock(&rdev->wiphy); 8170 return err; 8171 } 8172 8173 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info) 8174 { 8175 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8176 struct net_device *dev = info->user_ptr[1]; 8177 struct bss_parameters params; 8178 8179 memset(¶ms, 0, sizeof(params)); 8180 params.link_id = nl80211_link_id_or_invalid(info->attrs); 8181 /* default to not changing parameters */ 8182 params.use_cts_prot = -1; 8183 params.use_short_preamble = -1; 8184 params.use_short_slot_time = -1; 8185 params.ap_isolate = -1; 8186 params.ht_opmode = -1; 8187 params.p2p_ctwindow = -1; 8188 params.p2p_opp_ps = -1; 8189 8190 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT]) 8191 params.use_cts_prot = 8192 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]); 8193 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]) 8194 params.use_short_preamble = 8195 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]); 8196 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]) 8197 params.use_short_slot_time = 8198 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]); 8199 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 8200 params.basic_rates = 8201 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 8202 params.basic_rates_len = 8203 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 8204 } 8205 if (info->attrs[NL80211_ATTR_AP_ISOLATE]) 8206 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]); 8207 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE]) 8208 params.ht_opmode = 8209 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]); 8210 8211 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 8212 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8213 return -EINVAL; 8214 params.p2p_ctwindow = 8215 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 8216 if (params.p2p_ctwindow != 0 && 8217 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) 8218 return -EINVAL; 8219 } 8220 8221 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 8222 u8 tmp; 8223 8224 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8225 return -EINVAL; 8226 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 8227 params.p2p_opp_ps = tmp; 8228 if (params.p2p_opp_ps && 8229 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) 8230 return -EINVAL; 8231 } 8232 8233 if (!rdev->ops->change_bss) 8234 return -EOPNOTSUPP; 8235 8236 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 8237 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8238 return -EOPNOTSUPP; 8239 8240 return rdev_change_bss(rdev, dev, ¶ms); 8241 } 8242 8243 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info) 8244 { 8245 char *data = NULL; 8246 bool is_indoor; 8247 enum nl80211_user_reg_hint_type user_reg_hint_type; 8248 u32 owner_nlportid; 8249 8250 /* 8251 * You should only get this when cfg80211 hasn't yet initialized 8252 * completely when built-in to the kernel right between the time 8253 * window between nl80211_init() and regulatory_init(), if that is 8254 * even possible. 8255 */ 8256 if (unlikely(!rcu_access_pointer(cfg80211_regdomain))) 8257 return -EINPROGRESS; 8258 8259 user_reg_hint_type = 8260 nla_get_u32_default(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE], 8261 NL80211_USER_REG_HINT_USER); 8262 8263 switch (user_reg_hint_type) { 8264 case NL80211_USER_REG_HINT_USER: 8265 case NL80211_USER_REG_HINT_CELL_BASE: 8266 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8267 return -EINVAL; 8268 8269 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8270 return regulatory_hint_user(data, user_reg_hint_type); 8271 case NL80211_USER_REG_HINT_INDOOR: 8272 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 8273 owner_nlportid = info->snd_portid; 8274 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR]; 8275 } else { 8276 owner_nlportid = 0; 8277 is_indoor = true; 8278 } 8279 8280 regulatory_hint_indoor(is_indoor, owner_nlportid); 8281 return 0; 8282 default: 8283 return -EINVAL; 8284 } 8285 } 8286 8287 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info) 8288 { 8289 return reg_reload_regdb(); 8290 } 8291 8292 static int nl80211_get_mesh_config(struct sk_buff *skb, 8293 struct genl_info *info) 8294 { 8295 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8296 struct net_device *dev = info->user_ptr[1]; 8297 struct wireless_dev *wdev = dev->ieee80211_ptr; 8298 struct mesh_config cur_params; 8299 int err = 0; 8300 void *hdr; 8301 struct nlattr *pinfoattr; 8302 struct sk_buff *msg; 8303 8304 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8305 return -EOPNOTSUPP; 8306 8307 if (!rdev->ops->get_mesh_config) 8308 return -EOPNOTSUPP; 8309 8310 /* If not connected, get default parameters */ 8311 if (!wdev->u.mesh.id_len) 8312 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params)); 8313 else 8314 err = rdev_get_mesh_config(rdev, dev, &cur_params); 8315 8316 if (err) 8317 return err; 8318 8319 /* Draw up a netlink message to send back */ 8320 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8321 if (!msg) 8322 return -ENOMEM; 8323 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8324 NL80211_CMD_GET_MESH_CONFIG); 8325 if (!hdr) 8326 goto out; 8327 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG); 8328 if (!pinfoattr) 8329 goto nla_put_failure; 8330 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 8331 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT, 8332 cur_params.dot11MeshRetryTimeout) || 8333 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT, 8334 cur_params.dot11MeshConfirmTimeout) || 8335 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT, 8336 cur_params.dot11MeshHoldingTimeout) || 8337 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS, 8338 cur_params.dot11MeshMaxPeerLinks) || 8339 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES, 8340 cur_params.dot11MeshMaxRetries) || 8341 nla_put_u8(msg, NL80211_MESHCONF_TTL, 8342 cur_params.dot11MeshTTL) || 8343 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL, 8344 cur_params.element_ttl) || 8345 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8346 cur_params.auto_open_plinks) || 8347 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8348 cur_params.dot11MeshNbrOffsetMaxNeighbor) || 8349 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8350 cur_params.dot11MeshHWMPmaxPREQretries) || 8351 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME, 8352 cur_params.path_refresh_time) || 8353 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8354 cur_params.min_discovery_timeout) || 8355 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8356 cur_params.dot11MeshHWMPactivePathTimeout) || 8357 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8358 cur_params.dot11MeshHWMPpreqMinInterval) || 8359 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8360 cur_params.dot11MeshHWMPperrMinInterval) || 8361 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8362 cur_params.dot11MeshHWMPnetDiameterTraversalTime) || 8363 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE, 8364 cur_params.dot11MeshHWMPRootMode) || 8365 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8366 cur_params.dot11MeshHWMPRannInterval) || 8367 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8368 cur_params.dot11MeshGateAnnouncementProtocol) || 8369 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING, 8370 cur_params.dot11MeshForwarding) || 8371 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD, 8372 cur_params.rssi_threshold) || 8373 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE, 8374 cur_params.ht_opmode) || 8375 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8376 cur_params.dot11MeshHWMPactivePathToRootTimeout) || 8377 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8378 cur_params.dot11MeshHWMProotInterval) || 8379 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8380 cur_params.dot11MeshHWMPconfirmationInterval) || 8381 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE, 8382 cur_params.power_mode) || 8383 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW, 8384 cur_params.dot11MeshAwakeWindowDuration) || 8385 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT, 8386 cur_params.plink_timeout) || 8387 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE, 8388 cur_params.dot11MeshConnectedToMeshGate) || 8389 nla_put_u8(msg, NL80211_MESHCONF_NOLEARN, 8390 cur_params.dot11MeshNolearn) || 8391 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS, 8392 cur_params.dot11MeshConnectedToAuthServer)) 8393 goto nla_put_failure; 8394 nla_nest_end(msg, pinfoattr); 8395 genlmsg_end(msg, hdr); 8396 return genlmsg_reply(msg, info); 8397 8398 nla_put_failure: 8399 out: 8400 nlmsg_free(msg); 8401 return -ENOBUFS; 8402 } 8403 8404 static const struct nla_policy 8405 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = { 8406 [NL80211_MESHCONF_RETRY_TIMEOUT] = 8407 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8408 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = 8409 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8410 [NL80211_MESHCONF_HOLDING_TIMEOUT] = 8411 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8412 [NL80211_MESHCONF_MAX_PEER_LINKS] = 8413 NLA_POLICY_RANGE(NLA_U16, 0, 255), 8414 [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16), 8415 [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8416 [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8417 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1), 8418 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = 8419 NLA_POLICY_RANGE(NLA_U32, 1, 255), 8420 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 }, 8421 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 }, 8422 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1), 8423 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 }, 8424 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = 8425 NLA_POLICY_MIN(NLA_U16, 1), 8426 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = 8427 NLA_POLICY_MIN(NLA_U16, 1), 8428 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = 8429 NLA_POLICY_MIN(NLA_U16, 1), 8430 [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4), 8431 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = 8432 NLA_POLICY_MIN(NLA_U16, 1), 8433 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1), 8434 [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1), 8435 [NL80211_MESHCONF_RSSI_THRESHOLD] = 8436 NLA_POLICY_RANGE(NLA_S32, -255, 0), 8437 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 }, 8438 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 }, 8439 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = 8440 NLA_POLICY_MIN(NLA_U16, 1), 8441 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = 8442 NLA_POLICY_MIN(NLA_U16, 1), 8443 [NL80211_MESHCONF_POWER_MODE] = 8444 NLA_POLICY_RANGE(NLA_U32, 8445 NL80211_MESH_POWER_ACTIVE, 8446 NL80211_MESH_POWER_MAX), 8447 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 }, 8448 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 }, 8449 [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8450 [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8451 [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8452 }; 8453 8454 static const struct nla_policy 8455 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = { 8456 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 }, 8457 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 }, 8458 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 }, 8459 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG }, 8460 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 }, 8461 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG }, 8462 [NL80211_MESH_SETUP_IE] = 8463 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 8464 IEEE80211_MAX_DATA_LEN), 8465 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG }, 8466 }; 8467 8468 static int nl80211_parse_mesh_config(struct genl_info *info, 8469 struct mesh_config *cfg, 8470 u32 *mask_out) 8471 { 8472 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1]; 8473 u32 mask = 0; 8474 u16 ht_opmode; 8475 8476 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \ 8477 do { \ 8478 if (tb[attr]) { \ 8479 cfg->param = fn(tb[attr]); \ 8480 mask |= BIT((attr) - 1); \ 8481 } \ 8482 } while (0) 8483 8484 if (!info->attrs[NL80211_ATTR_MESH_CONFIG]) 8485 return -EINVAL; 8486 if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack)) 8487 return -EINVAL; 8488 8489 /* This makes sure that there aren't more than 32 mesh config 8490 * parameters (otherwise our bitfield scheme would not work.) */ 8491 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32); 8492 8493 /* Fill in the params struct */ 8494 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask, 8495 NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16); 8496 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask, 8497 NL80211_MESHCONF_CONFIRM_TIMEOUT, 8498 nla_get_u16); 8499 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask, 8500 NL80211_MESHCONF_HOLDING_TIMEOUT, 8501 nla_get_u16); 8502 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask, 8503 NL80211_MESHCONF_MAX_PEER_LINKS, 8504 nla_get_u16); 8505 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask, 8506 NL80211_MESHCONF_MAX_RETRIES, nla_get_u8); 8507 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask, 8508 NL80211_MESHCONF_TTL, nla_get_u8); 8509 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask, 8510 NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8); 8511 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask, 8512 NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8513 nla_get_u8); 8514 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, 8515 mask, 8516 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8517 nla_get_u32); 8518 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask, 8519 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8520 nla_get_u8); 8521 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask, 8522 NL80211_MESHCONF_PATH_REFRESH_TIME, 8523 nla_get_u32); 8524 if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) && 8525 (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535)) 8526 return -EINVAL; 8527 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask, 8528 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8529 nla_get_u16); 8530 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, 8531 mask, 8532 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8533 nla_get_u32); 8534 if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) && 8535 (cfg->dot11MeshHWMPactivePathTimeout < 1 || 8536 cfg->dot11MeshHWMPactivePathTimeout > 65535)) 8537 return -EINVAL; 8538 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask, 8539 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8540 nla_get_u16); 8541 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask, 8542 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8543 nla_get_u16); 8544 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8545 dot11MeshHWMPnetDiameterTraversalTime, mask, 8546 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8547 nla_get_u16); 8548 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask, 8549 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8); 8550 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask, 8551 NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8552 nla_get_u16); 8553 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol, 8554 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8555 nla_get_u8); 8556 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask, 8557 NL80211_MESHCONF_FORWARDING, nla_get_u8); 8558 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask, 8559 NL80211_MESHCONF_RSSI_THRESHOLD, 8560 nla_get_s32); 8561 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask, 8562 NL80211_MESHCONF_CONNECTED_TO_GATE, 8563 nla_get_u8); 8564 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask, 8565 NL80211_MESHCONF_CONNECTED_TO_AS, 8566 nla_get_u8); 8567 /* 8568 * Check HT operation mode based on 8569 * IEEE 802.11-2016 9.4.2.57 HT Operation element. 8570 */ 8571 if (tb[NL80211_MESHCONF_HT_OPMODE]) { 8572 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]); 8573 8574 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION | 8575 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT | 8576 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)) 8577 return -EINVAL; 8578 8579 /* NON_HT_STA bit is reserved, but some programs set it */ 8580 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT; 8581 8582 cfg->ht_opmode = ht_opmode; 8583 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1)); 8584 } 8585 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8586 dot11MeshHWMPactivePathToRootTimeout, mask, 8587 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8588 nla_get_u32); 8589 if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) && 8590 (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 || 8591 cfg->dot11MeshHWMPactivePathToRootTimeout > 65535)) 8592 return -EINVAL; 8593 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask, 8594 NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8595 nla_get_u16); 8596 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval, 8597 mask, 8598 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8599 nla_get_u16); 8600 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask, 8601 NL80211_MESHCONF_POWER_MODE, nla_get_u32); 8602 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask, 8603 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16); 8604 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask, 8605 NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32); 8606 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask, 8607 NL80211_MESHCONF_NOLEARN, nla_get_u8); 8608 if (mask_out) 8609 *mask_out = mask; 8610 8611 return 0; 8612 8613 #undef FILL_IN_MESH_PARAM_IF_SET 8614 } 8615 8616 static int nl80211_parse_mesh_setup(struct genl_info *info, 8617 struct mesh_setup *setup) 8618 { 8619 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8620 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1]; 8621 8622 if (!info->attrs[NL80211_ATTR_MESH_SETUP]) 8623 return -EINVAL; 8624 if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack)) 8625 return -EINVAL; 8626 8627 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC]) 8628 setup->sync_method = 8629 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ? 8630 IEEE80211_SYNC_METHOD_VENDOR : 8631 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET; 8632 8633 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL]) 8634 setup->path_sel_proto = 8635 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ? 8636 IEEE80211_PATH_PROTOCOL_VENDOR : 8637 IEEE80211_PATH_PROTOCOL_HWMP; 8638 8639 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC]) 8640 setup->path_metric = 8641 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ? 8642 IEEE80211_PATH_METRIC_VENDOR : 8643 IEEE80211_PATH_METRIC_AIRTIME; 8644 8645 if (tb[NL80211_MESH_SETUP_IE]) { 8646 struct nlattr *ieattr = 8647 tb[NL80211_MESH_SETUP_IE]; 8648 setup->ie = nla_data(ieattr); 8649 setup->ie_len = nla_len(ieattr); 8650 } 8651 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] && 8652 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM)) 8653 return -EINVAL; 8654 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]); 8655 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]); 8656 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]); 8657 if (setup->is_secure) 8658 setup->user_mpm = true; 8659 8660 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) { 8661 if (!setup->user_mpm) 8662 return -EINVAL; 8663 setup->auth_id = 8664 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]); 8665 } 8666 8667 return 0; 8668 } 8669 8670 static int nl80211_update_mesh_config(struct sk_buff *skb, 8671 struct genl_info *info) 8672 { 8673 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8674 struct net_device *dev = info->user_ptr[1]; 8675 struct wireless_dev *wdev = dev->ieee80211_ptr; 8676 struct mesh_config cfg = {}; 8677 u32 mask; 8678 int err; 8679 8680 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8681 return -EOPNOTSUPP; 8682 8683 if (!rdev->ops->update_mesh_config) 8684 return -EOPNOTSUPP; 8685 8686 err = nl80211_parse_mesh_config(info, &cfg, &mask); 8687 if (err) 8688 return err; 8689 8690 if (!wdev->u.mesh.id_len) 8691 err = -ENOLINK; 8692 8693 if (!err) 8694 err = rdev_update_mesh_config(rdev, dev, mask, &cfg); 8695 8696 return err; 8697 } 8698 8699 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom, 8700 struct sk_buff *msg) 8701 { 8702 struct nlattr *nl_reg_rules; 8703 unsigned int i; 8704 8705 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) || 8706 (regdom->dfs_region && 8707 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region))) 8708 goto nla_put_failure; 8709 8710 nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES); 8711 if (!nl_reg_rules) 8712 goto nla_put_failure; 8713 8714 for (i = 0; i < regdom->n_reg_rules; i++) { 8715 struct nlattr *nl_reg_rule; 8716 const struct ieee80211_reg_rule *reg_rule; 8717 const struct ieee80211_freq_range *freq_range; 8718 const struct ieee80211_power_rule *power_rule; 8719 unsigned int max_bandwidth_khz; 8720 8721 reg_rule = ®dom->reg_rules[i]; 8722 freq_range = ®_rule->freq_range; 8723 power_rule = ®_rule->power_rule; 8724 8725 nl_reg_rule = nla_nest_start_noflag(msg, i); 8726 if (!nl_reg_rule) 8727 goto nla_put_failure; 8728 8729 max_bandwidth_khz = freq_range->max_bandwidth_khz; 8730 if (!max_bandwidth_khz) 8731 max_bandwidth_khz = reg_get_max_bandwidth(regdom, 8732 reg_rule); 8733 8734 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS, 8735 reg_rule->flags) || 8736 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START, 8737 freq_range->start_freq_khz) || 8738 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END, 8739 freq_range->end_freq_khz) || 8740 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW, 8741 max_bandwidth_khz) || 8742 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN, 8743 power_rule->max_antenna_gain) || 8744 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP, 8745 power_rule->max_eirp) || 8746 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME, 8747 reg_rule->dfs_cac_ms)) 8748 goto nla_put_failure; 8749 8750 if ((reg_rule->flags & NL80211_RRF_PSD) && 8751 nla_put_s8(msg, NL80211_ATTR_POWER_RULE_PSD, 8752 reg_rule->psd)) 8753 goto nla_put_failure; 8754 8755 nla_nest_end(msg, nl_reg_rule); 8756 } 8757 8758 nla_nest_end(msg, nl_reg_rules); 8759 return 0; 8760 8761 nla_put_failure: 8762 return -EMSGSIZE; 8763 } 8764 8765 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info) 8766 { 8767 const struct ieee80211_regdomain *regdom = NULL; 8768 struct cfg80211_registered_device *rdev; 8769 struct wiphy *wiphy = NULL; 8770 struct sk_buff *msg; 8771 int err = -EMSGSIZE; 8772 void *hdr; 8773 8774 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8775 if (!msg) 8776 return -ENOBUFS; 8777 8778 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8779 NL80211_CMD_GET_REG); 8780 if (!hdr) 8781 goto put_failure; 8782 8783 rtnl_lock(); 8784 8785 if (info->attrs[NL80211_ATTR_WIPHY]) { 8786 bool self_managed; 8787 8788 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 8789 if (IS_ERR(rdev)) { 8790 err = PTR_ERR(rdev); 8791 goto nla_put_failure; 8792 } 8793 8794 wiphy = &rdev->wiphy; 8795 self_managed = wiphy->regulatory_flags & 8796 REGULATORY_WIPHY_SELF_MANAGED; 8797 8798 rcu_read_lock(); 8799 8800 regdom = get_wiphy_regdom(wiphy); 8801 8802 /* a self-managed-reg device must have a private regdom */ 8803 if (WARN_ON(!regdom && self_managed)) { 8804 err = -EINVAL; 8805 goto nla_put_failure_rcu; 8806 } 8807 8808 if (regdom && 8809 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8810 goto nla_put_failure_rcu; 8811 } else { 8812 rcu_read_lock(); 8813 } 8814 8815 if (!wiphy && reg_last_request_cell_base() && 8816 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8817 NL80211_USER_REG_HINT_CELL_BASE)) 8818 goto nla_put_failure_rcu; 8819 8820 if (!regdom) 8821 regdom = rcu_dereference(cfg80211_regdomain); 8822 8823 if (nl80211_put_regdom(regdom, msg)) 8824 goto nla_put_failure_rcu; 8825 8826 rcu_read_unlock(); 8827 8828 genlmsg_end(msg, hdr); 8829 rtnl_unlock(); 8830 return genlmsg_reply(msg, info); 8831 8832 nla_put_failure_rcu: 8833 rcu_read_unlock(); 8834 nla_put_failure: 8835 rtnl_unlock(); 8836 put_failure: 8837 nlmsg_free(msg); 8838 return err; 8839 } 8840 8841 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb, 8842 u32 seq, int flags, struct wiphy *wiphy, 8843 const struct ieee80211_regdomain *regdom) 8844 { 8845 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 8846 NL80211_CMD_GET_REG); 8847 8848 if (!hdr) 8849 return -1; 8850 8851 genl_dump_check_consistent(cb, hdr); 8852 8853 if (nl80211_put_regdom(regdom, msg)) 8854 goto nla_put_failure; 8855 8856 if (!wiphy && reg_last_request_cell_base() && 8857 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8858 NL80211_USER_REG_HINT_CELL_BASE)) 8859 goto nla_put_failure; 8860 8861 if (wiphy && 8862 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8863 goto nla_put_failure; 8864 8865 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 8866 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 8867 goto nla_put_failure; 8868 8869 genlmsg_end(msg, hdr); 8870 return 0; 8871 8872 nla_put_failure: 8873 genlmsg_cancel(msg, hdr); 8874 return -EMSGSIZE; 8875 } 8876 8877 static int nl80211_get_reg_dump(struct sk_buff *skb, 8878 struct netlink_callback *cb) 8879 { 8880 const struct ieee80211_regdomain *regdom = NULL; 8881 struct cfg80211_registered_device *rdev; 8882 int err, reg_idx, start = cb->args[2]; 8883 8884 rcu_read_lock(); 8885 8886 if (cfg80211_regdomain && start == 0) { 8887 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8888 NLM_F_MULTI, NULL, 8889 rcu_dereference(cfg80211_regdomain)); 8890 if (err < 0) 8891 goto out_err; 8892 } 8893 8894 /* the global regdom is idx 0 */ 8895 reg_idx = 1; 8896 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 8897 regdom = get_wiphy_regdom(&rdev->wiphy); 8898 if (!regdom) 8899 continue; 8900 8901 if (++reg_idx <= start) 8902 continue; 8903 8904 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8905 NLM_F_MULTI, &rdev->wiphy, regdom); 8906 if (err < 0) { 8907 reg_idx--; 8908 break; 8909 } 8910 } 8911 8912 cb->args[2] = reg_idx; 8913 err = skb->len; 8914 out_err: 8915 rcu_read_unlock(); 8916 return err; 8917 } 8918 8919 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 8920 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = { 8921 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 }, 8922 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 }, 8923 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 }, 8924 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 }, 8925 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 }, 8926 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 }, 8927 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 }, 8928 }; 8929 8930 static int parse_reg_rule(struct nlattr *tb[], 8931 struct ieee80211_reg_rule *reg_rule) 8932 { 8933 struct ieee80211_freq_range *freq_range = ®_rule->freq_range; 8934 struct ieee80211_power_rule *power_rule = ®_rule->power_rule; 8935 8936 if (!tb[NL80211_ATTR_REG_RULE_FLAGS]) 8937 return -EINVAL; 8938 if (!tb[NL80211_ATTR_FREQ_RANGE_START]) 8939 return -EINVAL; 8940 if (!tb[NL80211_ATTR_FREQ_RANGE_END]) 8941 return -EINVAL; 8942 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]) 8943 return -EINVAL; 8944 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]) 8945 return -EINVAL; 8946 8947 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]); 8948 8949 freq_range->start_freq_khz = 8950 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]); 8951 freq_range->end_freq_khz = 8952 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]); 8953 freq_range->max_bandwidth_khz = 8954 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]); 8955 8956 power_rule->max_eirp = 8957 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]); 8958 8959 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]) 8960 power_rule->max_antenna_gain = 8961 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]); 8962 8963 if (tb[NL80211_ATTR_DFS_CAC_TIME]) 8964 reg_rule->dfs_cac_ms = 8965 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]); 8966 8967 return 0; 8968 } 8969 8970 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info) 8971 { 8972 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1]; 8973 struct nlattr *nl_reg_rule; 8974 char *alpha2; 8975 int rem_reg_rules, r; 8976 u32 num_rules = 0, rule_idx = 0; 8977 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET; 8978 struct ieee80211_regdomain *rd; 8979 8980 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8981 return -EINVAL; 8982 8983 if (!info->attrs[NL80211_ATTR_REG_RULES]) 8984 return -EINVAL; 8985 8986 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8987 8988 if (info->attrs[NL80211_ATTR_DFS_REGION]) 8989 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]); 8990 8991 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 8992 rem_reg_rules) { 8993 num_rules++; 8994 if (num_rules > NL80211_MAX_SUPP_REG_RULES) 8995 return -EINVAL; 8996 } 8997 8998 rtnl_lock(); 8999 if (!reg_is_valid_request(alpha2)) { 9000 r = -EINVAL; 9001 goto out; 9002 } 9003 9004 rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL); 9005 if (!rd) { 9006 r = -ENOMEM; 9007 goto out; 9008 } 9009 9010 rd->n_reg_rules = num_rules; 9011 rd->alpha2[0] = alpha2[0]; 9012 rd->alpha2[1] = alpha2[1]; 9013 9014 /* 9015 * Disable DFS master mode if the DFS region was 9016 * not supported or known on this kernel. 9017 */ 9018 if (reg_supported_dfs_region(dfs_region)) 9019 rd->dfs_region = dfs_region; 9020 9021 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 9022 rem_reg_rules) { 9023 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX, 9024 nl_reg_rule, reg_rule_policy, 9025 info->extack); 9026 if (r) 9027 goto bad_reg; 9028 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]); 9029 if (r) 9030 goto bad_reg; 9031 9032 rule_idx++; 9033 9034 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) { 9035 r = -EINVAL; 9036 goto bad_reg; 9037 } 9038 } 9039 9040 r = set_regdom(rd, REGD_SOURCE_CRDA); 9041 /* set_regdom takes ownership of rd */ 9042 rd = NULL; 9043 bad_reg: 9044 kfree(rd); 9045 out: 9046 rtnl_unlock(); 9047 return r; 9048 } 9049 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */ 9050 9051 static int validate_scan_freqs(struct nlattr *freqs) 9052 { 9053 struct nlattr *attr1, *attr2; 9054 int n_channels = 0, tmp1, tmp2; 9055 9056 nla_for_each_nested(attr1, freqs, tmp1) 9057 if (nla_len(attr1) != sizeof(u32)) 9058 return 0; 9059 9060 nla_for_each_nested(attr1, freqs, tmp1) { 9061 n_channels++; 9062 /* 9063 * Some hardware has a limited channel list for 9064 * scanning, and it is pretty much nonsensical 9065 * to scan for a channel twice, so disallow that 9066 * and don't require drivers to check that the 9067 * channel list they get isn't longer than what 9068 * they can scan, as long as they can scan all 9069 * the channels they registered at once. 9070 */ 9071 nla_for_each_nested(attr2, freqs, tmp2) 9072 if (attr1 != attr2 && 9073 nla_get_u32(attr1) == nla_get_u32(attr2)) 9074 return 0; 9075 } 9076 9077 return n_channels; 9078 } 9079 9080 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b) 9081 { 9082 return b < NUM_NL80211_BANDS && wiphy->bands[b]; 9083 } 9084 9085 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy, 9086 struct cfg80211_bss_selection *bss_select) 9087 { 9088 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1]; 9089 struct nlattr *nest; 9090 int err; 9091 bool found = false; 9092 int i; 9093 9094 /* only process one nested attribute */ 9095 nest = nla_data(nla); 9096 if (!nla_ok(nest, nla_len(nest))) 9097 return -EINVAL; 9098 9099 err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX, 9100 nest, nl80211_bss_select_policy, 9101 NULL); 9102 if (err) 9103 return err; 9104 9105 /* only one attribute may be given */ 9106 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) { 9107 if (attr[i]) { 9108 if (found) 9109 return -EINVAL; 9110 found = true; 9111 } 9112 } 9113 9114 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID; 9115 9116 if (attr[NL80211_BSS_SELECT_ATTR_RSSI]) 9117 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI; 9118 9119 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) { 9120 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF; 9121 bss_select->param.band_pref = 9122 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]); 9123 if (!is_band_valid(wiphy, bss_select->param.band_pref)) 9124 return -EINVAL; 9125 } 9126 9127 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) { 9128 struct nl80211_bss_select_rssi_adjust *adj_param; 9129 9130 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]); 9131 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST; 9132 bss_select->param.adjust.band = adj_param->band; 9133 bss_select->param.adjust.delta = adj_param->delta; 9134 if (!is_band_valid(wiphy, bss_select->param.adjust.band)) 9135 return -EINVAL; 9136 } 9137 9138 /* user-space did not provide behaviour attribute */ 9139 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID) 9140 return -EINVAL; 9141 9142 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour))) 9143 return -EINVAL; 9144 9145 return 0; 9146 } 9147 9148 int nl80211_parse_random_mac(struct nlattr **attrs, 9149 u8 *mac_addr, u8 *mac_addr_mask) 9150 { 9151 int i; 9152 9153 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) { 9154 eth_zero_addr(mac_addr); 9155 eth_zero_addr(mac_addr_mask); 9156 mac_addr[0] = 0x2; 9157 mac_addr_mask[0] = 0x3; 9158 9159 return 0; 9160 } 9161 9162 /* need both or none */ 9163 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK]) 9164 return -EINVAL; 9165 9166 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN); 9167 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN); 9168 9169 /* don't allow or configure an mcast address */ 9170 if (!is_multicast_ether_addr(mac_addr_mask) || 9171 is_multicast_ether_addr(mac_addr)) 9172 return -EINVAL; 9173 9174 /* 9175 * allow users to pass a MAC address that has bits set outside 9176 * of the mask, but don't bother drivers with having to deal 9177 * with such bits 9178 */ 9179 for (i = 0; i < ETH_ALEN; i++) 9180 mac_addr[i] &= mac_addr_mask[i]; 9181 9182 return 0; 9183 } 9184 9185 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev, 9186 struct ieee80211_channel *chan) 9187 { 9188 unsigned int link_id; 9189 bool all_ok = true; 9190 9191 lockdep_assert_wiphy(wdev->wiphy); 9192 9193 if (!cfg80211_wdev_channel_allowed(wdev, chan)) 9194 return false; 9195 9196 if (!cfg80211_beaconing_iface_active(wdev)) 9197 return true; 9198 9199 /* 9200 * FIXME: check if we have a free HW resource/link for chan 9201 * 9202 * This, as well as the FIXME below, requires knowing the link 9203 * capabilities of the hardware. 9204 */ 9205 9206 /* we cannot leave radar channels */ 9207 for_each_valid_link(wdev, link_id) { 9208 struct cfg80211_chan_def *chandef; 9209 9210 chandef = wdev_chandef(wdev, link_id); 9211 if (!chandef || !chandef->chan) 9212 continue; 9213 9214 /* 9215 * FIXME: don't require all_ok, but rather check only the 9216 * correct HW resource/link onto which 'chan' falls, 9217 * as only that link leaves the channel for doing 9218 * the off-channel operation. 9219 */ 9220 9221 if (chandef->chan->flags & IEEE80211_CHAN_RADAR) 9222 all_ok = false; 9223 } 9224 9225 if (all_ok) 9226 return true; 9227 9228 return regulatory_pre_cac_allowed(wdev->wiphy); 9229 } 9230 9231 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag, 9232 enum nl80211_ext_feature_index feat) 9233 { 9234 if (!(flags & flag)) 9235 return true; 9236 if (wiphy_ext_feature_isset(wiphy, feat)) 9237 return true; 9238 return false; 9239 } 9240 9241 static int 9242 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev, 9243 void *request, struct nlattr **attrs, 9244 bool is_sched_scan) 9245 { 9246 u8 *mac_addr, *mac_addr_mask; 9247 u32 *flags; 9248 enum nl80211_feature_flags randomness_flag; 9249 9250 if (!attrs[NL80211_ATTR_SCAN_FLAGS]) 9251 return 0; 9252 9253 if (is_sched_scan) { 9254 struct cfg80211_sched_scan_request *req = request; 9255 9256 randomness_flag = wdev ? 9257 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR : 9258 NL80211_FEATURE_ND_RANDOM_MAC_ADDR; 9259 flags = &req->flags; 9260 mac_addr = req->mac_addr; 9261 mac_addr_mask = req->mac_addr_mask; 9262 } else { 9263 struct cfg80211_scan_request *req = request; 9264 9265 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; 9266 flags = &req->flags; 9267 mac_addr = req->mac_addr; 9268 mac_addr_mask = req->mac_addr_mask; 9269 } 9270 9271 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]); 9272 9273 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) && 9274 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) || 9275 !nl80211_check_scan_feat(wiphy, *flags, 9276 NL80211_SCAN_FLAG_LOW_SPAN, 9277 NL80211_EXT_FEATURE_LOW_SPAN_SCAN) || 9278 !nl80211_check_scan_feat(wiphy, *flags, 9279 NL80211_SCAN_FLAG_LOW_POWER, 9280 NL80211_EXT_FEATURE_LOW_POWER_SCAN) || 9281 !nl80211_check_scan_feat(wiphy, *flags, 9282 NL80211_SCAN_FLAG_HIGH_ACCURACY, 9283 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) || 9284 !nl80211_check_scan_feat(wiphy, *flags, 9285 NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME, 9286 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) || 9287 !nl80211_check_scan_feat(wiphy, *flags, 9288 NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP, 9289 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) || 9290 !nl80211_check_scan_feat(wiphy, *flags, 9291 NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION, 9292 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) || 9293 !nl80211_check_scan_feat(wiphy, *flags, 9294 NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE, 9295 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) || 9296 !nl80211_check_scan_feat(wiphy, *flags, 9297 NL80211_SCAN_FLAG_RANDOM_SN, 9298 NL80211_EXT_FEATURE_SCAN_RANDOM_SN) || 9299 !nl80211_check_scan_feat(wiphy, *flags, 9300 NL80211_SCAN_FLAG_MIN_PREQ_CONTENT, 9301 NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT)) 9302 return -EOPNOTSUPP; 9303 9304 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { 9305 int err; 9306 9307 if (!(wiphy->features & randomness_flag) || 9308 (wdev && wdev->connected)) 9309 return -EOPNOTSUPP; 9310 9311 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask); 9312 if (err) 9313 return err; 9314 } 9315 9316 return 0; 9317 } 9318 9319 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info) 9320 { 9321 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9322 struct wireless_dev *wdev = info->user_ptr[1]; 9323 struct cfg80211_scan_request *request; 9324 struct nlattr *scan_freqs = NULL; 9325 bool scan_freqs_khz = false; 9326 struct nlattr *attr; 9327 struct wiphy *wiphy; 9328 int err, tmp, n_ssids = 0, n_channels, i; 9329 size_t ie_len, size; 9330 size_t ssids_offset, ie_offset; 9331 9332 wiphy = &rdev->wiphy; 9333 9334 if (wdev->iftype == NL80211_IFTYPE_NAN) 9335 return -EOPNOTSUPP; 9336 9337 if (!rdev->ops->scan) 9338 return -EOPNOTSUPP; 9339 9340 if (rdev->scan_req || rdev->scan_msg) 9341 return -EBUSY; 9342 9343 if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) { 9344 if (!wiphy_ext_feature_isset(wiphy, 9345 NL80211_EXT_FEATURE_SCAN_FREQ_KHZ)) 9346 return -EOPNOTSUPP; 9347 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]; 9348 scan_freqs_khz = true; 9349 } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) 9350 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]; 9351 9352 if (scan_freqs) { 9353 n_channels = validate_scan_freqs(scan_freqs); 9354 if (!n_channels) 9355 return -EINVAL; 9356 } else { 9357 n_channels = ieee80211_get_num_supported_channels(wiphy); 9358 } 9359 9360 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) 9361 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) 9362 n_ssids++; 9363 9364 if (n_ssids > wiphy->max_scan_ssids) 9365 return -EINVAL; 9366 9367 if (info->attrs[NL80211_ATTR_IE]) 9368 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9369 else 9370 ie_len = 0; 9371 9372 if (ie_len > wiphy->max_scan_ie_len) 9373 return -EINVAL; 9374 9375 size = struct_size(request, channels, n_channels); 9376 ssids_offset = size; 9377 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9378 ie_offset = size; 9379 size = size_add(size, ie_len); 9380 request = kzalloc(size, GFP_KERNEL); 9381 if (!request) 9382 return -ENOMEM; 9383 request->n_channels = n_channels; 9384 9385 if (n_ssids) 9386 request->ssids = (void *)request + ssids_offset; 9387 request->n_ssids = n_ssids; 9388 if (ie_len) 9389 request->ie = (void *)request + ie_offset; 9390 9391 i = 0; 9392 if (scan_freqs) { 9393 /* user specified, bail out if channel not found */ 9394 nla_for_each_nested(attr, scan_freqs, tmp) { 9395 struct ieee80211_channel *chan; 9396 int freq = nla_get_u32(attr); 9397 9398 if (!scan_freqs_khz) 9399 freq = MHZ_TO_KHZ(freq); 9400 9401 chan = ieee80211_get_channel_khz(wiphy, freq); 9402 if (!chan) { 9403 err = -EINVAL; 9404 goto out_free; 9405 } 9406 9407 /* ignore disabled channels */ 9408 if (chan->flags & IEEE80211_CHAN_DISABLED || 9409 !cfg80211_wdev_channel_allowed(wdev, chan)) 9410 continue; 9411 9412 request->channels[i] = chan; 9413 i++; 9414 } 9415 } else { 9416 enum nl80211_band band; 9417 9418 /* all channels */ 9419 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9420 int j; 9421 9422 if (!wiphy->bands[band]) 9423 continue; 9424 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9425 struct ieee80211_channel *chan; 9426 9427 chan = &wiphy->bands[band]->channels[j]; 9428 9429 if (chan->flags & IEEE80211_CHAN_DISABLED || 9430 !cfg80211_wdev_channel_allowed(wdev, chan)) 9431 continue; 9432 9433 request->channels[i] = chan; 9434 i++; 9435 } 9436 } 9437 } 9438 9439 if (!i) { 9440 err = -EINVAL; 9441 goto out_free; 9442 } 9443 9444 request->n_channels = i; 9445 9446 for (i = 0; i < request->n_channels; i++) { 9447 struct ieee80211_channel *chan = request->channels[i]; 9448 9449 /* if we can go off-channel to the target channel we're good */ 9450 if (cfg80211_off_channel_oper_allowed(wdev, chan)) 9451 continue; 9452 9453 if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) { 9454 err = -EBUSY; 9455 goto out_free; 9456 } 9457 } 9458 9459 i = 0; 9460 if (n_ssids) { 9461 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) { 9462 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9463 err = -EINVAL; 9464 goto out_free; 9465 } 9466 request->ssids[i].ssid_len = nla_len(attr); 9467 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr)); 9468 i++; 9469 } 9470 } 9471 9472 if (info->attrs[NL80211_ATTR_IE]) { 9473 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9474 memcpy((void *)request->ie, 9475 nla_data(info->attrs[NL80211_ATTR_IE]), 9476 request->ie_len); 9477 } 9478 9479 for (i = 0; i < NUM_NL80211_BANDS; i++) 9480 if (wiphy->bands[i]) 9481 request->rates[i] = 9482 (1 << wiphy->bands[i]->n_bitrates) - 1; 9483 9484 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) { 9485 nla_for_each_nested(attr, 9486 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES], 9487 tmp) { 9488 enum nl80211_band band = nla_type(attr); 9489 9490 if (band < 0 || band >= NUM_NL80211_BANDS) { 9491 err = -EINVAL; 9492 goto out_free; 9493 } 9494 9495 if (!wiphy->bands[band]) 9496 continue; 9497 9498 err = ieee80211_get_ratemask(wiphy->bands[band], 9499 nla_data(attr), 9500 nla_len(attr), 9501 &request->rates[band]); 9502 if (err) 9503 goto out_free; 9504 } 9505 } 9506 9507 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) { 9508 request->duration = 9509 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]); 9510 request->duration_mandatory = 9511 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]); 9512 } 9513 9514 err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs, 9515 false); 9516 if (err) 9517 goto out_free; 9518 9519 request->no_cck = 9520 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 9521 9522 /* Initial implementation used NL80211_ATTR_MAC to set the specific 9523 * BSSID to scan for. This was problematic because that same attribute 9524 * was already used for another purpose (local random MAC address). The 9525 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards 9526 * compatibility with older userspace components, also use the 9527 * NL80211_ATTR_MAC value here if it can be determined to be used for 9528 * the specific BSSID use case instead of the random MAC address 9529 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use). 9530 */ 9531 if (info->attrs[NL80211_ATTR_BSSID]) 9532 memcpy(request->bssid, 9533 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN); 9534 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) && 9535 info->attrs[NL80211_ATTR_MAC]) 9536 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]), 9537 ETH_ALEN); 9538 else 9539 eth_broadcast_addr(request->bssid); 9540 9541 request->tsf_report_link_id = nl80211_link_id_or_invalid(info->attrs); 9542 request->wdev = wdev; 9543 request->wiphy = &rdev->wiphy; 9544 request->scan_start = jiffies; 9545 9546 rdev->scan_req = request; 9547 err = cfg80211_scan(rdev); 9548 9549 if (err) 9550 goto out_free; 9551 9552 nl80211_send_scan_start(rdev, wdev); 9553 dev_hold(wdev->netdev); 9554 9555 return 0; 9556 9557 out_free: 9558 rdev->scan_req = NULL; 9559 kfree(request); 9560 9561 return err; 9562 } 9563 9564 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info) 9565 { 9566 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9567 struct wireless_dev *wdev = info->user_ptr[1]; 9568 9569 if (!rdev->ops->abort_scan) 9570 return -EOPNOTSUPP; 9571 9572 if (rdev->scan_msg) 9573 return 0; 9574 9575 if (!rdev->scan_req) 9576 return -ENOENT; 9577 9578 rdev_abort_scan(rdev, wdev); 9579 return 0; 9580 } 9581 9582 static int 9583 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans, 9584 struct cfg80211_sched_scan_request *request, 9585 struct nlattr **attrs) 9586 { 9587 int tmp, err, i = 0; 9588 struct nlattr *attr; 9589 9590 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9591 u32 interval; 9592 9593 /* 9594 * If scan plans are not specified, 9595 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this 9596 * case one scan plan will be set with the specified scan 9597 * interval and infinite number of iterations. 9598 */ 9599 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]); 9600 if (!interval) 9601 return -EINVAL; 9602 9603 request->scan_plans[0].interval = 9604 DIV_ROUND_UP(interval, MSEC_PER_SEC); 9605 if (!request->scan_plans[0].interval) 9606 return -EINVAL; 9607 9608 if (request->scan_plans[0].interval > 9609 wiphy->max_sched_scan_plan_interval) 9610 request->scan_plans[0].interval = 9611 wiphy->max_sched_scan_plan_interval; 9612 9613 return 0; 9614 } 9615 9616 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) { 9617 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1]; 9618 9619 if (WARN_ON(i >= n_plans)) 9620 return -EINVAL; 9621 9622 err = nla_parse_nested_deprecated(plan, 9623 NL80211_SCHED_SCAN_PLAN_MAX, 9624 attr, nl80211_plan_policy, 9625 NULL); 9626 if (err) 9627 return err; 9628 9629 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]) 9630 return -EINVAL; 9631 9632 request->scan_plans[i].interval = 9633 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]); 9634 if (!request->scan_plans[i].interval || 9635 request->scan_plans[i].interval > 9636 wiphy->max_sched_scan_plan_interval) 9637 return -EINVAL; 9638 9639 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) { 9640 request->scan_plans[i].iterations = 9641 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]); 9642 if (!request->scan_plans[i].iterations || 9643 (request->scan_plans[i].iterations > 9644 wiphy->max_sched_scan_plan_iterations)) 9645 return -EINVAL; 9646 } else if (i < n_plans - 1) { 9647 /* 9648 * All scan plans but the last one must specify 9649 * a finite number of iterations 9650 */ 9651 return -EINVAL; 9652 } 9653 9654 i++; 9655 } 9656 9657 /* 9658 * The last scan plan must not specify the number of 9659 * iterations, it is supposed to run infinitely 9660 */ 9661 if (request->scan_plans[n_plans - 1].iterations) 9662 return -EINVAL; 9663 9664 return 0; 9665 } 9666 9667 static struct cfg80211_sched_scan_request * 9668 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev, 9669 struct nlattr **attrs, int max_match_sets) 9670 { 9671 struct cfg80211_sched_scan_request *request; 9672 struct nlattr *attr; 9673 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0; 9674 enum nl80211_band band; 9675 size_t ie_len, size; 9676 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1]; 9677 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF; 9678 9679 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9680 n_channels = validate_scan_freqs( 9681 attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 9682 if (!n_channels) 9683 return ERR_PTR(-EINVAL); 9684 } else { 9685 n_channels = ieee80211_get_num_supported_channels(wiphy); 9686 } 9687 9688 if (attrs[NL80211_ATTR_SCAN_SSIDS]) 9689 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9690 tmp) 9691 n_ssids++; 9692 9693 if (n_ssids > wiphy->max_sched_scan_ssids) 9694 return ERR_PTR(-EINVAL); 9695 9696 /* 9697 * First, count the number of 'real' matchsets. Due to an issue with 9698 * the old implementation, matchsets containing only the RSSI attribute 9699 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default' 9700 * RSSI for all matchsets, rather than their own matchset for reporting 9701 * all APs with a strong RSSI. This is needed to be compatible with 9702 * older userspace that treated a matchset with only the RSSI as the 9703 * global RSSI for all other matchsets - if there are other matchsets. 9704 */ 9705 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9706 nla_for_each_nested(attr, 9707 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9708 tmp) { 9709 struct nlattr *rssi; 9710 9711 err = nla_parse_nested_deprecated(tb, 9712 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9713 attr, 9714 nl80211_match_policy, 9715 NULL); 9716 if (err) 9717 return ERR_PTR(err); 9718 9719 /* SSID and BSSID are mutually exclusive */ 9720 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] && 9721 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) 9722 return ERR_PTR(-EINVAL); 9723 9724 /* add other standalone attributes here */ 9725 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] || 9726 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) { 9727 n_match_sets++; 9728 continue; 9729 } 9730 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9731 if (rssi) 9732 default_match_rssi = nla_get_s32(rssi); 9733 } 9734 } 9735 9736 /* However, if there's no other matchset, add the RSSI one */ 9737 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF) 9738 n_match_sets = 1; 9739 9740 if (n_match_sets > max_match_sets) 9741 return ERR_PTR(-EINVAL); 9742 9743 if (attrs[NL80211_ATTR_IE]) 9744 ie_len = nla_len(attrs[NL80211_ATTR_IE]); 9745 else 9746 ie_len = 0; 9747 9748 if (ie_len > wiphy->max_sched_scan_ie_len) 9749 return ERR_PTR(-EINVAL); 9750 9751 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9752 /* 9753 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since 9754 * each scan plan already specifies its own interval 9755 */ 9756 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9757 return ERR_PTR(-EINVAL); 9758 9759 nla_for_each_nested(attr, 9760 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) 9761 n_plans++; 9762 } else { 9763 /* 9764 * The scan interval attribute is kept for backward 9765 * compatibility. If no scan plans are specified and sched scan 9766 * interval is specified, one scan plan will be set with this 9767 * scan interval and infinite number of iterations. 9768 */ 9769 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9770 return ERR_PTR(-EINVAL); 9771 9772 n_plans = 1; 9773 } 9774 9775 if (!n_plans || n_plans > wiphy->max_sched_scan_plans) 9776 return ERR_PTR(-EINVAL); 9777 9778 if (!wiphy_ext_feature_isset( 9779 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) && 9780 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] || 9781 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST])) 9782 return ERR_PTR(-EINVAL); 9783 9784 size = struct_size(request, channels, n_channels); 9785 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9786 size = size_add(size, array_size(sizeof(*request->match_sets), 9787 n_match_sets)); 9788 size = size_add(size, array_size(sizeof(*request->scan_plans), 9789 n_plans)); 9790 size = size_add(size, ie_len); 9791 request = kzalloc(size, GFP_KERNEL); 9792 if (!request) 9793 return ERR_PTR(-ENOMEM); 9794 request->n_channels = n_channels; 9795 9796 if (n_ssids) 9797 request->ssids = (void *)request + 9798 struct_size(request, channels, n_channels); 9799 request->n_ssids = n_ssids; 9800 if (ie_len) { 9801 if (n_ssids) 9802 request->ie = (void *)(request->ssids + n_ssids); 9803 else 9804 request->ie = (void *)(request->channels + n_channels); 9805 } 9806 9807 if (n_match_sets) { 9808 if (request->ie) 9809 request->match_sets = (void *)(request->ie + ie_len); 9810 else if (n_ssids) 9811 request->match_sets = 9812 (void *)(request->ssids + n_ssids); 9813 else 9814 request->match_sets = 9815 (void *)(request->channels + n_channels); 9816 } 9817 request->n_match_sets = n_match_sets; 9818 9819 if (n_match_sets) 9820 request->scan_plans = (void *)(request->match_sets + 9821 n_match_sets); 9822 else if (request->ie) 9823 request->scan_plans = (void *)(request->ie + ie_len); 9824 else if (n_ssids) 9825 request->scan_plans = (void *)(request->ssids + n_ssids); 9826 else 9827 request->scan_plans = (void *)(request->channels + n_channels); 9828 9829 request->n_scan_plans = n_plans; 9830 9831 i = 0; 9832 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9833 /* user specified, bail out if channel not found */ 9834 nla_for_each_nested(attr, 9835 attrs[NL80211_ATTR_SCAN_FREQUENCIES], 9836 tmp) { 9837 struct ieee80211_channel *chan; 9838 9839 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 9840 9841 if (!chan) { 9842 err = -EINVAL; 9843 goto out_free; 9844 } 9845 9846 /* ignore disabled channels */ 9847 if (chan->flags & IEEE80211_CHAN_DISABLED) 9848 continue; 9849 9850 request->channels[i] = chan; 9851 i++; 9852 } 9853 } else { 9854 /* all channels */ 9855 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9856 int j; 9857 9858 if (!wiphy->bands[band]) 9859 continue; 9860 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9861 struct ieee80211_channel *chan; 9862 9863 chan = &wiphy->bands[band]->channels[j]; 9864 9865 if (chan->flags & IEEE80211_CHAN_DISABLED) 9866 continue; 9867 9868 request->channels[i] = chan; 9869 i++; 9870 } 9871 } 9872 } 9873 9874 if (!i) { 9875 err = -EINVAL; 9876 goto out_free; 9877 } 9878 9879 request->n_channels = i; 9880 9881 i = 0; 9882 if (n_ssids) { 9883 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9884 tmp) { 9885 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9886 err = -EINVAL; 9887 goto out_free; 9888 } 9889 request->ssids[i].ssid_len = nla_len(attr); 9890 memcpy(request->ssids[i].ssid, nla_data(attr), 9891 nla_len(attr)); 9892 i++; 9893 } 9894 } 9895 9896 i = 0; 9897 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9898 nla_for_each_nested(attr, 9899 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9900 tmp) { 9901 struct nlattr *ssid, *bssid, *rssi; 9902 9903 err = nla_parse_nested_deprecated(tb, 9904 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9905 attr, 9906 nl80211_match_policy, 9907 NULL); 9908 if (err) 9909 goto out_free; 9910 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]; 9911 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]; 9912 9913 if (!ssid && !bssid) { 9914 i++; 9915 continue; 9916 } 9917 9918 if (WARN_ON(i >= n_match_sets)) { 9919 /* this indicates a programming error, 9920 * the loop above should have verified 9921 * things properly 9922 */ 9923 err = -EINVAL; 9924 goto out_free; 9925 } 9926 9927 if (ssid) { 9928 memcpy(request->match_sets[i].ssid.ssid, 9929 nla_data(ssid), nla_len(ssid)); 9930 request->match_sets[i].ssid.ssid_len = 9931 nla_len(ssid); 9932 } 9933 if (bssid) 9934 memcpy(request->match_sets[i].bssid, 9935 nla_data(bssid), ETH_ALEN); 9936 9937 /* special attribute - old implementation w/a */ 9938 request->match_sets[i].rssi_thold = default_match_rssi; 9939 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9940 if (rssi) 9941 request->match_sets[i].rssi_thold = 9942 nla_get_s32(rssi); 9943 i++; 9944 } 9945 9946 /* there was no other matchset, so the RSSI one is alone */ 9947 if (i == 0 && n_match_sets) 9948 request->match_sets[0].rssi_thold = default_match_rssi; 9949 9950 request->min_rssi_thold = INT_MAX; 9951 for (i = 0; i < n_match_sets; i++) 9952 request->min_rssi_thold = 9953 min(request->match_sets[i].rssi_thold, 9954 request->min_rssi_thold); 9955 } else { 9956 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF; 9957 } 9958 9959 if (ie_len) { 9960 request->ie_len = ie_len; 9961 memcpy((void *)request->ie, 9962 nla_data(attrs[NL80211_ATTR_IE]), 9963 request->ie_len); 9964 } 9965 9966 err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true); 9967 if (err) 9968 goto out_free; 9969 9970 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY]) 9971 request->delay = 9972 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]); 9973 9974 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) { 9975 request->relative_rssi = nla_get_s8( 9976 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]); 9977 request->relative_rssi_set = true; 9978 } 9979 9980 if (request->relative_rssi_set && 9981 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) { 9982 struct nl80211_bss_select_rssi_adjust *rssi_adjust; 9983 9984 rssi_adjust = nla_data( 9985 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]); 9986 request->rssi_adjust.band = rssi_adjust->band; 9987 request->rssi_adjust.delta = rssi_adjust->delta; 9988 if (!is_band_valid(wiphy, request->rssi_adjust.band)) { 9989 err = -EINVAL; 9990 goto out_free; 9991 } 9992 } 9993 9994 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs); 9995 if (err) 9996 goto out_free; 9997 9998 request->scan_start = jiffies; 9999 10000 return request; 10001 10002 out_free: 10003 kfree(request); 10004 return ERR_PTR(err); 10005 } 10006 10007 static int nl80211_start_sched_scan(struct sk_buff *skb, 10008 struct genl_info *info) 10009 { 10010 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10011 struct net_device *dev = info->user_ptr[1]; 10012 struct wireless_dev *wdev = dev->ieee80211_ptr; 10013 struct cfg80211_sched_scan_request *sched_scan_req; 10014 bool want_multi; 10015 int err; 10016 10017 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start) 10018 return -EOPNOTSUPP; 10019 10020 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI]; 10021 err = cfg80211_sched_scan_req_possible(rdev, want_multi); 10022 if (err) 10023 return err; 10024 10025 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev, 10026 info->attrs, 10027 rdev->wiphy.max_match_sets); 10028 10029 err = PTR_ERR_OR_ZERO(sched_scan_req); 10030 if (err) 10031 goto out_err; 10032 10033 /* leave request id zero for legacy request 10034 * or if driver does not support multi-scheduled scan 10035 */ 10036 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) 10037 sched_scan_req->reqid = cfg80211_assign_cookie(rdev); 10038 10039 err = rdev_sched_scan_start(rdev, dev, sched_scan_req); 10040 if (err) 10041 goto out_free; 10042 10043 sched_scan_req->dev = dev; 10044 sched_scan_req->wiphy = &rdev->wiphy; 10045 10046 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 10047 sched_scan_req->owner_nlportid = info->snd_portid; 10048 10049 cfg80211_add_sched_scan_req(rdev, sched_scan_req); 10050 10051 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN); 10052 return 0; 10053 10054 out_free: 10055 kfree(sched_scan_req); 10056 out_err: 10057 return err; 10058 } 10059 10060 static int nl80211_stop_sched_scan(struct sk_buff *skb, 10061 struct genl_info *info) 10062 { 10063 struct cfg80211_sched_scan_request *req; 10064 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10065 u64 cookie; 10066 10067 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop) 10068 return -EOPNOTSUPP; 10069 10070 if (info->attrs[NL80211_ATTR_COOKIE]) { 10071 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 10072 return __cfg80211_stop_sched_scan(rdev, cookie, false); 10073 } 10074 10075 req = list_first_or_null_rcu(&rdev->sched_scan_req_list, 10076 struct cfg80211_sched_scan_request, 10077 list); 10078 if (!req || req->reqid || 10079 (req->owner_nlportid && 10080 req->owner_nlportid != info->snd_portid)) 10081 return -ENOENT; 10082 10083 return cfg80211_stop_sched_scan_req(rdev, req, false); 10084 } 10085 10086 static int nl80211_start_radar_detection(struct sk_buff *skb, 10087 struct genl_info *info) 10088 { 10089 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10090 struct net_device *dev = info->user_ptr[1]; 10091 struct wireless_dev *wdev = dev->ieee80211_ptr; 10092 int link_id = nl80211_link_id(info->attrs); 10093 struct wiphy *wiphy = wdev->wiphy; 10094 struct cfg80211_chan_def chandef; 10095 enum nl80211_dfs_regions dfs_region; 10096 unsigned int cac_time_ms; 10097 int err; 10098 10099 flush_delayed_work(&rdev->dfs_update_channels_wk); 10100 10101 switch (wdev->iftype) { 10102 case NL80211_IFTYPE_AP: 10103 case NL80211_IFTYPE_P2P_GO: 10104 case NL80211_IFTYPE_MESH_POINT: 10105 case NL80211_IFTYPE_ADHOC: 10106 break; 10107 default: 10108 /* caution - see cfg80211_beaconing_iface_active() below */ 10109 return -EINVAL; 10110 } 10111 10112 guard(wiphy)(wiphy); 10113 10114 dfs_region = reg_get_dfs_region(wiphy); 10115 if (dfs_region == NL80211_DFS_UNSET) 10116 return -EINVAL; 10117 10118 err = nl80211_parse_chandef(rdev, info, &chandef); 10119 if (err) 10120 return err; 10121 10122 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 10123 if (err < 0) 10124 return err; 10125 10126 if (err == 0) 10127 return -EINVAL; 10128 10129 if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) 10130 return -EINVAL; 10131 10132 if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) 10133 return cfg80211_start_background_radar_detection(rdev, wdev, 10134 &chandef); 10135 10136 if (cfg80211_beaconing_iface_active(wdev)) { 10137 /* During MLO other link(s) can beacon, only the current link 10138 * can not already beacon 10139 */ 10140 if (wdev->valid_links && 10141 !wdev->links[link_id].ap.beacon_interval) { 10142 /* nothing */ 10143 } else { 10144 return -EBUSY; 10145 } 10146 } 10147 10148 if (wdev->links[link_id].cac_started) 10149 return -EBUSY; 10150 10151 /* CAC start is offloaded to HW and can't be started manually */ 10152 if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) 10153 return -EOPNOTSUPP; 10154 10155 if (!rdev->ops->start_radar_detection) 10156 return -EOPNOTSUPP; 10157 10158 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef); 10159 if (WARN_ON(!cac_time_ms)) 10160 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS; 10161 10162 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms, 10163 link_id); 10164 if (err) 10165 return err; 10166 10167 switch (wdev->iftype) { 10168 case NL80211_IFTYPE_AP: 10169 case NL80211_IFTYPE_P2P_GO: 10170 wdev->links[0].ap.chandef = chandef; 10171 break; 10172 case NL80211_IFTYPE_ADHOC: 10173 wdev->u.ibss.chandef = chandef; 10174 break; 10175 case NL80211_IFTYPE_MESH_POINT: 10176 wdev->u.mesh.chandef = chandef; 10177 break; 10178 default: 10179 break; 10180 } 10181 wdev->links[link_id].cac_started = true; 10182 wdev->links[link_id].cac_start_time = jiffies; 10183 wdev->links[link_id].cac_time_ms = cac_time_ms; 10184 10185 return 0; 10186 } 10187 10188 static int nl80211_notify_radar_detection(struct sk_buff *skb, 10189 struct genl_info *info) 10190 { 10191 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10192 struct net_device *dev = info->user_ptr[1]; 10193 struct wireless_dev *wdev = dev->ieee80211_ptr; 10194 struct wiphy *wiphy = wdev->wiphy; 10195 struct cfg80211_chan_def chandef; 10196 enum nl80211_dfs_regions dfs_region; 10197 int err; 10198 10199 dfs_region = reg_get_dfs_region(wiphy); 10200 if (dfs_region == NL80211_DFS_UNSET) { 10201 GENL_SET_ERR_MSG(info, 10202 "DFS Region is not set. Unexpected Radar indication"); 10203 return -EINVAL; 10204 } 10205 10206 err = nl80211_parse_chandef(rdev, info, &chandef); 10207 if (err) { 10208 GENL_SET_ERR_MSG(info, "Unable to extract chandef info"); 10209 return err; 10210 } 10211 10212 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 10213 if (err < 0) { 10214 GENL_SET_ERR_MSG(info, "chandef is invalid"); 10215 return err; 10216 } 10217 10218 if (err == 0) { 10219 GENL_SET_ERR_MSG(info, 10220 "Unexpected Radar indication for chandef/iftype"); 10221 return -EINVAL; 10222 } 10223 10224 /* Do not process this notification if radar is already detected 10225 * by kernel on this channel, and return success. 10226 */ 10227 if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE) 10228 return 0; 10229 10230 cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE); 10231 10232 cfg80211_sched_dfs_chan_update(rdev); 10233 10234 rdev->radar_chandef = chandef; 10235 10236 /* Propagate this notification to other radios as well */ 10237 queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk); 10238 10239 return 0; 10240 } 10241 10242 static int nl80211_parse_counter_offsets(struct cfg80211_registered_device *rdev, 10243 const u8 *data, size_t datalen, 10244 int first_count, struct nlattr *attr, 10245 const u16 **offsets, unsigned int *n_offsets) 10246 { 10247 int i; 10248 10249 *n_offsets = 0; 10250 10251 if (!attr) 10252 return 0; 10253 10254 if (!nla_len(attr) || (nla_len(attr) % sizeof(u16))) 10255 return -EINVAL; 10256 10257 *n_offsets = nla_len(attr) / sizeof(u16); 10258 if (rdev->wiphy.max_num_csa_counters && 10259 (*n_offsets > rdev->wiphy.max_num_csa_counters)) 10260 return -EINVAL; 10261 10262 *offsets = nla_data(attr); 10263 10264 /* sanity checks - counters should fit and be the same */ 10265 for (i = 0; i < *n_offsets; i++) { 10266 u16 offset = (*offsets)[i]; 10267 10268 if (offset >= datalen) 10269 return -EINVAL; 10270 10271 if (first_count != -1 && data[offset] != first_count) 10272 return -EINVAL; 10273 } 10274 10275 return 0; 10276 } 10277 10278 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info) 10279 { 10280 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10281 unsigned int link_id = nl80211_link_id(info->attrs); 10282 struct net_device *dev = info->user_ptr[1]; 10283 struct wireless_dev *wdev = dev->ieee80211_ptr; 10284 struct cfg80211_csa_settings params; 10285 struct nlattr **csa_attrs = NULL; 10286 int err; 10287 bool need_new_beacon = false; 10288 bool need_handle_dfs_flag = true; 10289 u32 cs_count; 10290 10291 if (!rdev->ops->channel_switch || 10292 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 10293 return -EOPNOTSUPP; 10294 10295 switch (dev->ieee80211_ptr->iftype) { 10296 case NL80211_IFTYPE_AP: 10297 case NL80211_IFTYPE_P2P_GO: 10298 need_new_beacon = true; 10299 /* For all modes except AP the handle_dfs flag needs to be 10300 * supplied to tell the kernel that userspace will handle radar 10301 * events when they happen. Otherwise a switch to a channel 10302 * requiring DFS will be rejected. 10303 */ 10304 need_handle_dfs_flag = false; 10305 10306 /* useless if AP is not running */ 10307 if (!wdev->links[link_id].ap.beacon_interval) 10308 return -ENOTCONN; 10309 break; 10310 case NL80211_IFTYPE_ADHOC: 10311 if (!wdev->u.ibss.ssid_len) 10312 return -ENOTCONN; 10313 break; 10314 case NL80211_IFTYPE_MESH_POINT: 10315 if (!wdev->u.mesh.id_len) 10316 return -ENOTCONN; 10317 break; 10318 default: 10319 return -EOPNOTSUPP; 10320 } 10321 10322 memset(¶ms, 0, sizeof(params)); 10323 params.beacon_csa.ftm_responder = -1; 10324 10325 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 10326 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]) 10327 return -EINVAL; 10328 10329 /* only important for AP, IBSS and mesh create IEs internally */ 10330 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES]) 10331 return -EINVAL; 10332 10333 /* Even though the attribute is u32, the specification says 10334 * u8, so let's make sure we don't overflow. 10335 */ 10336 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]); 10337 if (cs_count > 255) 10338 return -EINVAL; 10339 10340 params.count = cs_count; 10341 10342 if (!need_new_beacon) 10343 goto skip_beacons; 10344 10345 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_after, 10346 info->extack); 10347 if (err) 10348 goto free; 10349 10350 csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs), 10351 GFP_KERNEL); 10352 if (!csa_attrs) { 10353 err = -ENOMEM; 10354 goto free; 10355 } 10356 10357 err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX, 10358 info->attrs[NL80211_ATTR_CSA_IES], 10359 nl80211_policy, info->extack); 10360 if (err) 10361 goto free; 10362 10363 err = nl80211_parse_beacon(rdev, csa_attrs, ¶ms.beacon_csa, 10364 info->extack); 10365 if (err) 10366 goto free; 10367 10368 if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 10369 err = -EINVAL; 10370 goto free; 10371 } 10372 10373 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.tail, 10374 params.beacon_csa.tail_len, 10375 params.count, 10376 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON], 10377 ¶ms.counter_offsets_beacon, 10378 ¶ms.n_counter_offsets_beacon); 10379 if (err) 10380 goto free; 10381 10382 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.probe_resp, 10383 params.beacon_csa.probe_resp_len, 10384 params.count, 10385 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP], 10386 ¶ms.counter_offsets_presp, 10387 ¶ms.n_counter_offsets_presp); 10388 if (err) 10389 goto free; 10390 10391 skip_beacons: 10392 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 10393 if (err) 10394 goto free; 10395 10396 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 10397 wdev->iftype)) { 10398 err = -EINVAL; 10399 goto free; 10400 } 10401 10402 err = cfg80211_chandef_dfs_required(wdev->wiphy, 10403 ¶ms.chandef, 10404 wdev->iftype); 10405 if (err < 0) 10406 goto free; 10407 10408 if (err > 0) { 10409 params.radar_required = true; 10410 if (need_handle_dfs_flag && 10411 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) { 10412 err = -EINVAL; 10413 goto free; 10414 } 10415 } 10416 10417 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX]) 10418 params.block_tx = true; 10419 10420 params.link_id = link_id; 10421 err = rdev_channel_switch(rdev, dev, ¶ms); 10422 10423 free: 10424 kfree(params.beacon_after.mbssid_ies); 10425 kfree(params.beacon_csa.mbssid_ies); 10426 kfree(params.beacon_after.rnr_ies); 10427 kfree(params.beacon_csa.rnr_ies); 10428 kfree(csa_attrs); 10429 return err; 10430 } 10431 10432 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb, 10433 u32 seq, int flags, 10434 struct cfg80211_registered_device *rdev, 10435 struct wireless_dev *wdev, 10436 struct cfg80211_internal_bss *intbss) 10437 { 10438 struct cfg80211_bss *res = &intbss->pub; 10439 const struct cfg80211_bss_ies *ies; 10440 unsigned int link_id; 10441 void *hdr; 10442 struct nlattr *bss; 10443 10444 lockdep_assert_wiphy(wdev->wiphy); 10445 10446 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 10447 NL80211_CMD_NEW_SCAN_RESULTS); 10448 if (!hdr) 10449 return -1; 10450 10451 genl_dump_check_consistent(cb, hdr); 10452 10453 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation)) 10454 goto nla_put_failure; 10455 if (wdev->netdev && 10456 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex)) 10457 goto nla_put_failure; 10458 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 10459 NL80211_ATTR_PAD)) 10460 goto nla_put_failure; 10461 10462 bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS); 10463 if (!bss) 10464 goto nla_put_failure; 10465 if ((!is_zero_ether_addr(res->bssid) && 10466 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid))) 10467 goto nla_put_failure; 10468 10469 rcu_read_lock(); 10470 /* indicate whether we have probe response data or not */ 10471 if (rcu_access_pointer(res->proberesp_ies) && 10472 nla_put_flag(msg, NL80211_BSS_PRESP_DATA)) 10473 goto fail_unlock_rcu; 10474 10475 /* this pointer prefers to be pointed to probe response data 10476 * but is always valid 10477 */ 10478 ies = rcu_dereference(res->ies); 10479 if (ies) { 10480 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf, 10481 NL80211_BSS_PAD)) 10482 goto fail_unlock_rcu; 10483 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS, 10484 ies->len, ies->data)) 10485 goto fail_unlock_rcu; 10486 } 10487 10488 /* and this pointer is always (unless driver didn't know) beacon data */ 10489 ies = rcu_dereference(res->beacon_ies); 10490 if (ies && ies->from_beacon) { 10491 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf, 10492 NL80211_BSS_PAD)) 10493 goto fail_unlock_rcu; 10494 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES, 10495 ies->len, ies->data)) 10496 goto fail_unlock_rcu; 10497 } 10498 rcu_read_unlock(); 10499 10500 if (res->beacon_interval && 10501 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval)) 10502 goto nla_put_failure; 10503 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) || 10504 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) || 10505 nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET, 10506 res->channel->freq_offset) || 10507 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO, 10508 jiffies_to_msecs(jiffies - intbss->ts))) 10509 goto nla_put_failure; 10510 10511 if (intbss->parent_tsf && 10512 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF, 10513 intbss->parent_tsf, NL80211_BSS_PAD) || 10514 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN, 10515 intbss->parent_bssid))) 10516 goto nla_put_failure; 10517 10518 if (intbss->ts_boottime && 10519 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME, 10520 intbss->ts_boottime, NL80211_BSS_PAD)) 10521 goto nla_put_failure; 10522 10523 if (!nl80211_put_signal(msg, intbss->pub.chains, 10524 intbss->pub.chain_signal, 10525 NL80211_BSS_CHAIN_SIGNAL)) 10526 goto nla_put_failure; 10527 10528 if (intbss->bss_source != BSS_SOURCE_STA_PROFILE) { 10529 switch (rdev->wiphy.signal_type) { 10530 case CFG80211_SIGNAL_TYPE_MBM: 10531 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, 10532 res->signal)) 10533 goto nla_put_failure; 10534 break; 10535 case CFG80211_SIGNAL_TYPE_UNSPEC: 10536 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, 10537 res->signal)) 10538 goto nla_put_failure; 10539 break; 10540 default: 10541 break; 10542 } 10543 } 10544 10545 switch (wdev->iftype) { 10546 case NL80211_IFTYPE_P2P_CLIENT: 10547 case NL80211_IFTYPE_STATION: 10548 for_each_valid_link(wdev, link_id) { 10549 if (intbss == wdev->links[link_id].client.current_bss && 10550 (nla_put_u32(msg, NL80211_BSS_STATUS, 10551 NL80211_BSS_STATUS_ASSOCIATED) || 10552 (wdev->valid_links && 10553 (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID, 10554 link_id) || 10555 nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN, 10556 wdev->u.client.connected_addr))))) 10557 goto nla_put_failure; 10558 } 10559 break; 10560 case NL80211_IFTYPE_ADHOC: 10561 if (intbss == wdev->u.ibss.current_bss && 10562 nla_put_u32(msg, NL80211_BSS_STATUS, 10563 NL80211_BSS_STATUS_IBSS_JOINED)) 10564 goto nla_put_failure; 10565 break; 10566 default: 10567 break; 10568 } 10569 10570 if (nla_put_u32(msg, NL80211_BSS_USE_FOR, res->use_for)) 10571 goto nla_put_failure; 10572 10573 if (res->cannot_use_reasons && 10574 nla_put_u64_64bit(msg, NL80211_BSS_CANNOT_USE_REASONS, 10575 res->cannot_use_reasons, 10576 NL80211_BSS_PAD)) 10577 goto nla_put_failure; 10578 10579 nla_nest_end(msg, bss); 10580 10581 genlmsg_end(msg, hdr); 10582 return 0; 10583 10584 fail_unlock_rcu: 10585 rcu_read_unlock(); 10586 nla_put_failure: 10587 genlmsg_cancel(msg, hdr); 10588 return -EMSGSIZE; 10589 } 10590 10591 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb) 10592 { 10593 struct cfg80211_registered_device *rdev; 10594 struct cfg80211_internal_bss *scan; 10595 struct wireless_dev *wdev; 10596 struct nlattr **attrbuf; 10597 int start = cb->args[2], idx = 0; 10598 bool dump_include_use_data; 10599 int err; 10600 10601 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 10602 if (!attrbuf) 10603 return -ENOMEM; 10604 10605 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 10606 if (err) { 10607 kfree(attrbuf); 10608 return err; 10609 } 10610 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10611 __acquire(&rdev->wiphy.mtx); 10612 10613 dump_include_use_data = 10614 attrbuf[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA]; 10615 kfree(attrbuf); 10616 10617 spin_lock_bh(&rdev->bss_lock); 10618 10619 /* 10620 * dump_scan will be called multiple times to break up the scan results 10621 * into multiple messages. It is unlikely that any more bss-es will be 10622 * expired after the first call, so only call only call this on the 10623 * first dump_scan invocation. 10624 */ 10625 if (start == 0) 10626 cfg80211_bss_expire(rdev); 10627 10628 cb->seq = rdev->bss_generation; 10629 10630 list_for_each_entry(scan, &rdev->bss_list, list) { 10631 if (++idx <= start) 10632 continue; 10633 if (!dump_include_use_data && 10634 !(scan->pub.use_for & NL80211_BSS_USE_FOR_NORMAL)) 10635 continue; 10636 if (nl80211_send_bss(skb, cb, 10637 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10638 rdev, wdev, scan) < 0) { 10639 idx--; 10640 break; 10641 } 10642 } 10643 10644 spin_unlock_bh(&rdev->bss_lock); 10645 10646 cb->args[2] = idx; 10647 wiphy_unlock(&rdev->wiphy); 10648 10649 return skb->len; 10650 } 10651 10652 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq, 10653 int flags, struct net_device *dev, 10654 bool allow_radio_stats, 10655 struct survey_info *survey) 10656 { 10657 void *hdr; 10658 struct nlattr *infoattr; 10659 10660 /* skip radio stats if userspace didn't request them */ 10661 if (!survey->channel && !allow_radio_stats) 10662 return 0; 10663 10664 hdr = nl80211hdr_put(msg, portid, seq, flags, 10665 NL80211_CMD_NEW_SURVEY_RESULTS); 10666 if (!hdr) 10667 return -ENOMEM; 10668 10669 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 10670 goto nla_put_failure; 10671 10672 infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO); 10673 if (!infoattr) 10674 goto nla_put_failure; 10675 10676 if (survey->channel && 10677 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY, 10678 survey->channel->center_freq)) 10679 goto nla_put_failure; 10680 10681 if (survey->channel && survey->channel->freq_offset && 10682 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET, 10683 survey->channel->freq_offset)) 10684 goto nla_put_failure; 10685 10686 if ((survey->filled & SURVEY_INFO_NOISE_DBM) && 10687 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise)) 10688 goto nla_put_failure; 10689 if ((survey->filled & SURVEY_INFO_IN_USE) && 10690 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE)) 10691 goto nla_put_failure; 10692 if ((survey->filled & SURVEY_INFO_TIME) && 10693 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME, 10694 survey->time, NL80211_SURVEY_INFO_PAD)) 10695 goto nla_put_failure; 10696 if ((survey->filled & SURVEY_INFO_TIME_BUSY) && 10697 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY, 10698 survey->time_busy, NL80211_SURVEY_INFO_PAD)) 10699 goto nla_put_failure; 10700 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) && 10701 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY, 10702 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD)) 10703 goto nla_put_failure; 10704 if ((survey->filled & SURVEY_INFO_TIME_RX) && 10705 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX, 10706 survey->time_rx, NL80211_SURVEY_INFO_PAD)) 10707 goto nla_put_failure; 10708 if ((survey->filled & SURVEY_INFO_TIME_TX) && 10709 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX, 10710 survey->time_tx, NL80211_SURVEY_INFO_PAD)) 10711 goto nla_put_failure; 10712 if ((survey->filled & SURVEY_INFO_TIME_SCAN) && 10713 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN, 10714 survey->time_scan, NL80211_SURVEY_INFO_PAD)) 10715 goto nla_put_failure; 10716 if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) && 10717 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX, 10718 survey->time_bss_rx, NL80211_SURVEY_INFO_PAD)) 10719 goto nla_put_failure; 10720 10721 nla_nest_end(msg, infoattr); 10722 10723 genlmsg_end(msg, hdr); 10724 return 0; 10725 10726 nla_put_failure: 10727 genlmsg_cancel(msg, hdr); 10728 return -EMSGSIZE; 10729 } 10730 10731 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb) 10732 { 10733 struct nlattr **attrbuf; 10734 struct survey_info survey; 10735 struct cfg80211_registered_device *rdev; 10736 struct wireless_dev *wdev; 10737 int survey_idx = cb->args[2]; 10738 int res; 10739 bool radio_stats; 10740 10741 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 10742 if (!attrbuf) 10743 return -ENOMEM; 10744 10745 res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 10746 if (res) { 10747 kfree(attrbuf); 10748 return res; 10749 } 10750 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10751 __acquire(&rdev->wiphy.mtx); 10752 10753 /* prepare_wdev_dump parsed the attributes */ 10754 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS]; 10755 10756 if (!wdev->netdev) { 10757 res = -EINVAL; 10758 goto out_err; 10759 } 10760 10761 if (!rdev->ops->dump_survey) { 10762 res = -EOPNOTSUPP; 10763 goto out_err; 10764 } 10765 10766 while (1) { 10767 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey); 10768 if (res == -ENOENT) 10769 break; 10770 if (res) 10771 goto out_err; 10772 10773 /* don't send disabled channels, but do send non-channel data */ 10774 if (survey.channel && 10775 survey.channel->flags & IEEE80211_CHAN_DISABLED) { 10776 survey_idx++; 10777 continue; 10778 } 10779 10780 if (nl80211_send_survey(skb, 10781 NETLINK_CB(cb->skb).portid, 10782 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10783 wdev->netdev, radio_stats, &survey) < 0) 10784 goto out; 10785 survey_idx++; 10786 } 10787 10788 out: 10789 cb->args[2] = survey_idx; 10790 res = skb->len; 10791 out_err: 10792 kfree(attrbuf); 10793 wiphy_unlock(&rdev->wiphy); 10794 return res; 10795 } 10796 10797 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info) 10798 { 10799 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10800 struct net_device *dev = info->user_ptr[1]; 10801 struct ieee80211_channel *chan; 10802 const u8 *bssid, *ssid; 10803 int err, ssid_len; 10804 enum nl80211_auth_type auth_type; 10805 struct key_parse key; 10806 bool local_state_change; 10807 struct cfg80211_auth_request req = {}; 10808 u32 freq; 10809 10810 if (!info->attrs[NL80211_ATTR_MAC]) 10811 return -EINVAL; 10812 10813 if (!info->attrs[NL80211_ATTR_AUTH_TYPE]) 10814 return -EINVAL; 10815 10816 if (!info->attrs[NL80211_ATTR_SSID]) 10817 return -EINVAL; 10818 10819 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 10820 return -EINVAL; 10821 10822 err = nl80211_parse_key(info, &key); 10823 if (err) 10824 return err; 10825 10826 if (key.idx >= 0) { 10827 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP) 10828 return -EINVAL; 10829 if (!key.p.key || !key.p.key_len) 10830 return -EINVAL; 10831 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 || 10832 key.p.key_len != WLAN_KEY_LEN_WEP40) && 10833 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 || 10834 key.p.key_len != WLAN_KEY_LEN_WEP104)) 10835 return -EINVAL; 10836 if (key.idx > 3) 10837 return -EINVAL; 10838 } else { 10839 key.p.key_len = 0; 10840 key.p.key = NULL; 10841 } 10842 10843 if (key.idx >= 0) { 10844 int i; 10845 bool ok = false; 10846 10847 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) { 10848 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) { 10849 ok = true; 10850 break; 10851 } 10852 } 10853 if (!ok) 10854 return -EINVAL; 10855 } 10856 10857 if (!rdev->ops->auth) 10858 return -EOPNOTSUPP; 10859 10860 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10861 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10862 return -EOPNOTSUPP; 10863 10864 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 10865 freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 10866 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 10867 freq += 10868 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 10869 10870 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 10871 if (!chan) 10872 return -EINVAL; 10873 10874 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10875 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10876 10877 if (info->attrs[NL80211_ATTR_IE]) { 10878 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10879 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10880 } 10881 10882 if (info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]) { 10883 req.supported_selectors = 10884 nla_data(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 10885 req.supported_selectors_len = 10886 nla_len(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 10887 } 10888 10889 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 10890 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE)) 10891 return -EINVAL; 10892 10893 if ((auth_type == NL80211_AUTHTYPE_SAE || 10894 auth_type == NL80211_AUTHTYPE_FILS_SK || 10895 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 10896 auth_type == NL80211_AUTHTYPE_FILS_PK) && 10897 !info->attrs[NL80211_ATTR_AUTH_DATA]) 10898 return -EINVAL; 10899 10900 if (info->attrs[NL80211_ATTR_AUTH_DATA]) { 10901 if (auth_type != NL80211_AUTHTYPE_SAE && 10902 auth_type != NL80211_AUTHTYPE_FILS_SK && 10903 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS && 10904 auth_type != NL80211_AUTHTYPE_FILS_PK) 10905 return -EINVAL; 10906 req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]); 10907 req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]); 10908 } 10909 10910 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 10911 10912 /* 10913 * Since we no longer track auth state, ignore 10914 * requests to only change local state. 10915 */ 10916 if (local_state_change) 10917 return 0; 10918 10919 req.auth_type = auth_type; 10920 req.key = key.p.key; 10921 req.key_len = key.p.key_len; 10922 req.key_idx = key.idx; 10923 req.link_id = nl80211_link_id_or_invalid(info->attrs); 10924 if (req.link_id >= 0) { 10925 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 10926 return -EINVAL; 10927 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 10928 return -EINVAL; 10929 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 10930 if (!is_valid_ether_addr(req.ap_mld_addr)) 10931 return -EINVAL; 10932 } 10933 10934 req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, 10935 IEEE80211_BSS_TYPE_ESS, 10936 IEEE80211_PRIVACY_ANY); 10937 if (!req.bss) 10938 return -ENOENT; 10939 10940 err = cfg80211_mlme_auth(rdev, dev, &req); 10941 10942 cfg80211_put_bss(&rdev->wiphy, req.bss); 10943 10944 return err; 10945 } 10946 10947 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev, 10948 struct genl_info *info) 10949 { 10950 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 10951 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set"); 10952 return -EINVAL; 10953 } 10954 10955 if (!rdev->ops->tx_control_port || 10956 !wiphy_ext_feature_isset(&rdev->wiphy, 10957 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 10958 return -EOPNOTSUPP; 10959 10960 return 0; 10961 } 10962 10963 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 10964 struct genl_info *info, 10965 struct cfg80211_crypto_settings *settings, 10966 int cipher_limit) 10967 { 10968 memset(settings, 0, sizeof(*settings)); 10969 10970 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT]; 10971 10972 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 10973 u16 proto; 10974 10975 proto = nla_get_u16( 10976 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 10977 settings->control_port_ethertype = cpu_to_be16(proto); 10978 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 10979 proto != ETH_P_PAE) 10980 return -EINVAL; 10981 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]) 10982 settings->control_port_no_encrypt = true; 10983 } else 10984 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE); 10985 10986 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 10987 int r = validate_pae_over_nl80211(rdev, info); 10988 10989 if (r < 0) 10990 return r; 10991 10992 settings->control_port_over_nl80211 = true; 10993 10994 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH]) 10995 settings->control_port_no_preauth = true; 10996 } 10997 10998 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) { 10999 void *data; 11000 int len, i; 11001 11002 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 11003 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 11004 settings->n_ciphers_pairwise = len / sizeof(u32); 11005 11006 if (len % sizeof(u32)) 11007 return -EINVAL; 11008 11009 if (settings->n_ciphers_pairwise > cipher_limit) 11010 return -EINVAL; 11011 11012 memcpy(settings->ciphers_pairwise, data, len); 11013 11014 for (i = 0; i < settings->n_ciphers_pairwise; i++) 11015 if (!cfg80211_supported_cipher_suite( 11016 &rdev->wiphy, 11017 settings->ciphers_pairwise[i])) 11018 return -EINVAL; 11019 } 11020 11021 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) { 11022 settings->cipher_group = 11023 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]); 11024 if (!cfg80211_supported_cipher_suite(&rdev->wiphy, 11025 settings->cipher_group)) 11026 return -EINVAL; 11027 } 11028 11029 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) 11030 settings->wpa_versions = 11031 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]); 11032 11033 if (info->attrs[NL80211_ATTR_AKM_SUITES]) { 11034 void *data; 11035 int len; 11036 11037 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]); 11038 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]); 11039 settings->n_akm_suites = len / sizeof(u32); 11040 11041 if (len % sizeof(u32)) 11042 return -EINVAL; 11043 11044 if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites) 11045 return -EINVAL; 11046 11047 memcpy(settings->akm_suites, data, len); 11048 } 11049 11050 if (info->attrs[NL80211_ATTR_PMK]) { 11051 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN) 11052 return -EINVAL; 11053 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11054 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) && 11055 !wiphy_ext_feature_isset(&rdev->wiphy, 11056 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK)) 11057 return -EINVAL; 11058 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]); 11059 } 11060 11061 if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) { 11062 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11063 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 11064 !wiphy_ext_feature_isset(&rdev->wiphy, 11065 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP)) 11066 return -EINVAL; 11067 settings->sae_pwd = 11068 nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 11069 settings->sae_pwd_len = 11070 nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 11071 } 11072 11073 settings->sae_pwe = 11074 nla_get_u8_default(info->attrs[NL80211_ATTR_SAE_PWE], 11075 NL80211_SAE_PWE_UNSPECIFIED); 11076 11077 return 0; 11078 } 11079 11080 static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev, 11081 const u8 *ssid, int ssid_len, 11082 struct nlattr **attrs, 11083 int assoc_link_id, int link_id) 11084 { 11085 struct ieee80211_channel *chan; 11086 struct cfg80211_bss *bss; 11087 const u8 *bssid; 11088 u32 freq, use_for = 0; 11089 11090 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ]) 11091 return ERR_PTR(-EINVAL); 11092 11093 bssid = nla_data(attrs[NL80211_ATTR_MAC]); 11094 11095 freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ])); 11096 if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 11097 freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 11098 11099 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 11100 if (!chan) 11101 return ERR_PTR(-EINVAL); 11102 11103 if (assoc_link_id >= 0) 11104 use_for = NL80211_BSS_USE_FOR_MLD_LINK; 11105 if (assoc_link_id == link_id) 11106 use_for |= NL80211_BSS_USE_FOR_NORMAL; 11107 11108 bss = __cfg80211_get_bss(&rdev->wiphy, chan, bssid, 11109 ssid, ssid_len, 11110 IEEE80211_BSS_TYPE_ESS, 11111 IEEE80211_PRIVACY_ANY, 11112 use_for); 11113 if (!bss) 11114 return ERR_PTR(-ENOENT); 11115 11116 return bss; 11117 } 11118 11119 static int nl80211_process_links(struct cfg80211_registered_device *rdev, 11120 struct cfg80211_assoc_link *links, 11121 const u8 *ssid, int ssid_len, 11122 struct genl_info *info) 11123 { 11124 unsigned int attrsize = NUM_NL80211_ATTR * sizeof(struct nlattr *); 11125 struct nlattr **attrs __free(kfree) = kzalloc(attrsize, GFP_KERNEL); 11126 struct nlattr *link; 11127 unsigned int link_id; 11128 int rem, err; 11129 11130 if (!attrs) 11131 return -ENOMEM; 11132 11133 nla_for_each_nested(link, info->attrs[NL80211_ATTR_MLO_LINKS], rem) { 11134 memset(attrs, 0, attrsize); 11135 11136 nla_parse_nested(attrs, NL80211_ATTR_MAX, link, NULL, NULL); 11137 11138 if (!attrs[NL80211_ATTR_MLO_LINK_ID]) { 11139 NL_SET_BAD_ATTR(info->extack, link); 11140 return -EINVAL; 11141 } 11142 11143 link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]); 11144 /* cannot use the same link ID again */ 11145 if (links[link_id].bss) { 11146 NL_SET_BAD_ATTR(info->extack, link); 11147 return -EINVAL; 11148 } 11149 links[link_id].bss = 11150 nl80211_assoc_bss(rdev, ssid, ssid_len, attrs, 11151 link_id, link_id); 11152 if (IS_ERR(links[link_id].bss)) { 11153 err = PTR_ERR(links[link_id].bss); 11154 links[link_id].bss = NULL; 11155 NL_SET_ERR_MSG_ATTR(info->extack, link, 11156 "Error fetching BSS for link"); 11157 return err; 11158 } 11159 11160 if (attrs[NL80211_ATTR_IE]) { 11161 links[link_id].elems = nla_data(attrs[NL80211_ATTR_IE]); 11162 links[link_id].elems_len = 11163 nla_len(attrs[NL80211_ATTR_IE]); 11164 11165 if (cfg80211_find_elem(WLAN_EID_FRAGMENT, 11166 links[link_id].elems, 11167 links[link_id].elems_len)) { 11168 NL_SET_ERR_MSG_ATTR(info->extack, 11169 attrs[NL80211_ATTR_IE], 11170 "cannot deal with fragmentation"); 11171 return -EINVAL; 11172 } 11173 11174 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 11175 links[link_id].elems, 11176 links[link_id].elems_len)) { 11177 NL_SET_ERR_MSG_ATTR(info->extack, 11178 attrs[NL80211_ATTR_IE], 11179 "cannot deal with non-inheritance"); 11180 return -EINVAL; 11181 } 11182 } 11183 11184 links[link_id].disabled = 11185 nla_get_flag(attrs[NL80211_ATTR_MLO_LINK_DISABLED]); 11186 } 11187 11188 return 0; 11189 } 11190 11191 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info) 11192 { 11193 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11194 struct net_device *dev = info->user_ptr[1]; 11195 struct cfg80211_assoc_request req = {}; 11196 const u8 *ap_addr, *ssid; 11197 unsigned int link_id; 11198 int err, ssid_len; 11199 11200 if (dev->ieee80211_ptr->conn_owner_nlportid && 11201 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11202 return -EPERM; 11203 11204 if (!info->attrs[NL80211_ATTR_SSID]) 11205 return -EINVAL; 11206 11207 if (!rdev->ops->assoc) 11208 return -EOPNOTSUPP; 11209 11210 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11211 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11212 return -EOPNOTSUPP; 11213 11214 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11215 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11216 11217 if (info->attrs[NL80211_ATTR_IE]) { 11218 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11219 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11220 11221 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 11222 req.ie, req.ie_len)) { 11223 NL_SET_ERR_MSG_ATTR(info->extack, 11224 info->attrs[NL80211_ATTR_IE], 11225 "non-inheritance makes no sense"); 11226 return -EINVAL; 11227 } 11228 } 11229 11230 if (info->attrs[NL80211_ATTR_USE_MFP]) { 11231 enum nl80211_mfp mfp = 11232 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 11233 if (mfp == NL80211_MFP_REQUIRED) 11234 req.use_mfp = true; 11235 else if (mfp != NL80211_MFP_NO) 11236 return -EINVAL; 11237 } 11238 11239 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 11240 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 11241 11242 if (info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]) { 11243 req.supported_selectors = 11244 nla_data(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 11245 req.supported_selectors_len = 11246 nla_len(info->attrs[NL80211_ATTR_SUPPORTED_SELECTORS]); 11247 } 11248 11249 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 11250 req.flags |= ASSOC_REQ_DISABLE_HT; 11251 11252 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11253 memcpy(&req.ht_capa_mask, 11254 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11255 sizeof(req.ht_capa_mask)); 11256 11257 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11258 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11259 return -EINVAL; 11260 memcpy(&req.ht_capa, 11261 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11262 sizeof(req.ht_capa)); 11263 } 11264 11265 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 11266 req.flags |= ASSOC_REQ_DISABLE_VHT; 11267 11268 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 11269 req.flags |= ASSOC_REQ_DISABLE_HE; 11270 11271 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 11272 req.flags |= ASSOC_REQ_DISABLE_EHT; 11273 11274 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11275 memcpy(&req.vht_capa_mask, 11276 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 11277 sizeof(req.vht_capa_mask)); 11278 11279 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 11280 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11281 return -EINVAL; 11282 memcpy(&req.vht_capa, 11283 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 11284 sizeof(req.vht_capa)); 11285 } 11286 11287 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 11288 if (!((rdev->wiphy.features & 11289 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 11290 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 11291 !wiphy_ext_feature_isset(&rdev->wiphy, 11292 NL80211_EXT_FEATURE_RRM)) 11293 return -EINVAL; 11294 req.flags |= ASSOC_REQ_USE_RRM; 11295 } 11296 11297 if (info->attrs[NL80211_ATTR_FILS_KEK]) { 11298 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 11299 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 11300 if (!info->attrs[NL80211_ATTR_FILS_NONCES]) 11301 return -EINVAL; 11302 req.fils_nonces = 11303 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 11304 } 11305 11306 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) { 11307 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 11308 return -EINVAL; 11309 memcpy(&req.s1g_capa_mask, 11310 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]), 11311 sizeof(req.s1g_capa_mask)); 11312 } 11313 11314 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) { 11315 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) 11316 return -EINVAL; 11317 memcpy(&req.s1g_capa, 11318 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]), 11319 sizeof(req.s1g_capa)); 11320 } 11321 11322 if (nla_get_flag(info->attrs[NL80211_ATTR_ASSOC_SPP_AMSDU])) { 11323 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11324 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT)) { 11325 GENL_SET_ERR_MSG(info, "SPP A-MSDUs not supported"); 11326 return -EINVAL; 11327 } 11328 req.flags |= ASSOC_REQ_SPP_AMSDU; 11329 } 11330 11331 req.link_id = nl80211_link_id_or_invalid(info->attrs); 11332 11333 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 11334 if (req.link_id < 0) 11335 return -EINVAL; 11336 11337 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 11338 return -EINVAL; 11339 11340 if (info->attrs[NL80211_ATTR_MAC] || 11341 info->attrs[NL80211_ATTR_WIPHY_FREQ] || 11342 !info->attrs[NL80211_ATTR_MLD_ADDR]) 11343 return -EINVAL; 11344 11345 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 11346 ap_addr = req.ap_mld_addr; 11347 11348 err = nl80211_process_links(rdev, req.links, ssid, ssid_len, 11349 info); 11350 if (err) 11351 goto free; 11352 11353 if (!req.links[req.link_id].bss) { 11354 err = -EINVAL; 11355 goto free; 11356 } 11357 11358 if (req.links[req.link_id].elems_len) { 11359 GENL_SET_ERR_MSG(info, 11360 "cannot have per-link elems on assoc link"); 11361 err = -EINVAL; 11362 goto free; 11363 } 11364 11365 if (req.links[req.link_id].disabled) { 11366 GENL_SET_ERR_MSG(info, 11367 "cannot have assoc link disabled"); 11368 err = -EINVAL; 11369 goto free; 11370 } 11371 } else { 11372 if (req.link_id >= 0) 11373 return -EINVAL; 11374 11375 req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs, 11376 -1, -1); 11377 if (IS_ERR(req.bss)) 11378 return PTR_ERR(req.bss); 11379 ap_addr = req.bss->bssid; 11380 } 11381 11382 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1); 11383 if (!err) { 11384 struct nlattr *link; 11385 int rem = 0; 11386 11387 err = cfg80211_mlme_assoc(rdev, dev, &req, 11388 info->extack); 11389 11390 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 11391 dev->ieee80211_ptr->conn_owner_nlportid = 11392 info->snd_portid; 11393 memcpy(dev->ieee80211_ptr->disconnect_bssid, 11394 ap_addr, ETH_ALEN); 11395 } 11396 11397 /* Report error from first problematic link */ 11398 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 11399 nla_for_each_nested(link, 11400 info->attrs[NL80211_ATTR_MLO_LINKS], 11401 rem) { 11402 struct nlattr *link_id_attr = 11403 nla_find_nested(link, NL80211_ATTR_MLO_LINK_ID); 11404 11405 if (!link_id_attr) 11406 continue; 11407 11408 link_id = nla_get_u8(link_id_attr); 11409 11410 if (link_id == req.link_id) 11411 continue; 11412 11413 if (!req.links[link_id].error || 11414 WARN_ON(req.links[link_id].error > 0)) 11415 continue; 11416 11417 WARN_ON(err >= 0); 11418 11419 NL_SET_BAD_ATTR(info->extack, link); 11420 err = req.links[link_id].error; 11421 break; 11422 } 11423 } 11424 } 11425 11426 free: 11427 for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++) 11428 cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss); 11429 cfg80211_put_bss(&rdev->wiphy, req.bss); 11430 11431 return err; 11432 } 11433 11434 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info) 11435 { 11436 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11437 struct net_device *dev = info->user_ptr[1]; 11438 const u8 *ie = NULL, *bssid; 11439 int ie_len = 0; 11440 u16 reason_code; 11441 bool local_state_change; 11442 11443 if (dev->ieee80211_ptr->conn_owner_nlportid && 11444 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11445 return -EPERM; 11446 11447 if (!info->attrs[NL80211_ATTR_MAC]) 11448 return -EINVAL; 11449 11450 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11451 return -EINVAL; 11452 11453 if (!rdev->ops->deauth) 11454 return -EOPNOTSUPP; 11455 11456 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11457 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11458 return -EOPNOTSUPP; 11459 11460 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11461 11462 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11463 if (reason_code == 0) { 11464 /* Reason Code 0 is reserved */ 11465 return -EINVAL; 11466 } 11467 11468 if (info->attrs[NL80211_ATTR_IE]) { 11469 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11470 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11471 } 11472 11473 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11474 11475 return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code, 11476 local_state_change); 11477 } 11478 11479 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info) 11480 { 11481 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11482 struct net_device *dev = info->user_ptr[1]; 11483 const u8 *ie = NULL, *bssid; 11484 int ie_len = 0; 11485 u16 reason_code; 11486 bool local_state_change; 11487 11488 if (dev->ieee80211_ptr->conn_owner_nlportid && 11489 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11490 return -EPERM; 11491 11492 if (!info->attrs[NL80211_ATTR_MAC]) 11493 return -EINVAL; 11494 11495 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11496 return -EINVAL; 11497 11498 if (!rdev->ops->disassoc) 11499 return -EOPNOTSUPP; 11500 11501 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11502 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11503 return -EOPNOTSUPP; 11504 11505 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11506 11507 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11508 if (reason_code == 0) { 11509 /* Reason Code 0 is reserved */ 11510 return -EINVAL; 11511 } 11512 11513 if (info->attrs[NL80211_ATTR_IE]) { 11514 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11515 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11516 } 11517 11518 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11519 11520 return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code, 11521 local_state_change); 11522 } 11523 11524 static bool 11525 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev, 11526 int mcast_rate[NUM_NL80211_BANDS], 11527 int rateval) 11528 { 11529 struct wiphy *wiphy = &rdev->wiphy; 11530 bool found = false; 11531 int band, i; 11532 11533 for (band = 0; band < NUM_NL80211_BANDS; band++) { 11534 struct ieee80211_supported_band *sband; 11535 11536 sband = wiphy->bands[band]; 11537 if (!sband) 11538 continue; 11539 11540 for (i = 0; i < sband->n_bitrates; i++) { 11541 if (sband->bitrates[i].bitrate == rateval) { 11542 mcast_rate[band] = i + 1; 11543 found = true; 11544 break; 11545 } 11546 } 11547 } 11548 11549 return found; 11550 } 11551 11552 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info) 11553 { 11554 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11555 struct net_device *dev = info->user_ptr[1]; 11556 struct cfg80211_ibss_params ibss; 11557 struct wiphy *wiphy; 11558 struct cfg80211_cached_keys *connkeys = NULL; 11559 int err; 11560 11561 memset(&ibss, 0, sizeof(ibss)); 11562 11563 if (!info->attrs[NL80211_ATTR_SSID] || 11564 !nla_len(info->attrs[NL80211_ATTR_SSID])) 11565 return -EINVAL; 11566 11567 ibss.beacon_interval = 100; 11568 11569 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) 11570 ibss.beacon_interval = 11571 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 11572 11573 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC, 11574 ibss.beacon_interval); 11575 if (err) 11576 return err; 11577 11578 if (!rdev->ops->join_ibss) 11579 return -EOPNOTSUPP; 11580 11581 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11582 return -EOPNOTSUPP; 11583 11584 wiphy = &rdev->wiphy; 11585 11586 if (info->attrs[NL80211_ATTR_MAC]) { 11587 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11588 11589 if (!is_valid_ether_addr(ibss.bssid)) 11590 return -EINVAL; 11591 } 11592 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11593 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11594 11595 if (info->attrs[NL80211_ATTR_IE]) { 11596 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11597 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11598 } 11599 11600 err = nl80211_parse_chandef(rdev, info, &ibss.chandef); 11601 if (err) 11602 return err; 11603 11604 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef, 11605 NL80211_IFTYPE_ADHOC)) 11606 return -EINVAL; 11607 11608 switch (ibss.chandef.width) { 11609 case NL80211_CHAN_WIDTH_5: 11610 case NL80211_CHAN_WIDTH_10: 11611 case NL80211_CHAN_WIDTH_20_NOHT: 11612 break; 11613 case NL80211_CHAN_WIDTH_20: 11614 case NL80211_CHAN_WIDTH_40: 11615 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11616 return -EINVAL; 11617 break; 11618 case NL80211_CHAN_WIDTH_80: 11619 case NL80211_CHAN_WIDTH_80P80: 11620 case NL80211_CHAN_WIDTH_160: 11621 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11622 return -EINVAL; 11623 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11624 NL80211_EXT_FEATURE_VHT_IBSS)) 11625 return -EINVAL; 11626 break; 11627 case NL80211_CHAN_WIDTH_320: 11628 return -EINVAL; 11629 default: 11630 return -EINVAL; 11631 } 11632 11633 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED]; 11634 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 11635 11636 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 11637 u8 *rates = 11638 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11639 int n_rates = 11640 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11641 struct ieee80211_supported_band *sband = 11642 wiphy->bands[ibss.chandef.chan->band]; 11643 11644 err = ieee80211_get_ratemask(sband, rates, n_rates, 11645 &ibss.basic_rates); 11646 if (err) 11647 return err; 11648 } 11649 11650 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11651 memcpy(&ibss.ht_capa_mask, 11652 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11653 sizeof(ibss.ht_capa_mask)); 11654 11655 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11656 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11657 return -EINVAL; 11658 memcpy(&ibss.ht_capa, 11659 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11660 sizeof(ibss.ht_capa)); 11661 } 11662 11663 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 11664 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate, 11665 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 11666 return -EINVAL; 11667 11668 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) { 11669 bool no_ht = false; 11670 11671 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht); 11672 if (IS_ERR(connkeys)) 11673 return PTR_ERR(connkeys); 11674 11675 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) && 11676 no_ht) { 11677 kfree_sensitive(connkeys); 11678 return -EINVAL; 11679 } 11680 } 11681 11682 ibss.control_port = 11683 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]); 11684 11685 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 11686 int r = validate_pae_over_nl80211(rdev, info); 11687 11688 if (r < 0) { 11689 kfree_sensitive(connkeys); 11690 return r; 11691 } 11692 11693 ibss.control_port_over_nl80211 = true; 11694 } 11695 11696 ibss.userspace_handles_dfs = 11697 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 11698 11699 err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys); 11700 if (err) 11701 kfree_sensitive(connkeys); 11702 else if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 11703 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 11704 11705 return err; 11706 } 11707 11708 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info) 11709 { 11710 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11711 struct net_device *dev = info->user_ptr[1]; 11712 11713 if (!rdev->ops->leave_ibss) 11714 return -EOPNOTSUPP; 11715 11716 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11717 return -EOPNOTSUPP; 11718 11719 return cfg80211_leave_ibss(rdev, dev, false); 11720 } 11721 11722 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info) 11723 { 11724 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11725 struct net_device *dev = info->user_ptr[1]; 11726 int mcast_rate[NUM_NL80211_BANDS]; 11727 u32 nla_rate; 11728 11729 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC && 11730 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 11731 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB) 11732 return -EOPNOTSUPP; 11733 11734 if (!rdev->ops->set_mcast_rate) 11735 return -EOPNOTSUPP; 11736 11737 memset(mcast_rate, 0, sizeof(mcast_rate)); 11738 11739 if (!info->attrs[NL80211_ATTR_MCAST_RATE]) 11740 return -EINVAL; 11741 11742 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]); 11743 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate)) 11744 return -EINVAL; 11745 11746 return rdev_set_mcast_rate(rdev, dev, mcast_rate); 11747 } 11748 11749 static struct sk_buff * 11750 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev, 11751 struct wireless_dev *wdev, int approxlen, 11752 u32 portid, u32 seq, enum nl80211_commands cmd, 11753 enum nl80211_attrs attr, 11754 const struct nl80211_vendor_cmd_info *info, 11755 gfp_t gfp) 11756 { 11757 struct sk_buff *skb; 11758 void *hdr; 11759 struct nlattr *data; 11760 11761 skb = nlmsg_new(approxlen + 100, gfp); 11762 if (!skb) 11763 return NULL; 11764 11765 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd); 11766 if (!hdr) { 11767 kfree_skb(skb); 11768 return NULL; 11769 } 11770 11771 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 11772 goto nla_put_failure; 11773 11774 if (info) { 11775 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID, 11776 info->vendor_id)) 11777 goto nla_put_failure; 11778 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD, 11779 info->subcmd)) 11780 goto nla_put_failure; 11781 } 11782 11783 if (wdev) { 11784 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 11785 wdev_id(wdev), NL80211_ATTR_PAD)) 11786 goto nla_put_failure; 11787 if (wdev->netdev && 11788 nla_put_u32(skb, NL80211_ATTR_IFINDEX, 11789 wdev->netdev->ifindex)) 11790 goto nla_put_failure; 11791 } 11792 11793 data = nla_nest_start_noflag(skb, attr); 11794 if (!data) 11795 goto nla_put_failure; 11796 11797 ((void **)skb->cb)[0] = rdev; 11798 ((void **)skb->cb)[1] = hdr; 11799 ((void **)skb->cb)[2] = data; 11800 11801 return skb; 11802 11803 nla_put_failure: 11804 kfree_skb(skb); 11805 return NULL; 11806 } 11807 11808 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy, 11809 struct wireless_dev *wdev, 11810 enum nl80211_commands cmd, 11811 enum nl80211_attrs attr, 11812 unsigned int portid, 11813 int vendor_event_idx, 11814 int approxlen, gfp_t gfp) 11815 { 11816 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 11817 const struct nl80211_vendor_cmd_info *info; 11818 11819 switch (cmd) { 11820 case NL80211_CMD_TESTMODE: 11821 if (WARN_ON(vendor_event_idx != -1)) 11822 return NULL; 11823 info = NULL; 11824 break; 11825 case NL80211_CMD_VENDOR: 11826 if (WARN_ON(vendor_event_idx < 0 || 11827 vendor_event_idx >= wiphy->n_vendor_events)) 11828 return NULL; 11829 info = &wiphy->vendor_events[vendor_event_idx]; 11830 break; 11831 default: 11832 WARN_ON(1); 11833 return NULL; 11834 } 11835 11836 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0, 11837 cmd, attr, info, gfp); 11838 } 11839 EXPORT_SYMBOL(__cfg80211_alloc_event_skb); 11840 11841 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp) 11842 { 11843 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 11844 void *hdr = ((void **)skb->cb)[1]; 11845 struct nlmsghdr *nlhdr = nlmsg_hdr(skb); 11846 struct nlattr *data = ((void **)skb->cb)[2]; 11847 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE; 11848 11849 /* clear CB data for netlink core to own from now on */ 11850 memset(skb->cb, 0, sizeof(skb->cb)); 11851 11852 nla_nest_end(skb, data); 11853 genlmsg_end(skb, hdr); 11854 11855 if (nlhdr->nlmsg_pid) { 11856 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb, 11857 nlhdr->nlmsg_pid); 11858 } else { 11859 if (data->nla_type == NL80211_ATTR_VENDOR_DATA) 11860 mcgrp = NL80211_MCGRP_VENDOR; 11861 11862 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 11863 skb, 0, mcgrp, gfp); 11864 } 11865 } 11866 EXPORT_SYMBOL(__cfg80211_send_event_skb); 11867 11868 #ifdef CONFIG_NL80211_TESTMODE 11869 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info) 11870 { 11871 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11872 struct wireless_dev *wdev; 11873 int err; 11874 11875 lockdep_assert_held(&rdev->wiphy.mtx); 11876 11877 wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 11878 info->attrs); 11879 11880 if (!rdev->ops->testmode_cmd) 11881 return -EOPNOTSUPP; 11882 11883 if (IS_ERR(wdev)) { 11884 err = PTR_ERR(wdev); 11885 if (err != -EINVAL) 11886 return err; 11887 wdev = NULL; 11888 } else if (wdev->wiphy != &rdev->wiphy) { 11889 return -EINVAL; 11890 } 11891 11892 if (!info->attrs[NL80211_ATTR_TESTDATA]) 11893 return -EINVAL; 11894 11895 rdev->cur_cmd_info = info; 11896 err = rdev_testmode_cmd(rdev, wdev, 11897 nla_data(info->attrs[NL80211_ATTR_TESTDATA]), 11898 nla_len(info->attrs[NL80211_ATTR_TESTDATA])); 11899 rdev->cur_cmd_info = NULL; 11900 11901 return err; 11902 } 11903 11904 static int nl80211_testmode_dump(struct sk_buff *skb, 11905 struct netlink_callback *cb) 11906 { 11907 struct cfg80211_registered_device *rdev; 11908 struct nlattr **attrbuf = NULL; 11909 int err; 11910 long phy_idx; 11911 void *data = NULL; 11912 int data_len = 0; 11913 11914 rtnl_lock(); 11915 11916 if (cb->args[0]) { 11917 /* 11918 * 0 is a valid index, but not valid for args[0], 11919 * so we need to offset by 1. 11920 */ 11921 phy_idx = cb->args[0] - 1; 11922 11923 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx); 11924 if (!rdev) { 11925 err = -ENOENT; 11926 goto out_err; 11927 } 11928 } else { 11929 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 11930 GFP_KERNEL); 11931 if (!attrbuf) { 11932 err = -ENOMEM; 11933 goto out_err; 11934 } 11935 11936 err = nlmsg_parse_deprecated(cb->nlh, 11937 GENL_HDRLEN + nl80211_fam.hdrsize, 11938 attrbuf, nl80211_fam.maxattr, 11939 nl80211_policy, NULL); 11940 if (err) 11941 goto out_err; 11942 11943 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 11944 if (IS_ERR(rdev)) { 11945 err = PTR_ERR(rdev); 11946 goto out_err; 11947 } 11948 phy_idx = rdev->wiphy_idx; 11949 11950 if (attrbuf[NL80211_ATTR_TESTDATA]) 11951 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA]; 11952 } 11953 11954 if (cb->args[1]) { 11955 data = nla_data((void *)cb->args[1]); 11956 data_len = nla_len((void *)cb->args[1]); 11957 } 11958 11959 if (!rdev->ops->testmode_dump) { 11960 err = -EOPNOTSUPP; 11961 goto out_err; 11962 } 11963 11964 while (1) { 11965 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 11966 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11967 NL80211_CMD_TESTMODE); 11968 struct nlattr *tmdata; 11969 11970 if (!hdr) 11971 break; 11972 11973 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) { 11974 genlmsg_cancel(skb, hdr); 11975 break; 11976 } 11977 11978 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA); 11979 if (!tmdata) { 11980 genlmsg_cancel(skb, hdr); 11981 break; 11982 } 11983 err = rdev_testmode_dump(rdev, skb, cb, data, data_len); 11984 nla_nest_end(skb, tmdata); 11985 11986 if (err == -ENOBUFS || err == -ENOENT) { 11987 genlmsg_cancel(skb, hdr); 11988 break; 11989 } else if (err) { 11990 genlmsg_cancel(skb, hdr); 11991 goto out_err; 11992 } 11993 11994 genlmsg_end(skb, hdr); 11995 } 11996 11997 err = skb->len; 11998 /* see above */ 11999 cb->args[0] = phy_idx + 1; 12000 out_err: 12001 kfree(attrbuf); 12002 rtnl_unlock(); 12003 return err; 12004 } 12005 #endif 12006 12007 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info) 12008 { 12009 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12010 struct net_device *dev = info->user_ptr[1]; 12011 struct cfg80211_connect_params connect; 12012 struct wiphy *wiphy; 12013 struct cfg80211_cached_keys *connkeys = NULL; 12014 u32 freq = 0; 12015 int err; 12016 12017 memset(&connect, 0, sizeof(connect)); 12018 12019 if (!info->attrs[NL80211_ATTR_SSID] || 12020 !nla_len(info->attrs[NL80211_ATTR_SSID])) 12021 return -EINVAL; 12022 12023 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 12024 connect.auth_type = 12025 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 12026 if (!nl80211_valid_auth_type(rdev, connect.auth_type, 12027 NL80211_CMD_CONNECT)) 12028 return -EINVAL; 12029 } else 12030 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 12031 12032 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY]; 12033 12034 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] && 12035 !wiphy_ext_feature_isset(&rdev->wiphy, 12036 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 12037 return -EINVAL; 12038 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS]; 12039 12040 err = nl80211_crypto_settings(rdev, info, &connect.crypto, 12041 NL80211_MAX_NR_CIPHER_SUITES); 12042 if (err) 12043 return err; 12044 12045 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12046 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12047 return -EOPNOTSUPP; 12048 12049 wiphy = &rdev->wiphy; 12050 12051 connect.bg_scan_period = -1; 12052 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] && 12053 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) { 12054 connect.bg_scan_period = 12055 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]); 12056 } 12057 12058 if (info->attrs[NL80211_ATTR_MAC]) 12059 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12060 else if (info->attrs[NL80211_ATTR_MAC_HINT]) 12061 connect.bssid_hint = 12062 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]); 12063 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12064 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12065 12066 if (info->attrs[NL80211_ATTR_IE]) { 12067 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12068 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12069 } 12070 12071 if (info->attrs[NL80211_ATTR_USE_MFP]) { 12072 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 12073 if (connect.mfp == NL80211_MFP_OPTIONAL && 12074 !wiphy_ext_feature_isset(&rdev->wiphy, 12075 NL80211_EXT_FEATURE_MFP_OPTIONAL)) 12076 return -EOPNOTSUPP; 12077 } else { 12078 connect.mfp = NL80211_MFP_NO; 12079 } 12080 12081 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 12082 connect.prev_bssid = 12083 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 12084 12085 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) 12086 freq = MHZ_TO_KHZ(nla_get_u32( 12087 info->attrs[NL80211_ATTR_WIPHY_FREQ])); 12088 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 12089 freq += 12090 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 12091 12092 if (freq) { 12093 connect.channel = nl80211_get_valid_chan(wiphy, freq); 12094 if (!connect.channel) 12095 return -EINVAL; 12096 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) { 12097 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]); 12098 freq = MHZ_TO_KHZ(freq); 12099 connect.channel_hint = nl80211_get_valid_chan(wiphy, freq); 12100 if (!connect.channel_hint) 12101 return -EINVAL; 12102 } 12103 12104 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 12105 connect.edmg.channels = 12106 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 12107 12108 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 12109 connect.edmg.bw_config = 12110 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 12111 } 12112 12113 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) { 12114 connkeys = nl80211_parse_connkeys(rdev, info, NULL); 12115 if (IS_ERR(connkeys)) 12116 return PTR_ERR(connkeys); 12117 } 12118 12119 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 12120 connect.flags |= ASSOC_REQ_DISABLE_HT; 12121 12122 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 12123 memcpy(&connect.ht_capa_mask, 12124 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 12125 sizeof(connect.ht_capa_mask)); 12126 12127 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 12128 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) { 12129 kfree_sensitive(connkeys); 12130 return -EINVAL; 12131 } 12132 memcpy(&connect.ht_capa, 12133 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 12134 sizeof(connect.ht_capa)); 12135 } 12136 12137 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 12138 connect.flags |= ASSOC_REQ_DISABLE_VHT; 12139 12140 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 12141 connect.flags |= ASSOC_REQ_DISABLE_HE; 12142 12143 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 12144 connect.flags |= ASSOC_REQ_DISABLE_EHT; 12145 12146 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 12147 memcpy(&connect.vht_capa_mask, 12148 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 12149 sizeof(connect.vht_capa_mask)); 12150 12151 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 12152 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) { 12153 kfree_sensitive(connkeys); 12154 return -EINVAL; 12155 } 12156 memcpy(&connect.vht_capa, 12157 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 12158 sizeof(connect.vht_capa)); 12159 } 12160 12161 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 12162 if (!((rdev->wiphy.features & 12163 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 12164 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 12165 !wiphy_ext_feature_isset(&rdev->wiphy, 12166 NL80211_EXT_FEATURE_RRM)) { 12167 kfree_sensitive(connkeys); 12168 return -EINVAL; 12169 } 12170 connect.flags |= ASSOC_REQ_USE_RRM; 12171 } 12172 12173 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 12174 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 12175 kfree_sensitive(connkeys); 12176 return -EOPNOTSUPP; 12177 } 12178 12179 if (info->attrs[NL80211_ATTR_BSS_SELECT]) { 12180 /* bss selection makes no sense if bssid is set */ 12181 if (connect.bssid) { 12182 kfree_sensitive(connkeys); 12183 return -EINVAL; 12184 } 12185 12186 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT], 12187 wiphy, &connect.bss_select); 12188 if (err) { 12189 kfree_sensitive(connkeys); 12190 return err; 12191 } 12192 } 12193 12194 if (wiphy_ext_feature_isset(&rdev->wiphy, 12195 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 12196 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 12197 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 12198 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 12199 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12200 connect.fils_erp_username = 12201 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12202 connect.fils_erp_username_len = 12203 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12204 connect.fils_erp_realm = 12205 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12206 connect.fils_erp_realm_len = 12207 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12208 connect.fils_erp_next_seq_num = 12209 nla_get_u16( 12210 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 12211 connect.fils_erp_rrk = 12212 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12213 connect.fils_erp_rrk_len = 12214 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12215 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 12216 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 12217 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 12218 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12219 kfree_sensitive(connkeys); 12220 return -EINVAL; 12221 } 12222 12223 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) { 12224 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12225 kfree_sensitive(connkeys); 12226 GENL_SET_ERR_MSG(info, 12227 "external auth requires connection ownership"); 12228 return -EINVAL; 12229 } 12230 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT; 12231 } 12232 12233 if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT])) 12234 connect.flags |= CONNECT_REQ_MLO_SUPPORT; 12235 12236 err = cfg80211_connect(rdev, dev, &connect, connkeys, 12237 connect.prev_bssid); 12238 if (err) 12239 kfree_sensitive(connkeys); 12240 12241 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12242 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 12243 if (connect.bssid) 12244 memcpy(dev->ieee80211_ptr->disconnect_bssid, 12245 connect.bssid, ETH_ALEN); 12246 else 12247 eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid); 12248 } 12249 12250 return err; 12251 } 12252 12253 static int nl80211_update_connect_params(struct sk_buff *skb, 12254 struct genl_info *info) 12255 { 12256 struct cfg80211_connect_params connect = {}; 12257 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12258 struct net_device *dev = info->user_ptr[1]; 12259 struct wireless_dev *wdev = dev->ieee80211_ptr; 12260 bool fils_sk_offload; 12261 u32 auth_type; 12262 u32 changed = 0; 12263 12264 if (!rdev->ops->update_connect_params) 12265 return -EOPNOTSUPP; 12266 12267 if (info->attrs[NL80211_ATTR_IE]) { 12268 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12269 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12270 changed |= UPDATE_ASSOC_IES; 12271 } 12272 12273 fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy, 12274 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD); 12275 12276 /* 12277 * when driver supports fils-sk offload all attributes must be 12278 * provided. So the else covers "fils-sk-not-all" and 12279 * "no-fils-sk-any". 12280 */ 12281 if (fils_sk_offload && 12282 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 12283 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 12284 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 12285 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12286 connect.fils_erp_username = 12287 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12288 connect.fils_erp_username_len = 12289 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12290 connect.fils_erp_realm = 12291 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12292 connect.fils_erp_realm_len = 12293 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12294 connect.fils_erp_next_seq_num = 12295 nla_get_u16( 12296 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 12297 connect.fils_erp_rrk = 12298 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12299 connect.fils_erp_rrk_len = 12300 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12301 changed |= UPDATE_FILS_ERP_INFO; 12302 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 12303 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 12304 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 12305 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12306 return -EINVAL; 12307 } 12308 12309 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 12310 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 12311 if (!nl80211_valid_auth_type(rdev, auth_type, 12312 NL80211_CMD_CONNECT)) 12313 return -EINVAL; 12314 12315 if (auth_type == NL80211_AUTHTYPE_FILS_SK && 12316 fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO)) 12317 return -EINVAL; 12318 12319 connect.auth_type = auth_type; 12320 changed |= UPDATE_AUTH_TYPE; 12321 } 12322 12323 if (!wdev->connected) 12324 return -ENOLINK; 12325 12326 return rdev_update_connect_params(rdev, dev, &connect, changed); 12327 } 12328 12329 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info) 12330 { 12331 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12332 struct net_device *dev = info->user_ptr[1]; 12333 u16 reason; 12334 12335 if (dev->ieee80211_ptr->conn_owner_nlportid && 12336 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12337 return -EPERM; 12338 12339 reason = nla_get_u16_default(info->attrs[NL80211_ATTR_REASON_CODE], 12340 WLAN_REASON_DEAUTH_LEAVING); 12341 12342 if (reason == 0) 12343 return -EINVAL; 12344 12345 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12346 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12347 return -EOPNOTSUPP; 12348 12349 return cfg80211_disconnect(rdev, dev, reason, true); 12350 } 12351 12352 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info) 12353 { 12354 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12355 struct net *net; 12356 int err; 12357 12358 if (info->attrs[NL80211_ATTR_PID]) { 12359 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]); 12360 12361 net = get_net_ns_by_pid(pid); 12362 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) { 12363 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]); 12364 12365 net = get_net_ns_by_fd(fd); 12366 } else { 12367 return -EINVAL; 12368 } 12369 12370 if (IS_ERR(net)) 12371 return PTR_ERR(net); 12372 12373 err = 0; 12374 12375 /* check if anything to do */ 12376 if (!net_eq(wiphy_net(&rdev->wiphy), net)) 12377 err = cfg80211_switch_netns(rdev, net); 12378 12379 put_net(net); 12380 return err; 12381 } 12382 12383 static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info) 12384 { 12385 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12386 struct net_device *dev = info->user_ptr[1]; 12387 struct cfg80211_pmksa pmksa; 12388 bool ap_pmksa_caching_support = false; 12389 12390 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 12391 12392 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 12393 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 12394 12395 if (!info->attrs[NL80211_ATTR_PMKID]) 12396 return -EINVAL; 12397 12398 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 12399 12400 if (info->attrs[NL80211_ATTR_MAC]) { 12401 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12402 } else if (info->attrs[NL80211_ATTR_SSID] && 12403 info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 12404 info->attrs[NL80211_ATTR_PMK]) { 12405 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12406 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12407 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 12408 } else { 12409 return -EINVAL; 12410 } 12411 12412 if (info->attrs[NL80211_ATTR_PMK]) { 12413 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 12414 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 12415 } 12416 12417 if (info->attrs[NL80211_ATTR_PMK_LIFETIME]) 12418 pmksa.pmk_lifetime = 12419 nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]); 12420 12421 if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]) 12422 pmksa.pmk_reauth_threshold = 12423 nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]); 12424 12425 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12426 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 12427 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 12428 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 12429 ap_pmksa_caching_support)) 12430 return -EOPNOTSUPP; 12431 12432 if (!rdev->ops->set_pmksa) 12433 return -EOPNOTSUPP; 12434 12435 return rdev_set_pmksa(rdev, dev, &pmksa); 12436 } 12437 12438 static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info) 12439 { 12440 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12441 struct net_device *dev = info->user_ptr[1]; 12442 struct cfg80211_pmksa pmksa; 12443 bool sae_offload_support = false; 12444 bool owe_offload_support = false; 12445 bool ap_pmksa_caching_support = false; 12446 12447 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 12448 12449 sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 12450 NL80211_EXT_FEATURE_SAE_OFFLOAD); 12451 owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 12452 NL80211_EXT_FEATURE_OWE_OFFLOAD); 12453 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 12454 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 12455 12456 if (info->attrs[NL80211_ATTR_PMKID]) 12457 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 12458 12459 if (info->attrs[NL80211_ATTR_MAC]) { 12460 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12461 } else if (info->attrs[NL80211_ATTR_SSID]) { 12462 /* SSID based pmksa flush supported only for FILS, 12463 * OWE/SAE OFFLOAD cases 12464 */ 12465 if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 12466 info->attrs[NL80211_ATTR_PMK]) { 12467 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 12468 } else if (!sae_offload_support && !owe_offload_support) { 12469 return -EINVAL; 12470 } 12471 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12472 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12473 } else { 12474 return -EINVAL; 12475 } 12476 12477 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12478 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 12479 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 12480 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 12481 ap_pmksa_caching_support)) 12482 return -EOPNOTSUPP; 12483 12484 if (!rdev->ops->del_pmksa) 12485 return -EOPNOTSUPP; 12486 12487 return rdev_del_pmksa(rdev, dev, &pmksa); 12488 } 12489 12490 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info) 12491 { 12492 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12493 struct net_device *dev = info->user_ptr[1]; 12494 12495 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12496 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12497 return -EOPNOTSUPP; 12498 12499 if (!rdev->ops->flush_pmksa) 12500 return -EOPNOTSUPP; 12501 12502 return rdev_flush_pmksa(rdev, dev); 12503 } 12504 12505 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info) 12506 { 12507 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12508 struct net_device *dev = info->user_ptr[1]; 12509 u8 action_code, dialog_token; 12510 u32 peer_capability = 0; 12511 u16 status_code; 12512 u8 *peer; 12513 int link_id; 12514 bool initiator; 12515 12516 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12517 !rdev->ops->tdls_mgmt) 12518 return -EOPNOTSUPP; 12519 12520 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] || 12521 !info->attrs[NL80211_ATTR_STATUS_CODE] || 12522 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] || 12523 !info->attrs[NL80211_ATTR_IE] || 12524 !info->attrs[NL80211_ATTR_MAC]) 12525 return -EINVAL; 12526 12527 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12528 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]); 12529 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 12530 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]); 12531 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]); 12532 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]) 12533 peer_capability = 12534 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]); 12535 link_id = nl80211_link_id_or_invalid(info->attrs); 12536 12537 return rdev_tdls_mgmt(rdev, dev, peer, link_id, action_code, 12538 dialog_token, status_code, peer_capability, 12539 initiator, 12540 nla_data(info->attrs[NL80211_ATTR_IE]), 12541 nla_len(info->attrs[NL80211_ATTR_IE])); 12542 } 12543 12544 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info) 12545 { 12546 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12547 struct net_device *dev = info->user_ptr[1]; 12548 enum nl80211_tdls_operation operation; 12549 u8 *peer; 12550 12551 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12552 !rdev->ops->tdls_oper) 12553 return -EOPNOTSUPP; 12554 12555 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] || 12556 !info->attrs[NL80211_ATTR_MAC]) 12557 return -EINVAL; 12558 12559 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]); 12560 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12561 12562 return rdev_tdls_oper(rdev, dev, peer, operation); 12563 } 12564 12565 static int nl80211_remain_on_channel(struct sk_buff *skb, 12566 struct genl_info *info) 12567 { 12568 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12569 unsigned int link_id = nl80211_link_id(info->attrs); 12570 struct wireless_dev *wdev = info->user_ptr[1]; 12571 struct cfg80211_chan_def chandef; 12572 struct sk_buff *msg; 12573 void *hdr; 12574 u64 cookie; 12575 u32 duration; 12576 int err; 12577 12578 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 12579 !info->attrs[NL80211_ATTR_DURATION]) 12580 return -EINVAL; 12581 12582 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12583 12584 if (!rdev->ops->remain_on_channel || 12585 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)) 12586 return -EOPNOTSUPP; 12587 12588 /* 12589 * We should be on that channel for at least a minimum amount of 12590 * time (10ms) but no longer than the driver supports. 12591 */ 12592 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12593 duration > rdev->wiphy.max_remain_on_channel_duration) 12594 return -EINVAL; 12595 12596 err = nl80211_parse_chandef(rdev, info, &chandef); 12597 if (err) 12598 return err; 12599 12600 if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) { 12601 const struct cfg80211_chan_def *oper_chandef, *compat_chandef; 12602 12603 oper_chandef = wdev_chandef(wdev, link_id); 12604 12605 if (WARN_ON(!oper_chandef)) { 12606 /* cannot happen since we must beacon to get here */ 12607 WARN_ON(1); 12608 return -EBUSY; 12609 } 12610 12611 /* note: returns first one if identical chandefs */ 12612 compat_chandef = cfg80211_chandef_compatible(&chandef, 12613 oper_chandef); 12614 12615 if (compat_chandef != &chandef) 12616 return -EBUSY; 12617 } 12618 12619 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12620 if (!msg) 12621 return -ENOMEM; 12622 12623 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12624 NL80211_CMD_REMAIN_ON_CHANNEL); 12625 if (!hdr) { 12626 err = -ENOBUFS; 12627 goto free_msg; 12628 } 12629 12630 err = rdev_remain_on_channel(rdev, wdev, chandef.chan, 12631 duration, &cookie); 12632 12633 if (err) 12634 goto free_msg; 12635 12636 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12637 NL80211_ATTR_PAD)) 12638 goto nla_put_failure; 12639 12640 genlmsg_end(msg, hdr); 12641 12642 return genlmsg_reply(msg, info); 12643 12644 nla_put_failure: 12645 err = -ENOBUFS; 12646 free_msg: 12647 nlmsg_free(msg); 12648 return err; 12649 } 12650 12651 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb, 12652 struct genl_info *info) 12653 { 12654 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12655 struct wireless_dev *wdev = info->user_ptr[1]; 12656 u64 cookie; 12657 12658 if (!info->attrs[NL80211_ATTR_COOKIE]) 12659 return -EINVAL; 12660 12661 if (!rdev->ops->cancel_remain_on_channel) 12662 return -EOPNOTSUPP; 12663 12664 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12665 12666 return rdev_cancel_remain_on_channel(rdev, wdev, cookie); 12667 } 12668 12669 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb, 12670 struct genl_info *info) 12671 { 12672 struct cfg80211_bitrate_mask mask; 12673 unsigned int link_id = nl80211_link_id(info->attrs); 12674 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12675 struct net_device *dev = info->user_ptr[1]; 12676 int err; 12677 12678 if (!rdev->ops->set_bitrate_mask) 12679 return -EOPNOTSUPP; 12680 12681 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 12682 NL80211_ATTR_TX_RATES, &mask, 12683 dev, true, link_id); 12684 if (err) 12685 return err; 12686 12687 return rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask); 12688 } 12689 12690 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info) 12691 { 12692 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12693 struct wireless_dev *wdev = info->user_ptr[1]; 12694 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION; 12695 12696 if (!info->attrs[NL80211_ATTR_FRAME_MATCH]) 12697 return -EINVAL; 12698 12699 if (info->attrs[NL80211_ATTR_FRAME_TYPE]) 12700 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]); 12701 12702 switch (wdev->iftype) { 12703 case NL80211_IFTYPE_STATION: 12704 case NL80211_IFTYPE_ADHOC: 12705 case NL80211_IFTYPE_P2P_CLIENT: 12706 case NL80211_IFTYPE_AP: 12707 case NL80211_IFTYPE_AP_VLAN: 12708 case NL80211_IFTYPE_MESH_POINT: 12709 case NL80211_IFTYPE_P2P_GO: 12710 case NL80211_IFTYPE_P2P_DEVICE: 12711 break; 12712 case NL80211_IFTYPE_NAN: 12713 if (!wiphy_ext_feature_isset(wdev->wiphy, 12714 NL80211_EXT_FEATURE_SECURE_NAN)) 12715 return -EOPNOTSUPP; 12716 break; 12717 default: 12718 return -EOPNOTSUPP; 12719 } 12720 12721 /* not much point in registering if we can't reply */ 12722 if (!rdev->ops->mgmt_tx) 12723 return -EOPNOTSUPP; 12724 12725 if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] && 12726 !wiphy_ext_feature_isset(&rdev->wiphy, 12727 NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) { 12728 GENL_SET_ERR_MSG(info, 12729 "multicast RX registrations are not supported"); 12730 return -EOPNOTSUPP; 12731 } 12732 12733 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type, 12734 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12735 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12736 info->attrs[NL80211_ATTR_RECEIVE_MULTICAST], 12737 info->extack); 12738 } 12739 12740 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info) 12741 { 12742 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12743 struct wireless_dev *wdev = info->user_ptr[1]; 12744 struct cfg80211_chan_def chandef; 12745 int err; 12746 void *hdr = NULL; 12747 u64 cookie; 12748 struct sk_buff *msg = NULL; 12749 struct cfg80211_mgmt_tx_params params = { 12750 .dont_wait_for_ack = 12751 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK], 12752 }; 12753 12754 if (!info->attrs[NL80211_ATTR_FRAME]) 12755 return -EINVAL; 12756 12757 if (!rdev->ops->mgmt_tx) 12758 return -EOPNOTSUPP; 12759 12760 switch (wdev->iftype) { 12761 case NL80211_IFTYPE_P2P_DEVICE: 12762 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 12763 return -EINVAL; 12764 break; 12765 case NL80211_IFTYPE_STATION: 12766 case NL80211_IFTYPE_ADHOC: 12767 case NL80211_IFTYPE_P2P_CLIENT: 12768 case NL80211_IFTYPE_AP: 12769 case NL80211_IFTYPE_AP_VLAN: 12770 case NL80211_IFTYPE_MESH_POINT: 12771 case NL80211_IFTYPE_P2P_GO: 12772 break; 12773 case NL80211_IFTYPE_NAN: 12774 if (!wiphy_ext_feature_isset(wdev->wiphy, 12775 NL80211_EXT_FEATURE_SECURE_NAN)) 12776 return -EOPNOTSUPP; 12777 break; 12778 default: 12779 return -EOPNOTSUPP; 12780 } 12781 12782 if (info->attrs[NL80211_ATTR_DURATION]) { 12783 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12784 return -EINVAL; 12785 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12786 12787 /* 12788 * We should wait on the channel for at least a minimum amount 12789 * of time (10ms) but no longer than the driver supports. 12790 */ 12791 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12792 params.wait > rdev->wiphy.max_remain_on_channel_duration) 12793 return -EINVAL; 12794 } 12795 12796 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK]; 12797 12798 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12799 return -EINVAL; 12800 12801 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 12802 12803 /* get the channel if any has been specified, otherwise pass NULL to 12804 * the driver. The latter will use the current one 12805 */ 12806 chandef.chan = NULL; 12807 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 12808 err = nl80211_parse_chandef(rdev, info, &chandef); 12809 if (err) 12810 return err; 12811 } 12812 12813 if (!chandef.chan && params.offchan) 12814 return -EINVAL; 12815 12816 if (params.offchan && 12817 !cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) 12818 return -EBUSY; 12819 12820 params.link_id = nl80211_link_id_or_invalid(info->attrs); 12821 /* 12822 * This now races due to the unlock, but we cannot check 12823 * the valid links for the _station_ anyway, so that's up 12824 * to the driver. 12825 */ 12826 if (params.link_id >= 0 && 12827 !(wdev->valid_links & BIT(params.link_id))) 12828 return -EINVAL; 12829 12830 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 12831 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 12832 12833 err = nl80211_parse_counter_offsets(rdev, NULL, params.len, -1, 12834 info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX], 12835 ¶ms.csa_offsets, 12836 ¶ms.n_csa_offsets); 12837 if (err) 12838 return err; 12839 12840 if (!params.dont_wait_for_ack) { 12841 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12842 if (!msg) 12843 return -ENOMEM; 12844 12845 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12846 NL80211_CMD_FRAME); 12847 if (!hdr) { 12848 err = -ENOBUFS; 12849 goto free_msg; 12850 } 12851 } 12852 12853 params.chan = chandef.chan; 12854 err = cfg80211_mlme_mgmt_tx(rdev, wdev, ¶ms, &cookie); 12855 if (err) 12856 goto free_msg; 12857 12858 if (msg) { 12859 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12860 NL80211_ATTR_PAD)) 12861 goto nla_put_failure; 12862 12863 genlmsg_end(msg, hdr); 12864 return genlmsg_reply(msg, info); 12865 } 12866 12867 return 0; 12868 12869 nla_put_failure: 12870 err = -ENOBUFS; 12871 free_msg: 12872 nlmsg_free(msg); 12873 return err; 12874 } 12875 12876 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info) 12877 { 12878 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12879 struct wireless_dev *wdev = info->user_ptr[1]; 12880 u64 cookie; 12881 12882 if (!info->attrs[NL80211_ATTR_COOKIE]) 12883 return -EINVAL; 12884 12885 if (!rdev->ops->mgmt_tx_cancel_wait) 12886 return -EOPNOTSUPP; 12887 12888 switch (wdev->iftype) { 12889 case NL80211_IFTYPE_STATION: 12890 case NL80211_IFTYPE_ADHOC: 12891 case NL80211_IFTYPE_P2P_CLIENT: 12892 case NL80211_IFTYPE_AP: 12893 case NL80211_IFTYPE_AP_VLAN: 12894 case NL80211_IFTYPE_P2P_GO: 12895 case NL80211_IFTYPE_P2P_DEVICE: 12896 break; 12897 case NL80211_IFTYPE_NAN: 12898 if (!wiphy_ext_feature_isset(wdev->wiphy, 12899 NL80211_EXT_FEATURE_SECURE_NAN)) 12900 return -EOPNOTSUPP; 12901 break; 12902 default: 12903 return -EOPNOTSUPP; 12904 } 12905 12906 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12907 12908 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie); 12909 } 12910 12911 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info) 12912 { 12913 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12914 struct wireless_dev *wdev; 12915 struct net_device *dev = info->user_ptr[1]; 12916 u8 ps_state; 12917 bool state; 12918 int err; 12919 12920 if (!info->attrs[NL80211_ATTR_PS_STATE]) 12921 return -EINVAL; 12922 12923 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]); 12924 12925 wdev = dev->ieee80211_ptr; 12926 12927 if (!rdev->ops->set_power_mgmt) 12928 return -EOPNOTSUPP; 12929 12930 state = (ps_state == NL80211_PS_ENABLED) ? true : false; 12931 12932 if (state == wdev->ps) 12933 return 0; 12934 12935 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout); 12936 if (!err) 12937 wdev->ps = state; 12938 return err; 12939 } 12940 12941 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info) 12942 { 12943 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12944 enum nl80211_ps_state ps_state; 12945 struct wireless_dev *wdev; 12946 struct net_device *dev = info->user_ptr[1]; 12947 struct sk_buff *msg; 12948 void *hdr; 12949 int err; 12950 12951 wdev = dev->ieee80211_ptr; 12952 12953 if (!rdev->ops->set_power_mgmt) 12954 return -EOPNOTSUPP; 12955 12956 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12957 if (!msg) 12958 return -ENOMEM; 12959 12960 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12961 NL80211_CMD_GET_POWER_SAVE); 12962 if (!hdr) { 12963 err = -ENOBUFS; 12964 goto free_msg; 12965 } 12966 12967 if (wdev->ps) 12968 ps_state = NL80211_PS_ENABLED; 12969 else 12970 ps_state = NL80211_PS_DISABLED; 12971 12972 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state)) 12973 goto nla_put_failure; 12974 12975 genlmsg_end(msg, hdr); 12976 return genlmsg_reply(msg, info); 12977 12978 nla_put_failure: 12979 err = -ENOBUFS; 12980 free_msg: 12981 nlmsg_free(msg); 12982 return err; 12983 } 12984 12985 static const struct nla_policy 12986 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = { 12987 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY }, 12988 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 }, 12989 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 }, 12990 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 }, 12991 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 }, 12992 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 }, 12993 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 }, 12994 }; 12995 12996 static int nl80211_set_cqm_txe(struct genl_info *info, 12997 u32 rate, u32 pkts, u32 intvl) 12998 { 12999 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13000 struct net_device *dev = info->user_ptr[1]; 13001 struct wireless_dev *wdev = dev->ieee80211_ptr; 13002 13003 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL) 13004 return -EINVAL; 13005 13006 if (!rdev->ops->set_cqm_txe_config) 13007 return -EOPNOTSUPP; 13008 13009 if (wdev->iftype != NL80211_IFTYPE_STATION && 13010 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 13011 return -EOPNOTSUPP; 13012 13013 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl); 13014 } 13015 13016 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev, 13017 struct net_device *dev, 13018 struct cfg80211_cqm_config *cqm_config) 13019 { 13020 struct wireless_dev *wdev = dev->ieee80211_ptr; 13021 s32 last, low, high; 13022 u32 hyst; 13023 int i, n, low_index; 13024 int err; 13025 13026 /* 13027 * Obtain current RSSI value if possible, if not and no RSSI threshold 13028 * event has been received yet, we should receive an event after a 13029 * connection is established and enough beacons received to calculate 13030 * the average. 13031 */ 13032 if (!cqm_config->last_rssi_event_value && 13033 wdev->links[0].client.current_bss && 13034 rdev->ops->get_station) { 13035 struct station_info sinfo = {}; 13036 u8 *mac_addr; 13037 13038 mac_addr = wdev->links[0].client.current_bss->pub.bssid; 13039 13040 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 13041 if (err) 13042 return err; 13043 13044 cfg80211_sinfo_release_content(&sinfo); 13045 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG)) 13046 cqm_config->last_rssi_event_value = 13047 (s8) sinfo.rx_beacon_signal_avg; 13048 } 13049 13050 last = cqm_config->last_rssi_event_value; 13051 hyst = cqm_config->rssi_hyst; 13052 n = cqm_config->n_rssi_thresholds; 13053 13054 for (i = 0; i < n; i++) { 13055 i = array_index_nospec(i, n); 13056 if (last < cqm_config->rssi_thresholds[i]) 13057 break; 13058 } 13059 13060 low_index = i - 1; 13061 if (low_index >= 0) { 13062 low_index = array_index_nospec(low_index, n); 13063 low = cqm_config->rssi_thresholds[low_index] - hyst; 13064 } else { 13065 low = S32_MIN; 13066 } 13067 if (i < n) { 13068 i = array_index_nospec(i, n); 13069 high = cqm_config->rssi_thresholds[i] + hyst - 1; 13070 } else { 13071 high = S32_MAX; 13072 } 13073 13074 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high); 13075 } 13076 13077 static int nl80211_set_cqm_rssi(struct genl_info *info, 13078 const s32 *thresholds, int n_thresholds, 13079 u32 hysteresis) 13080 { 13081 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13082 struct cfg80211_cqm_config *cqm_config = NULL, *old; 13083 struct net_device *dev = info->user_ptr[1]; 13084 struct wireless_dev *wdev = dev->ieee80211_ptr; 13085 s32 prev = S32_MIN; 13086 int i, err; 13087 13088 /* Check all values negative and sorted */ 13089 for (i = 0; i < n_thresholds; i++) { 13090 if (thresholds[i] > 0 || thresholds[i] <= prev) 13091 return -EINVAL; 13092 13093 prev = thresholds[i]; 13094 } 13095 13096 if (wdev->iftype != NL80211_IFTYPE_STATION && 13097 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 13098 return -EOPNOTSUPP; 13099 13100 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */ 13101 n_thresholds = 0; 13102 13103 old = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 13104 13105 /* if already disabled just succeed */ 13106 if (!n_thresholds && !old) 13107 return 0; 13108 13109 if (n_thresholds > 1) { 13110 if (!wiphy_ext_feature_isset(&rdev->wiphy, 13111 NL80211_EXT_FEATURE_CQM_RSSI_LIST) || 13112 !rdev->ops->set_cqm_rssi_range_config) 13113 return -EOPNOTSUPP; 13114 } else { 13115 if (!rdev->ops->set_cqm_rssi_config) 13116 return -EOPNOTSUPP; 13117 } 13118 13119 if (n_thresholds) { 13120 cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds, 13121 n_thresholds), 13122 GFP_KERNEL); 13123 if (!cqm_config) 13124 return -ENOMEM; 13125 13126 cqm_config->rssi_hyst = hysteresis; 13127 cqm_config->n_rssi_thresholds = n_thresholds; 13128 memcpy(cqm_config->rssi_thresholds, thresholds, 13129 flex_array_size(cqm_config, rssi_thresholds, 13130 n_thresholds)); 13131 cqm_config->use_range_api = n_thresholds > 1 || 13132 !rdev->ops->set_cqm_rssi_config; 13133 13134 rcu_assign_pointer(wdev->cqm_config, cqm_config); 13135 13136 if (cqm_config->use_range_api) 13137 err = cfg80211_cqm_rssi_update(rdev, dev, cqm_config); 13138 else 13139 err = rdev_set_cqm_rssi_config(rdev, dev, 13140 thresholds[0], 13141 hysteresis); 13142 } else { 13143 RCU_INIT_POINTER(wdev->cqm_config, NULL); 13144 /* if enabled as range also disable via range */ 13145 if (old->use_range_api) 13146 err = rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0); 13147 else 13148 err = rdev_set_cqm_rssi_config(rdev, dev, 0, 0); 13149 } 13150 13151 if (err) { 13152 rcu_assign_pointer(wdev->cqm_config, old); 13153 kfree_rcu(cqm_config, rcu_head); 13154 } else { 13155 kfree_rcu(old, rcu_head); 13156 } 13157 13158 return err; 13159 } 13160 13161 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info) 13162 { 13163 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1]; 13164 struct nlattr *cqm; 13165 int err; 13166 13167 cqm = info->attrs[NL80211_ATTR_CQM]; 13168 if (!cqm) 13169 return -EINVAL; 13170 13171 err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm, 13172 nl80211_attr_cqm_policy, 13173 info->extack); 13174 if (err) 13175 return err; 13176 13177 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] && 13178 attrs[NL80211_ATTR_CQM_RSSI_HYST]) { 13179 const s32 *thresholds = 13180 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 13181 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 13182 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]); 13183 13184 if (len % 4) 13185 return -EINVAL; 13186 13187 return nl80211_set_cqm_rssi(info, thresholds, len / 4, 13188 hysteresis); 13189 } 13190 13191 if (attrs[NL80211_ATTR_CQM_TXE_RATE] && 13192 attrs[NL80211_ATTR_CQM_TXE_PKTS] && 13193 attrs[NL80211_ATTR_CQM_TXE_INTVL]) { 13194 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]); 13195 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]); 13196 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]); 13197 13198 return nl80211_set_cqm_txe(info, rate, pkts, intvl); 13199 } 13200 13201 return -EINVAL; 13202 } 13203 13204 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info) 13205 { 13206 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13207 struct net_device *dev = info->user_ptr[1]; 13208 struct ocb_setup setup = {}; 13209 int err; 13210 13211 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 13212 if (err) 13213 return err; 13214 13215 return cfg80211_join_ocb(rdev, dev, &setup); 13216 } 13217 13218 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info) 13219 { 13220 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13221 struct net_device *dev = info->user_ptr[1]; 13222 13223 return cfg80211_leave_ocb(rdev, dev); 13224 } 13225 13226 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info) 13227 { 13228 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13229 struct net_device *dev = info->user_ptr[1]; 13230 struct mesh_config cfg; 13231 struct mesh_setup setup; 13232 int err; 13233 13234 /* start with default */ 13235 memcpy(&cfg, &default_mesh_config, sizeof(cfg)); 13236 memcpy(&setup, &default_mesh_setup, sizeof(setup)); 13237 13238 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) { 13239 /* and parse parameters if given */ 13240 err = nl80211_parse_mesh_config(info, &cfg, NULL); 13241 if (err) 13242 return err; 13243 } 13244 13245 if (!info->attrs[NL80211_ATTR_MESH_ID] || 13246 !nla_len(info->attrs[NL80211_ATTR_MESH_ID])) 13247 return -EINVAL; 13248 13249 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]); 13250 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 13251 13252 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 13253 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate, 13254 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 13255 return -EINVAL; 13256 13257 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) { 13258 setup.beacon_interval = 13259 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 13260 13261 err = cfg80211_validate_beacon_int(rdev, 13262 NL80211_IFTYPE_MESH_POINT, 13263 setup.beacon_interval); 13264 if (err) 13265 return err; 13266 } 13267 13268 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) { 13269 setup.dtim_period = 13270 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 13271 if (setup.dtim_period < 1 || setup.dtim_period > 100) 13272 return -EINVAL; 13273 } 13274 13275 if (info->attrs[NL80211_ATTR_MESH_SETUP]) { 13276 /* parse additional setup parameters if given */ 13277 err = nl80211_parse_mesh_setup(info, &setup); 13278 if (err) 13279 return err; 13280 } 13281 13282 if (setup.user_mpm) 13283 cfg.auto_open_plinks = false; 13284 13285 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 13286 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 13287 if (err) 13288 return err; 13289 } else { 13290 /* __cfg80211_join_mesh() will sort it out */ 13291 setup.chandef.chan = NULL; 13292 } 13293 13294 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 13295 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13296 int n_rates = 13297 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13298 struct ieee80211_supported_band *sband; 13299 13300 if (!setup.chandef.chan) 13301 return -EINVAL; 13302 13303 sband = rdev->wiphy.bands[setup.chandef.chan->band]; 13304 13305 err = ieee80211_get_ratemask(sband, rates, n_rates, 13306 &setup.basic_rates); 13307 if (err) 13308 return err; 13309 } 13310 13311 if (info->attrs[NL80211_ATTR_TX_RATES]) { 13312 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 13313 NL80211_ATTR_TX_RATES, 13314 &setup.beacon_rate, 13315 dev, false, 0); 13316 if (err) 13317 return err; 13318 13319 if (!setup.chandef.chan) 13320 return -EINVAL; 13321 13322 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band, 13323 &setup.beacon_rate); 13324 if (err) 13325 return err; 13326 } 13327 13328 setup.userspace_handles_dfs = 13329 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 13330 13331 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 13332 int r = validate_pae_over_nl80211(rdev, info); 13333 13334 if (r < 0) 13335 return r; 13336 13337 setup.control_port_over_nl80211 = true; 13338 } 13339 13340 err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg); 13341 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) 13342 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 13343 13344 return err; 13345 } 13346 13347 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info) 13348 { 13349 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13350 struct net_device *dev = info->user_ptr[1]; 13351 13352 return cfg80211_leave_mesh(rdev, dev); 13353 } 13354 13355 #ifdef CONFIG_PM 13356 static int nl80211_send_wowlan_patterns(struct sk_buff *msg, 13357 struct cfg80211_registered_device *rdev) 13358 { 13359 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config; 13360 struct nlattr *nl_pats, *nl_pat; 13361 int i, pat_len; 13362 13363 if (!wowlan->n_patterns) 13364 return 0; 13365 13366 nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN); 13367 if (!nl_pats) 13368 return -ENOBUFS; 13369 13370 for (i = 0; i < wowlan->n_patterns; i++) { 13371 nl_pat = nla_nest_start_noflag(msg, i + 1); 13372 if (!nl_pat) 13373 return -ENOBUFS; 13374 pat_len = wowlan->patterns[i].pattern_len; 13375 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8), 13376 wowlan->patterns[i].mask) || 13377 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 13378 wowlan->patterns[i].pattern) || 13379 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 13380 wowlan->patterns[i].pkt_offset)) 13381 return -ENOBUFS; 13382 nla_nest_end(msg, nl_pat); 13383 } 13384 nla_nest_end(msg, nl_pats); 13385 13386 return 0; 13387 } 13388 13389 static int nl80211_send_wowlan_tcp(struct sk_buff *msg, 13390 struct cfg80211_wowlan_tcp *tcp) 13391 { 13392 struct nlattr *nl_tcp; 13393 13394 if (!tcp) 13395 return 0; 13396 13397 nl_tcp = nla_nest_start_noflag(msg, 13398 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 13399 if (!nl_tcp) 13400 return -ENOBUFS; 13401 13402 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) || 13403 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) || 13404 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) || 13405 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) || 13406 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) || 13407 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 13408 tcp->payload_len, tcp->payload) || 13409 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 13410 tcp->data_interval) || 13411 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 13412 tcp->wake_len, tcp->wake_data) || 13413 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK, 13414 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask)) 13415 return -ENOBUFS; 13416 13417 if (tcp->payload_seq.len && 13418 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ, 13419 sizeof(tcp->payload_seq), &tcp->payload_seq)) 13420 return -ENOBUFS; 13421 13422 if (tcp->payload_tok.len && 13423 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 13424 sizeof(tcp->payload_tok) + tcp->tokens_size, 13425 &tcp->payload_tok)) 13426 return -ENOBUFS; 13427 13428 nla_nest_end(msg, nl_tcp); 13429 13430 return 0; 13431 } 13432 13433 static int nl80211_send_wowlan_nd(struct sk_buff *msg, 13434 struct cfg80211_sched_scan_request *req) 13435 { 13436 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan; 13437 int i; 13438 13439 if (!req) 13440 return 0; 13441 13442 nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT); 13443 if (!nd) 13444 return -ENOBUFS; 13445 13446 if (req->n_scan_plans == 1 && 13447 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL, 13448 req->scan_plans[0].interval * 1000)) 13449 return -ENOBUFS; 13450 13451 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay)) 13452 return -ENOBUFS; 13453 13454 if (req->relative_rssi_set) { 13455 struct nl80211_bss_select_rssi_adjust rssi_adjust; 13456 13457 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI, 13458 req->relative_rssi)) 13459 return -ENOBUFS; 13460 13461 rssi_adjust.band = req->rssi_adjust.band; 13462 rssi_adjust.delta = req->rssi_adjust.delta; 13463 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST, 13464 sizeof(rssi_adjust), &rssi_adjust)) 13465 return -ENOBUFS; 13466 } 13467 13468 freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 13469 if (!freqs) 13470 return -ENOBUFS; 13471 13472 for (i = 0; i < req->n_channels; i++) { 13473 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 13474 return -ENOBUFS; 13475 } 13476 13477 nla_nest_end(msg, freqs); 13478 13479 if (req->n_match_sets) { 13480 matches = nla_nest_start_noflag(msg, 13481 NL80211_ATTR_SCHED_SCAN_MATCH); 13482 if (!matches) 13483 return -ENOBUFS; 13484 13485 for (i = 0; i < req->n_match_sets; i++) { 13486 match = nla_nest_start_noflag(msg, i); 13487 if (!match) 13488 return -ENOBUFS; 13489 13490 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID, 13491 req->match_sets[i].ssid.ssid_len, 13492 req->match_sets[i].ssid.ssid)) 13493 return -ENOBUFS; 13494 nla_nest_end(msg, match); 13495 } 13496 nla_nest_end(msg, matches); 13497 } 13498 13499 scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS); 13500 if (!scan_plans) 13501 return -ENOBUFS; 13502 13503 for (i = 0; i < req->n_scan_plans; i++) { 13504 scan_plan = nla_nest_start_noflag(msg, i + 1); 13505 if (!scan_plan) 13506 return -ENOBUFS; 13507 13508 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL, 13509 req->scan_plans[i].interval) || 13510 (req->scan_plans[i].iterations && 13511 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS, 13512 req->scan_plans[i].iterations))) 13513 return -ENOBUFS; 13514 nla_nest_end(msg, scan_plan); 13515 } 13516 nla_nest_end(msg, scan_plans); 13517 13518 nla_nest_end(msg, nd); 13519 13520 return 0; 13521 } 13522 13523 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info) 13524 { 13525 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13526 struct sk_buff *msg; 13527 void *hdr; 13528 u32 size = NLMSG_DEFAULT_SIZE; 13529 13530 if (!rdev->wiphy.wowlan) 13531 return -EOPNOTSUPP; 13532 13533 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) { 13534 /* adjust size to have room for all the data */ 13535 size += rdev->wiphy.wowlan_config->tcp->tokens_size + 13536 rdev->wiphy.wowlan_config->tcp->payload_len + 13537 rdev->wiphy.wowlan_config->tcp->wake_len + 13538 rdev->wiphy.wowlan_config->tcp->wake_len / 8; 13539 } 13540 13541 msg = nlmsg_new(size, GFP_KERNEL); 13542 if (!msg) 13543 return -ENOMEM; 13544 13545 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13546 NL80211_CMD_GET_WOWLAN); 13547 if (!hdr) 13548 goto nla_put_failure; 13549 13550 if (rdev->wiphy.wowlan_config) { 13551 struct nlattr *nl_wowlan; 13552 13553 nl_wowlan = nla_nest_start_noflag(msg, 13554 NL80211_ATTR_WOWLAN_TRIGGERS); 13555 if (!nl_wowlan) 13556 goto nla_put_failure; 13557 13558 if ((rdev->wiphy.wowlan_config->any && 13559 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 13560 (rdev->wiphy.wowlan_config->disconnect && 13561 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 13562 (rdev->wiphy.wowlan_config->magic_pkt && 13563 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 13564 (rdev->wiphy.wowlan_config->gtk_rekey_failure && 13565 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 13566 (rdev->wiphy.wowlan_config->eap_identity_req && 13567 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 13568 (rdev->wiphy.wowlan_config->four_way_handshake && 13569 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 13570 (rdev->wiphy.wowlan_config->rfkill_release && 13571 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 13572 goto nla_put_failure; 13573 13574 if (nl80211_send_wowlan_patterns(msg, rdev)) 13575 goto nla_put_failure; 13576 13577 if (nl80211_send_wowlan_tcp(msg, 13578 rdev->wiphy.wowlan_config->tcp)) 13579 goto nla_put_failure; 13580 13581 if (nl80211_send_wowlan_nd( 13582 msg, 13583 rdev->wiphy.wowlan_config->nd_config)) 13584 goto nla_put_failure; 13585 13586 nla_nest_end(msg, nl_wowlan); 13587 } 13588 13589 genlmsg_end(msg, hdr); 13590 return genlmsg_reply(msg, info); 13591 13592 nla_put_failure: 13593 nlmsg_free(msg); 13594 return -ENOBUFS; 13595 } 13596 13597 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev, 13598 struct nlattr *attr, 13599 struct cfg80211_wowlan *trig) 13600 { 13601 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP]; 13602 struct cfg80211_wowlan_tcp *cfg; 13603 struct nl80211_wowlan_tcp_data_token *tok = NULL; 13604 struct nl80211_wowlan_tcp_data_seq *seq = NULL; 13605 u32 size; 13606 u32 data_size, wake_size, tokens_size = 0, wake_mask_size; 13607 int err, port; 13608 13609 if (!rdev->wiphy.wowlan->tcp) 13610 return -EINVAL; 13611 13612 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr, 13613 nl80211_wowlan_tcp_policy, NULL); 13614 if (err) 13615 return err; 13616 13617 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] || 13618 !tb[NL80211_WOWLAN_TCP_DST_IPV4] || 13619 !tb[NL80211_WOWLAN_TCP_DST_MAC] || 13620 !tb[NL80211_WOWLAN_TCP_DST_PORT] || 13621 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] || 13622 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] || 13623 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] || 13624 !tb[NL80211_WOWLAN_TCP_WAKE_MASK]) 13625 return -EINVAL; 13626 13627 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]); 13628 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max) 13629 return -EINVAL; 13630 13631 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) > 13632 rdev->wiphy.wowlan->tcp->data_interval_max || 13633 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0) 13634 return -EINVAL; 13635 13636 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]); 13637 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max) 13638 return -EINVAL; 13639 13640 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]); 13641 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8)) 13642 return -EINVAL; 13643 13644 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) { 13645 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13646 13647 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13648 tokens_size = tokln - sizeof(*tok); 13649 13650 if (!tok->len || tokens_size % tok->len) 13651 return -EINVAL; 13652 if (!rdev->wiphy.wowlan->tcp->tok) 13653 return -EINVAL; 13654 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len) 13655 return -EINVAL; 13656 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len) 13657 return -EINVAL; 13658 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize) 13659 return -EINVAL; 13660 if (tok->offset + tok->len > data_size) 13661 return -EINVAL; 13662 } 13663 13664 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) { 13665 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]); 13666 if (!rdev->wiphy.wowlan->tcp->seq) 13667 return -EINVAL; 13668 if (seq->len == 0 || seq->len > 4) 13669 return -EINVAL; 13670 if (seq->len + seq->offset > data_size) 13671 return -EINVAL; 13672 } 13673 13674 size = sizeof(*cfg); 13675 size += data_size; 13676 size += wake_size + wake_mask_size; 13677 size += tokens_size; 13678 13679 cfg = kzalloc(size, GFP_KERNEL); 13680 if (!cfg) 13681 return -ENOMEM; 13682 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]); 13683 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]); 13684 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]), 13685 ETH_ALEN); 13686 port = nla_get_u16_default(tb[NL80211_WOWLAN_TCP_SRC_PORT], 0); 13687 #ifdef CONFIG_INET 13688 /* allocate a socket and port for it and use it */ 13689 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM, 13690 IPPROTO_TCP, &cfg->sock, 1); 13691 if (err) { 13692 kfree(cfg); 13693 return err; 13694 } 13695 if (inet_csk_get_port(cfg->sock->sk, port)) { 13696 sock_release(cfg->sock); 13697 kfree(cfg); 13698 return -EADDRINUSE; 13699 } 13700 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num; 13701 #else 13702 if (!port) { 13703 kfree(cfg); 13704 return -EINVAL; 13705 } 13706 cfg->src_port = port; 13707 #endif 13708 13709 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]); 13710 cfg->payload_len = data_size; 13711 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size; 13712 memcpy((void *)cfg->payload, 13713 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]), 13714 data_size); 13715 if (seq) 13716 cfg->payload_seq = *seq; 13717 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]); 13718 cfg->wake_len = wake_size; 13719 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size; 13720 memcpy((void *)cfg->wake_data, 13721 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]), 13722 wake_size); 13723 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size + 13724 data_size + wake_size; 13725 memcpy((void *)cfg->wake_mask, 13726 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]), 13727 wake_mask_size); 13728 if (tok) { 13729 cfg->tokens_size = tokens_size; 13730 cfg->payload_tok = *tok; 13731 memcpy(cfg->payload_tok.token_stream, tok->token_stream, 13732 tokens_size); 13733 } 13734 13735 trig->tcp = cfg; 13736 13737 return 0; 13738 } 13739 13740 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev, 13741 const struct wiphy_wowlan_support *wowlan, 13742 struct nlattr *attr, 13743 struct cfg80211_wowlan *trig) 13744 { 13745 struct nlattr **tb; 13746 int err; 13747 13748 tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 13749 if (!tb) 13750 return -ENOMEM; 13751 13752 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) { 13753 err = -EOPNOTSUPP; 13754 goto out; 13755 } 13756 13757 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr, 13758 nl80211_policy, NULL); 13759 if (err) 13760 goto out; 13761 13762 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb, 13763 wowlan->max_nd_match_sets); 13764 err = PTR_ERR_OR_ZERO(trig->nd_config); 13765 if (err) 13766 trig->nd_config = NULL; 13767 13768 out: 13769 kfree(tb); 13770 return err; 13771 } 13772 13773 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info) 13774 { 13775 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13776 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG]; 13777 struct cfg80211_wowlan new_triggers = {}; 13778 struct cfg80211_wowlan *ntrig; 13779 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan; 13780 int err, i; 13781 bool prev_enabled = rdev->wiphy.wowlan_config; 13782 bool regular = false; 13783 13784 if (!wowlan) 13785 return -EOPNOTSUPP; 13786 13787 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) { 13788 cfg80211_rdev_free_wowlan(rdev); 13789 rdev->wiphy.wowlan_config = NULL; 13790 goto set_wakeup; 13791 } 13792 13793 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG, 13794 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS], 13795 nl80211_wowlan_policy, info->extack); 13796 if (err) 13797 return err; 13798 13799 if (tb[NL80211_WOWLAN_TRIG_ANY]) { 13800 if (!(wowlan->flags & WIPHY_WOWLAN_ANY)) 13801 return -EINVAL; 13802 new_triggers.any = true; 13803 } 13804 13805 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) { 13806 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT)) 13807 return -EINVAL; 13808 new_triggers.disconnect = true; 13809 regular = true; 13810 } 13811 13812 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) { 13813 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT)) 13814 return -EINVAL; 13815 new_triggers.magic_pkt = true; 13816 regular = true; 13817 } 13818 13819 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED]) 13820 return -EINVAL; 13821 13822 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) { 13823 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE)) 13824 return -EINVAL; 13825 new_triggers.gtk_rekey_failure = true; 13826 regular = true; 13827 } 13828 13829 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) { 13830 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ)) 13831 return -EINVAL; 13832 new_triggers.eap_identity_req = true; 13833 regular = true; 13834 } 13835 13836 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) { 13837 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE)) 13838 return -EINVAL; 13839 new_triggers.four_way_handshake = true; 13840 regular = true; 13841 } 13842 13843 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) { 13844 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE)) 13845 return -EINVAL; 13846 new_triggers.rfkill_release = true; 13847 regular = true; 13848 } 13849 13850 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) { 13851 struct nlattr *pat; 13852 int n_patterns = 0; 13853 int rem, pat_len, mask_len, pkt_offset; 13854 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 13855 13856 regular = true; 13857 13858 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13859 rem) 13860 n_patterns++; 13861 if (n_patterns > wowlan->n_patterns) 13862 return -EINVAL; 13863 13864 new_triggers.patterns = kcalloc(n_patterns, 13865 sizeof(new_triggers.patterns[0]), 13866 GFP_KERNEL); 13867 if (!new_triggers.patterns) 13868 return -ENOMEM; 13869 13870 new_triggers.n_patterns = n_patterns; 13871 i = 0; 13872 13873 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13874 rem) { 13875 u8 *mask_pat; 13876 13877 err = nla_parse_nested_deprecated(pat_tb, 13878 MAX_NL80211_PKTPAT, 13879 pat, 13880 nl80211_packet_pattern_policy, 13881 info->extack); 13882 if (err) 13883 goto error; 13884 13885 err = -EINVAL; 13886 if (!pat_tb[NL80211_PKTPAT_MASK] || 13887 !pat_tb[NL80211_PKTPAT_PATTERN]) 13888 goto error; 13889 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 13890 mask_len = DIV_ROUND_UP(pat_len, 8); 13891 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 13892 goto error; 13893 if (pat_len > wowlan->pattern_max_len || 13894 pat_len < wowlan->pattern_min_len) 13895 goto error; 13896 13897 pkt_offset = 13898 nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET], 13899 0); 13900 if (pkt_offset > wowlan->max_pkt_offset) 13901 goto error; 13902 new_triggers.patterns[i].pkt_offset = pkt_offset; 13903 13904 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 13905 if (!mask_pat) { 13906 err = -ENOMEM; 13907 goto error; 13908 } 13909 new_triggers.patterns[i].mask = mask_pat; 13910 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 13911 mask_len); 13912 mask_pat += mask_len; 13913 new_triggers.patterns[i].pattern = mask_pat; 13914 new_triggers.patterns[i].pattern_len = pat_len; 13915 memcpy(mask_pat, 13916 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 13917 pat_len); 13918 i++; 13919 } 13920 } 13921 13922 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) { 13923 regular = true; 13924 err = nl80211_parse_wowlan_tcp( 13925 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION], 13926 &new_triggers); 13927 if (err) 13928 goto error; 13929 } 13930 13931 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) { 13932 regular = true; 13933 err = nl80211_parse_wowlan_nd( 13934 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT], 13935 &new_triggers); 13936 if (err) 13937 goto error; 13938 } 13939 13940 /* The 'any' trigger means the device continues operating more or less 13941 * as in its normal operation mode and wakes up the host on most of the 13942 * normal interrupts (like packet RX, ...) 13943 * It therefore makes little sense to combine with the more constrained 13944 * wakeup trigger modes. 13945 */ 13946 if (new_triggers.any && regular) { 13947 err = -EINVAL; 13948 goto error; 13949 } 13950 13951 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL); 13952 if (!ntrig) { 13953 err = -ENOMEM; 13954 goto error; 13955 } 13956 cfg80211_rdev_free_wowlan(rdev); 13957 rdev->wiphy.wowlan_config = ntrig; 13958 13959 set_wakeup: 13960 if (rdev->ops->set_wakeup && 13961 prev_enabled != !!rdev->wiphy.wowlan_config) 13962 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config); 13963 13964 return 0; 13965 error: 13966 for (i = 0; i < new_triggers.n_patterns; i++) 13967 kfree(new_triggers.patterns[i].mask); 13968 kfree(new_triggers.patterns); 13969 if (new_triggers.tcp && new_triggers.tcp->sock) 13970 sock_release(new_triggers.tcp->sock); 13971 kfree(new_triggers.tcp); 13972 kfree(new_triggers.nd_config); 13973 return err; 13974 } 13975 #endif 13976 13977 static int nl80211_send_coalesce_rules(struct sk_buff *msg, 13978 struct cfg80211_registered_device *rdev) 13979 { 13980 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules; 13981 int i, j, pat_len; 13982 struct cfg80211_coalesce_rules *rule; 13983 13984 if (!rdev->coalesce->n_rules) 13985 return 0; 13986 13987 nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE); 13988 if (!nl_rules) 13989 return -ENOBUFS; 13990 13991 for (i = 0; i < rdev->coalesce->n_rules; i++) { 13992 nl_rule = nla_nest_start_noflag(msg, i + 1); 13993 if (!nl_rule) 13994 return -ENOBUFS; 13995 13996 rule = &rdev->coalesce->rules[i]; 13997 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY, 13998 rule->delay)) 13999 return -ENOBUFS; 14000 14001 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION, 14002 rule->condition)) 14003 return -ENOBUFS; 14004 14005 nl_pats = nla_nest_start_noflag(msg, 14006 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN); 14007 if (!nl_pats) 14008 return -ENOBUFS; 14009 14010 for (j = 0; j < rule->n_patterns; j++) { 14011 nl_pat = nla_nest_start_noflag(msg, j + 1); 14012 if (!nl_pat) 14013 return -ENOBUFS; 14014 pat_len = rule->patterns[j].pattern_len; 14015 if (nla_put(msg, NL80211_PKTPAT_MASK, 14016 DIV_ROUND_UP(pat_len, 8), 14017 rule->patterns[j].mask) || 14018 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 14019 rule->patterns[j].pattern) || 14020 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 14021 rule->patterns[j].pkt_offset)) 14022 return -ENOBUFS; 14023 nla_nest_end(msg, nl_pat); 14024 } 14025 nla_nest_end(msg, nl_pats); 14026 nla_nest_end(msg, nl_rule); 14027 } 14028 nla_nest_end(msg, nl_rules); 14029 14030 return 0; 14031 } 14032 14033 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info) 14034 { 14035 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14036 struct sk_buff *msg; 14037 void *hdr; 14038 14039 if (!rdev->wiphy.coalesce) 14040 return -EOPNOTSUPP; 14041 14042 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14043 if (!msg) 14044 return -ENOMEM; 14045 14046 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14047 NL80211_CMD_GET_COALESCE); 14048 if (!hdr) 14049 goto nla_put_failure; 14050 14051 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev)) 14052 goto nla_put_failure; 14053 14054 genlmsg_end(msg, hdr); 14055 return genlmsg_reply(msg, info); 14056 14057 nla_put_failure: 14058 nlmsg_free(msg); 14059 return -ENOBUFS; 14060 } 14061 14062 void cfg80211_free_coalesce(struct cfg80211_coalesce *coalesce) 14063 { 14064 int i, j; 14065 struct cfg80211_coalesce_rules *rule; 14066 14067 if (!coalesce) 14068 return; 14069 14070 for (i = 0; i < coalesce->n_rules; i++) { 14071 rule = &coalesce->rules[i]; 14072 for (j = 0; j < rule->n_patterns; j++) 14073 kfree(rule->patterns[j].mask); 14074 kfree(rule->patterns); 14075 } 14076 kfree(coalesce); 14077 } 14078 14079 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev, 14080 struct nlattr *rule, 14081 struct cfg80211_coalesce_rules *new_rule) 14082 { 14083 int err, i; 14084 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 14085 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat; 14086 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0; 14087 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 14088 14089 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX, 14090 rule, nl80211_coalesce_policy, NULL); 14091 if (err) 14092 return err; 14093 14094 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY]) 14095 new_rule->delay = 14096 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]); 14097 if (new_rule->delay > coalesce->max_delay) 14098 return -EINVAL; 14099 14100 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION]) 14101 new_rule->condition = 14102 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]); 14103 14104 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN]) 14105 return -EINVAL; 14106 14107 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 14108 rem) 14109 n_patterns++; 14110 if (n_patterns > coalesce->n_patterns) 14111 return -EINVAL; 14112 14113 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]), 14114 GFP_KERNEL); 14115 if (!new_rule->patterns) 14116 return -ENOMEM; 14117 14118 new_rule->n_patterns = n_patterns; 14119 i = 0; 14120 14121 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 14122 rem) { 14123 u8 *mask_pat; 14124 14125 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT, 14126 pat, 14127 nl80211_packet_pattern_policy, 14128 NULL); 14129 if (err) 14130 return err; 14131 14132 if (!pat_tb[NL80211_PKTPAT_MASK] || 14133 !pat_tb[NL80211_PKTPAT_PATTERN]) 14134 return -EINVAL; 14135 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 14136 mask_len = DIV_ROUND_UP(pat_len, 8); 14137 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 14138 return -EINVAL; 14139 if (pat_len > coalesce->pattern_max_len || 14140 pat_len < coalesce->pattern_min_len) 14141 return -EINVAL; 14142 14143 pkt_offset = nla_get_u32_default(pat_tb[NL80211_PKTPAT_OFFSET], 14144 0); 14145 if (pkt_offset > coalesce->max_pkt_offset) 14146 return -EINVAL; 14147 new_rule->patterns[i].pkt_offset = pkt_offset; 14148 14149 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 14150 if (!mask_pat) 14151 return -ENOMEM; 14152 14153 new_rule->patterns[i].mask = mask_pat; 14154 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 14155 mask_len); 14156 14157 mask_pat += mask_len; 14158 new_rule->patterns[i].pattern = mask_pat; 14159 new_rule->patterns[i].pattern_len = pat_len; 14160 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 14161 pat_len); 14162 i++; 14163 } 14164 14165 return 0; 14166 } 14167 14168 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info) 14169 { 14170 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14171 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 14172 struct cfg80211_coalesce *new_coalesce; 14173 int err, rem_rule, n_rules = 0, i; 14174 struct nlattr *rule; 14175 14176 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce) 14177 return -EOPNOTSUPP; 14178 14179 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) { 14180 cfg80211_free_coalesce(rdev->coalesce); 14181 rdev->coalesce = NULL; 14182 rdev_set_coalesce(rdev, NULL); 14183 return 0; 14184 } 14185 14186 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 14187 rem_rule) 14188 n_rules++; 14189 if (n_rules > coalesce->n_rules) 14190 return -EINVAL; 14191 14192 new_coalesce = kzalloc(struct_size(new_coalesce, rules, n_rules), 14193 GFP_KERNEL); 14194 if (!new_coalesce) 14195 return -ENOMEM; 14196 14197 new_coalesce->n_rules = n_rules; 14198 i = 0; 14199 14200 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 14201 rem_rule) { 14202 err = nl80211_parse_coalesce_rule(rdev, rule, 14203 &new_coalesce->rules[i]); 14204 if (err) 14205 goto error; 14206 14207 i++; 14208 } 14209 14210 err = rdev_set_coalesce(rdev, new_coalesce); 14211 if (err) 14212 goto error; 14213 14214 cfg80211_free_coalesce(rdev->coalesce); 14215 rdev->coalesce = new_coalesce; 14216 14217 return 0; 14218 error: 14219 cfg80211_free_coalesce(new_coalesce); 14220 14221 return err; 14222 } 14223 14224 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info) 14225 { 14226 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14227 struct net_device *dev = info->user_ptr[1]; 14228 struct wireless_dev *wdev = dev->ieee80211_ptr; 14229 struct nlattr *tb[NUM_NL80211_REKEY_DATA]; 14230 struct cfg80211_gtk_rekey_data rekey_data = {}; 14231 int err; 14232 14233 if (!info->attrs[NL80211_ATTR_REKEY_DATA]) 14234 return -EINVAL; 14235 14236 err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA, 14237 info->attrs[NL80211_ATTR_REKEY_DATA], 14238 nl80211_rekey_policy, info->extack); 14239 if (err) 14240 return err; 14241 14242 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] || 14243 !tb[NL80211_REKEY_DATA_KCK]) 14244 return -EINVAL; 14245 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN && 14246 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14247 nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN)) 14248 return -ERANGE; 14249 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN && 14250 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14251 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) && 14252 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 && 14253 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32)) 14254 return -ERANGE; 14255 14256 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]); 14257 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]); 14258 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]); 14259 rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]); 14260 rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]); 14261 if (tb[NL80211_REKEY_DATA_AKM]) 14262 rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]); 14263 14264 if (!wdev->connected) 14265 return -ENOTCONN; 14266 14267 if (!rdev->ops->set_rekey_data) 14268 return -EOPNOTSUPP; 14269 14270 return rdev_set_rekey_data(rdev, dev, &rekey_data); 14271 } 14272 14273 static int nl80211_register_unexpected_frame(struct sk_buff *skb, 14274 struct genl_info *info) 14275 { 14276 struct net_device *dev = info->user_ptr[1]; 14277 struct wireless_dev *wdev = dev->ieee80211_ptr; 14278 14279 if (wdev->iftype != NL80211_IFTYPE_AP && 14280 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14281 return -EINVAL; 14282 14283 if (wdev->ap_unexpected_nlportid) 14284 return -EBUSY; 14285 14286 wdev->ap_unexpected_nlportid = info->snd_portid; 14287 return 0; 14288 } 14289 14290 static int nl80211_probe_client(struct sk_buff *skb, 14291 struct genl_info *info) 14292 { 14293 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14294 struct net_device *dev = info->user_ptr[1]; 14295 struct wireless_dev *wdev = dev->ieee80211_ptr; 14296 struct sk_buff *msg; 14297 void *hdr; 14298 const u8 *addr; 14299 u64 cookie; 14300 int err; 14301 14302 if (wdev->iftype != NL80211_IFTYPE_AP && 14303 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14304 return -EOPNOTSUPP; 14305 14306 if (!info->attrs[NL80211_ATTR_MAC]) 14307 return -EINVAL; 14308 14309 if (!rdev->ops->probe_client) 14310 return -EOPNOTSUPP; 14311 14312 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14313 if (!msg) 14314 return -ENOMEM; 14315 14316 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14317 NL80211_CMD_PROBE_CLIENT); 14318 if (!hdr) { 14319 err = -ENOBUFS; 14320 goto free_msg; 14321 } 14322 14323 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 14324 14325 err = rdev_probe_client(rdev, dev, addr, &cookie); 14326 if (err) 14327 goto free_msg; 14328 14329 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14330 NL80211_ATTR_PAD)) 14331 goto nla_put_failure; 14332 14333 genlmsg_end(msg, hdr); 14334 14335 return genlmsg_reply(msg, info); 14336 14337 nla_put_failure: 14338 err = -ENOBUFS; 14339 free_msg: 14340 nlmsg_free(msg); 14341 return err; 14342 } 14343 14344 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info) 14345 { 14346 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14347 struct cfg80211_beacon_registration *reg, *nreg; 14348 int rv; 14349 14350 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS)) 14351 return -EOPNOTSUPP; 14352 14353 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL); 14354 if (!nreg) 14355 return -ENOMEM; 14356 14357 /* First, check if already registered. */ 14358 spin_lock_bh(&rdev->beacon_registrations_lock); 14359 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 14360 if (reg->nlportid == info->snd_portid) { 14361 rv = -EALREADY; 14362 goto out_err; 14363 } 14364 } 14365 /* Add it to the list */ 14366 nreg->nlportid = info->snd_portid; 14367 list_add(&nreg->list, &rdev->beacon_registrations); 14368 14369 spin_unlock_bh(&rdev->beacon_registrations_lock); 14370 14371 return 0; 14372 out_err: 14373 spin_unlock_bh(&rdev->beacon_registrations_lock); 14374 kfree(nreg); 14375 return rv; 14376 } 14377 14378 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info) 14379 { 14380 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14381 struct wireless_dev *wdev = info->user_ptr[1]; 14382 int err; 14383 14384 if (!rdev->ops->start_p2p_device) 14385 return -EOPNOTSUPP; 14386 14387 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14388 return -EOPNOTSUPP; 14389 14390 if (wdev_running(wdev)) 14391 return 0; 14392 14393 if (rfkill_blocked(rdev->wiphy.rfkill)) 14394 return -ERFKILL; 14395 14396 err = rdev_start_p2p_device(rdev, wdev); 14397 if (err) 14398 return err; 14399 14400 wdev->is_running = true; 14401 rdev->opencount++; 14402 14403 return 0; 14404 } 14405 14406 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info) 14407 { 14408 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14409 struct wireless_dev *wdev = info->user_ptr[1]; 14410 14411 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14412 return -EOPNOTSUPP; 14413 14414 if (!rdev->ops->stop_p2p_device) 14415 return -EOPNOTSUPP; 14416 14417 cfg80211_stop_p2p_device(rdev, wdev); 14418 14419 return 0; 14420 } 14421 14422 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info) 14423 { 14424 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14425 struct wireless_dev *wdev = info->user_ptr[1]; 14426 struct cfg80211_nan_conf conf = {}; 14427 int err; 14428 14429 if (wdev->iftype != NL80211_IFTYPE_NAN) 14430 return -EOPNOTSUPP; 14431 14432 if (wdev_running(wdev)) 14433 return -EEXIST; 14434 14435 if (rfkill_blocked(rdev->wiphy.rfkill)) 14436 return -ERFKILL; 14437 14438 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) 14439 return -EINVAL; 14440 14441 conf.master_pref = 14442 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14443 14444 if (info->attrs[NL80211_ATTR_BANDS]) { 14445 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14446 14447 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14448 return -EOPNOTSUPP; 14449 14450 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14451 return -EINVAL; 14452 14453 conf.bands = bands; 14454 } 14455 14456 err = rdev_start_nan(rdev, wdev, &conf); 14457 if (err) 14458 return err; 14459 14460 wdev->is_running = true; 14461 rdev->opencount++; 14462 14463 return 0; 14464 } 14465 14466 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info) 14467 { 14468 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14469 struct wireless_dev *wdev = info->user_ptr[1]; 14470 14471 if (wdev->iftype != NL80211_IFTYPE_NAN) 14472 return -EOPNOTSUPP; 14473 14474 cfg80211_stop_nan(rdev, wdev); 14475 14476 return 0; 14477 } 14478 14479 static int validate_nan_filter(struct nlattr *filter_attr) 14480 { 14481 struct nlattr *attr; 14482 int len = 0, n_entries = 0, rem; 14483 14484 nla_for_each_nested(attr, filter_attr, rem) { 14485 len += nla_len(attr); 14486 n_entries++; 14487 } 14488 14489 if (len >= U8_MAX) 14490 return -EINVAL; 14491 14492 return n_entries; 14493 } 14494 14495 static int handle_nan_filter(struct nlattr *attr_filter, 14496 struct cfg80211_nan_func *func, 14497 bool tx) 14498 { 14499 struct nlattr *attr; 14500 int n_entries, rem, i; 14501 struct cfg80211_nan_func_filter *filter; 14502 14503 n_entries = validate_nan_filter(attr_filter); 14504 if (n_entries < 0) 14505 return n_entries; 14506 14507 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters)); 14508 14509 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL); 14510 if (!filter) 14511 return -ENOMEM; 14512 14513 i = 0; 14514 nla_for_each_nested(attr, attr_filter, rem) { 14515 filter[i].filter = nla_memdup(attr, GFP_KERNEL); 14516 if (!filter[i].filter) 14517 goto err; 14518 14519 filter[i].len = nla_len(attr); 14520 i++; 14521 } 14522 if (tx) { 14523 func->num_tx_filters = n_entries; 14524 func->tx_filters = filter; 14525 } else { 14526 func->num_rx_filters = n_entries; 14527 func->rx_filters = filter; 14528 } 14529 14530 return 0; 14531 14532 err: 14533 i = 0; 14534 nla_for_each_nested(attr, attr_filter, rem) { 14535 kfree(filter[i].filter); 14536 i++; 14537 } 14538 kfree(filter); 14539 return -ENOMEM; 14540 } 14541 14542 static int nl80211_nan_add_func(struct sk_buff *skb, 14543 struct genl_info *info) 14544 { 14545 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14546 struct wireless_dev *wdev = info->user_ptr[1]; 14547 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr; 14548 struct cfg80211_nan_func *func; 14549 struct sk_buff *msg = NULL; 14550 void *hdr = NULL; 14551 int err = 0; 14552 14553 if (wdev->iftype != NL80211_IFTYPE_NAN) 14554 return -EOPNOTSUPP; 14555 14556 if (!wdev_running(wdev)) 14557 return -ENOTCONN; 14558 14559 if (!info->attrs[NL80211_ATTR_NAN_FUNC]) 14560 return -EINVAL; 14561 14562 err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX, 14563 info->attrs[NL80211_ATTR_NAN_FUNC], 14564 nl80211_nan_func_policy, 14565 info->extack); 14566 if (err) 14567 return err; 14568 14569 func = kzalloc(sizeof(*func), GFP_KERNEL); 14570 if (!func) 14571 return -ENOMEM; 14572 14573 func->cookie = cfg80211_assign_cookie(rdev); 14574 14575 if (!tb[NL80211_NAN_FUNC_TYPE]) { 14576 err = -EINVAL; 14577 goto out; 14578 } 14579 14580 14581 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]); 14582 14583 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) { 14584 err = -EINVAL; 14585 goto out; 14586 } 14587 14588 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]), 14589 sizeof(func->service_id)); 14590 14591 func->close_range = 14592 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]); 14593 14594 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) { 14595 func->serv_spec_info_len = 14596 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]); 14597 func->serv_spec_info = 14598 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]), 14599 func->serv_spec_info_len, 14600 GFP_KERNEL); 14601 if (!func->serv_spec_info) { 14602 err = -ENOMEM; 14603 goto out; 14604 } 14605 } 14606 14607 if (tb[NL80211_NAN_FUNC_TTL]) 14608 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]); 14609 14610 switch (func->type) { 14611 case NL80211_NAN_FUNC_PUBLISH: 14612 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) { 14613 err = -EINVAL; 14614 goto out; 14615 } 14616 14617 func->publish_type = 14618 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]); 14619 func->publish_bcast = 14620 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]); 14621 14622 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) && 14623 func->publish_bcast) { 14624 err = -EINVAL; 14625 goto out; 14626 } 14627 break; 14628 case NL80211_NAN_FUNC_SUBSCRIBE: 14629 func->subscribe_active = 14630 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]); 14631 break; 14632 case NL80211_NAN_FUNC_FOLLOW_UP: 14633 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] || 14634 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] || 14635 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) { 14636 err = -EINVAL; 14637 goto out; 14638 } 14639 14640 func->followup_id = 14641 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]); 14642 func->followup_reqid = 14643 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]); 14644 memcpy(func->followup_dest.addr, 14645 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]), 14646 sizeof(func->followup_dest.addr)); 14647 if (func->ttl) { 14648 err = -EINVAL; 14649 goto out; 14650 } 14651 break; 14652 default: 14653 err = -EINVAL; 14654 goto out; 14655 } 14656 14657 if (tb[NL80211_NAN_FUNC_SRF]) { 14658 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR]; 14659 14660 err = nla_parse_nested_deprecated(srf_tb, 14661 NL80211_NAN_SRF_ATTR_MAX, 14662 tb[NL80211_NAN_FUNC_SRF], 14663 nl80211_nan_srf_policy, 14664 info->extack); 14665 if (err) 14666 goto out; 14667 14668 func->srf_include = 14669 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]); 14670 14671 if (srf_tb[NL80211_NAN_SRF_BF]) { 14672 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] || 14673 !srf_tb[NL80211_NAN_SRF_BF_IDX]) { 14674 err = -EINVAL; 14675 goto out; 14676 } 14677 14678 func->srf_bf_len = 14679 nla_len(srf_tb[NL80211_NAN_SRF_BF]); 14680 func->srf_bf = 14681 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]), 14682 func->srf_bf_len, GFP_KERNEL); 14683 if (!func->srf_bf) { 14684 err = -ENOMEM; 14685 goto out; 14686 } 14687 14688 func->srf_bf_idx = 14689 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]); 14690 } else { 14691 struct nlattr *attr, *mac_attr = 14692 srf_tb[NL80211_NAN_SRF_MAC_ADDRS]; 14693 int n_entries, rem, i = 0; 14694 14695 if (!mac_attr) { 14696 err = -EINVAL; 14697 goto out; 14698 } 14699 14700 n_entries = validate_acl_mac_addrs(mac_attr); 14701 if (n_entries <= 0) { 14702 err = -EINVAL; 14703 goto out; 14704 } 14705 14706 func->srf_num_macs = n_entries; 14707 func->srf_macs = 14708 kcalloc(n_entries, sizeof(*func->srf_macs), 14709 GFP_KERNEL); 14710 if (!func->srf_macs) { 14711 err = -ENOMEM; 14712 goto out; 14713 } 14714 14715 nla_for_each_nested(attr, mac_attr, rem) 14716 memcpy(func->srf_macs[i++].addr, nla_data(attr), 14717 sizeof(*func->srf_macs)); 14718 } 14719 } 14720 14721 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) { 14722 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER], 14723 func, true); 14724 if (err) 14725 goto out; 14726 } 14727 14728 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) { 14729 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER], 14730 func, false); 14731 if (err) 14732 goto out; 14733 } 14734 14735 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14736 if (!msg) { 14737 err = -ENOMEM; 14738 goto out; 14739 } 14740 14741 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14742 NL80211_CMD_ADD_NAN_FUNCTION); 14743 /* This can't really happen - we just allocated 4KB */ 14744 if (WARN_ON(!hdr)) { 14745 err = -ENOMEM; 14746 goto out; 14747 } 14748 14749 err = rdev_add_nan_func(rdev, wdev, func); 14750 out: 14751 if (err < 0) { 14752 cfg80211_free_nan_func(func); 14753 nlmsg_free(msg); 14754 return err; 14755 } 14756 14757 /* propagate the instance id and cookie to userspace */ 14758 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie, 14759 NL80211_ATTR_PAD)) 14760 goto nla_put_failure; 14761 14762 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14763 if (!func_attr) 14764 goto nla_put_failure; 14765 14766 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, 14767 func->instance_id)) 14768 goto nla_put_failure; 14769 14770 nla_nest_end(msg, func_attr); 14771 14772 genlmsg_end(msg, hdr); 14773 return genlmsg_reply(msg, info); 14774 14775 nla_put_failure: 14776 nlmsg_free(msg); 14777 return -ENOBUFS; 14778 } 14779 14780 static int nl80211_nan_del_func(struct sk_buff *skb, 14781 struct genl_info *info) 14782 { 14783 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14784 struct wireless_dev *wdev = info->user_ptr[1]; 14785 u64 cookie; 14786 14787 if (wdev->iftype != NL80211_IFTYPE_NAN) 14788 return -EOPNOTSUPP; 14789 14790 if (!wdev_running(wdev)) 14791 return -ENOTCONN; 14792 14793 if (!info->attrs[NL80211_ATTR_COOKIE]) 14794 return -EINVAL; 14795 14796 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 14797 14798 rdev_del_nan_func(rdev, wdev, cookie); 14799 14800 return 0; 14801 } 14802 14803 static int nl80211_nan_change_config(struct sk_buff *skb, 14804 struct genl_info *info) 14805 { 14806 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14807 struct wireless_dev *wdev = info->user_ptr[1]; 14808 struct cfg80211_nan_conf conf = {}; 14809 u32 changed = 0; 14810 14811 if (wdev->iftype != NL80211_IFTYPE_NAN) 14812 return -EOPNOTSUPP; 14813 14814 if (!wdev_running(wdev)) 14815 return -ENOTCONN; 14816 14817 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) { 14818 conf.master_pref = 14819 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14820 if (conf.master_pref <= 1 || conf.master_pref == 255) 14821 return -EINVAL; 14822 14823 changed |= CFG80211_NAN_CONF_CHANGED_PREF; 14824 } 14825 14826 if (info->attrs[NL80211_ATTR_BANDS]) { 14827 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14828 14829 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14830 return -EOPNOTSUPP; 14831 14832 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14833 return -EINVAL; 14834 14835 conf.bands = bands; 14836 changed |= CFG80211_NAN_CONF_CHANGED_BANDS; 14837 } 14838 14839 if (!changed) 14840 return -EINVAL; 14841 14842 return rdev_nan_change_conf(rdev, wdev, &conf, changed); 14843 } 14844 14845 void cfg80211_nan_match(struct wireless_dev *wdev, 14846 struct cfg80211_nan_match_params *match, gfp_t gfp) 14847 { 14848 struct wiphy *wiphy = wdev->wiphy; 14849 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14850 struct nlattr *match_attr, *local_func_attr, *peer_func_attr; 14851 struct sk_buff *msg; 14852 void *hdr; 14853 14854 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr)) 14855 return; 14856 14857 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14858 if (!msg) 14859 return; 14860 14861 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH); 14862 if (!hdr) { 14863 nlmsg_free(msg); 14864 return; 14865 } 14866 14867 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14868 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14869 wdev->netdev->ifindex)) || 14870 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14871 NL80211_ATTR_PAD)) 14872 goto nla_put_failure; 14873 14874 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie, 14875 NL80211_ATTR_PAD) || 14876 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr)) 14877 goto nla_put_failure; 14878 14879 match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH); 14880 if (!match_attr) 14881 goto nla_put_failure; 14882 14883 local_func_attr = nla_nest_start_noflag(msg, 14884 NL80211_NAN_MATCH_FUNC_LOCAL); 14885 if (!local_func_attr) 14886 goto nla_put_failure; 14887 14888 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id)) 14889 goto nla_put_failure; 14890 14891 nla_nest_end(msg, local_func_attr); 14892 14893 peer_func_attr = nla_nest_start_noflag(msg, 14894 NL80211_NAN_MATCH_FUNC_PEER); 14895 if (!peer_func_attr) 14896 goto nla_put_failure; 14897 14898 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) || 14899 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id)) 14900 goto nla_put_failure; 14901 14902 if (match->info && match->info_len && 14903 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len, 14904 match->info)) 14905 goto nla_put_failure; 14906 14907 nla_nest_end(msg, peer_func_attr); 14908 nla_nest_end(msg, match_attr); 14909 genlmsg_end(msg, hdr); 14910 14911 if (!wdev->owner_nlportid) 14912 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14913 msg, 0, NL80211_MCGRP_NAN, gfp); 14914 else 14915 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14916 wdev->owner_nlportid); 14917 14918 return; 14919 14920 nla_put_failure: 14921 nlmsg_free(msg); 14922 } 14923 EXPORT_SYMBOL(cfg80211_nan_match); 14924 14925 void cfg80211_nan_func_terminated(struct wireless_dev *wdev, 14926 u8 inst_id, 14927 enum nl80211_nan_func_term_reason reason, 14928 u64 cookie, gfp_t gfp) 14929 { 14930 struct wiphy *wiphy = wdev->wiphy; 14931 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14932 struct sk_buff *msg; 14933 struct nlattr *func_attr; 14934 void *hdr; 14935 14936 if (WARN_ON(!inst_id)) 14937 return; 14938 14939 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14940 if (!msg) 14941 return; 14942 14943 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION); 14944 if (!hdr) { 14945 nlmsg_free(msg); 14946 return; 14947 } 14948 14949 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14950 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14951 wdev->netdev->ifindex)) || 14952 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14953 NL80211_ATTR_PAD)) 14954 goto nla_put_failure; 14955 14956 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14957 NL80211_ATTR_PAD)) 14958 goto nla_put_failure; 14959 14960 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14961 if (!func_attr) 14962 goto nla_put_failure; 14963 14964 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) || 14965 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason)) 14966 goto nla_put_failure; 14967 14968 nla_nest_end(msg, func_attr); 14969 genlmsg_end(msg, hdr); 14970 14971 if (!wdev->owner_nlportid) 14972 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14973 msg, 0, NL80211_MCGRP_NAN, gfp); 14974 else 14975 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14976 wdev->owner_nlportid); 14977 14978 return; 14979 14980 nla_put_failure: 14981 nlmsg_free(msg); 14982 } 14983 EXPORT_SYMBOL(cfg80211_nan_func_terminated); 14984 14985 static int nl80211_get_protocol_features(struct sk_buff *skb, 14986 struct genl_info *info) 14987 { 14988 void *hdr; 14989 struct sk_buff *msg; 14990 14991 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14992 if (!msg) 14993 return -ENOMEM; 14994 14995 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14996 NL80211_CMD_GET_PROTOCOL_FEATURES); 14997 if (!hdr) 14998 goto nla_put_failure; 14999 15000 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES, 15001 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP)) 15002 goto nla_put_failure; 15003 15004 genlmsg_end(msg, hdr); 15005 return genlmsg_reply(msg, info); 15006 15007 nla_put_failure: 15008 kfree_skb(msg); 15009 return -ENOBUFS; 15010 } 15011 15012 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info) 15013 { 15014 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15015 struct cfg80211_update_ft_ies_params ft_params; 15016 struct net_device *dev = info->user_ptr[1]; 15017 15018 if (!rdev->ops->update_ft_ies) 15019 return -EOPNOTSUPP; 15020 15021 if (!info->attrs[NL80211_ATTR_MDID] || 15022 !info->attrs[NL80211_ATTR_IE]) 15023 return -EINVAL; 15024 15025 memset(&ft_params, 0, sizeof(ft_params)); 15026 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]); 15027 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 15028 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 15029 15030 return rdev_update_ft_ies(rdev, dev, &ft_params); 15031 } 15032 15033 static int nl80211_crit_protocol_start(struct sk_buff *skb, 15034 struct genl_info *info) 15035 { 15036 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15037 struct wireless_dev *wdev = info->user_ptr[1]; 15038 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC; 15039 u16 duration; 15040 int ret; 15041 15042 if (!rdev->ops->crit_proto_start) 15043 return -EOPNOTSUPP; 15044 15045 if (WARN_ON(!rdev->ops->crit_proto_stop)) 15046 return -EINVAL; 15047 15048 if (rdev->crit_proto_nlportid) 15049 return -EBUSY; 15050 15051 /* determine protocol if provided */ 15052 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID]) 15053 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]); 15054 15055 if (proto >= NUM_NL80211_CRIT_PROTO) 15056 return -EINVAL; 15057 15058 /* timeout must be provided */ 15059 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]) 15060 return -EINVAL; 15061 15062 duration = 15063 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]); 15064 15065 ret = rdev_crit_proto_start(rdev, wdev, proto, duration); 15066 if (!ret) 15067 rdev->crit_proto_nlportid = info->snd_portid; 15068 15069 return ret; 15070 } 15071 15072 static int nl80211_crit_protocol_stop(struct sk_buff *skb, 15073 struct genl_info *info) 15074 { 15075 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15076 struct wireless_dev *wdev = info->user_ptr[1]; 15077 15078 if (!rdev->ops->crit_proto_stop) 15079 return -EOPNOTSUPP; 15080 15081 if (rdev->crit_proto_nlportid) { 15082 rdev->crit_proto_nlportid = 0; 15083 rdev_crit_proto_stop(rdev, wdev); 15084 } 15085 return 0; 15086 } 15087 15088 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd, 15089 struct nlattr *attr, 15090 struct netlink_ext_ack *extack) 15091 { 15092 if (vcmd->policy == VENDOR_CMD_RAW_DATA) { 15093 if (attr->nla_type & NLA_F_NESTED) { 15094 NL_SET_ERR_MSG_ATTR(extack, attr, 15095 "unexpected nested data"); 15096 return -EINVAL; 15097 } 15098 15099 return 0; 15100 } 15101 15102 if (!(attr->nla_type & NLA_F_NESTED)) { 15103 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data"); 15104 return -EINVAL; 15105 } 15106 15107 return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack); 15108 } 15109 15110 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info) 15111 { 15112 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15113 struct wireless_dev *wdev = 15114 __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 15115 info->attrs); 15116 int i, err; 15117 u32 vid, subcmd; 15118 15119 if (!rdev->wiphy.vendor_commands) 15120 return -EOPNOTSUPP; 15121 15122 if (IS_ERR(wdev)) { 15123 err = PTR_ERR(wdev); 15124 if (err != -EINVAL) 15125 return err; 15126 wdev = NULL; 15127 } else if (wdev->wiphy != &rdev->wiphy) { 15128 return -EINVAL; 15129 } 15130 15131 if (!info->attrs[NL80211_ATTR_VENDOR_ID] || 15132 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD]) 15133 return -EINVAL; 15134 15135 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]); 15136 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]); 15137 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 15138 const struct wiphy_vendor_command *vcmd; 15139 void *data = NULL; 15140 int len = 0; 15141 15142 vcmd = &rdev->wiphy.vendor_commands[i]; 15143 15144 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 15145 continue; 15146 15147 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 15148 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 15149 if (!wdev) 15150 return -EINVAL; 15151 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 15152 !wdev->netdev) 15153 return -EINVAL; 15154 15155 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 15156 if (!wdev_running(wdev)) 15157 return -ENETDOWN; 15158 } 15159 } else { 15160 wdev = NULL; 15161 } 15162 15163 if (!vcmd->doit) 15164 return -EOPNOTSUPP; 15165 15166 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) { 15167 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]); 15168 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]); 15169 15170 err = nl80211_vendor_check_policy(vcmd, 15171 info->attrs[NL80211_ATTR_VENDOR_DATA], 15172 info->extack); 15173 if (err) 15174 return err; 15175 } 15176 15177 rdev->cur_cmd_info = info; 15178 err = vcmd->doit(&rdev->wiphy, wdev, data, len); 15179 rdev->cur_cmd_info = NULL; 15180 return err; 15181 } 15182 15183 return -EOPNOTSUPP; 15184 } 15185 15186 static int nl80211_prepare_vendor_dump(struct sk_buff *skb, 15187 struct netlink_callback *cb, 15188 struct cfg80211_registered_device **rdev, 15189 struct wireless_dev **wdev) 15190 { 15191 struct nlattr **attrbuf; 15192 u32 vid, subcmd; 15193 unsigned int i; 15194 int vcmd_idx = -1; 15195 int err; 15196 void *data = NULL; 15197 unsigned int data_len = 0; 15198 15199 if (cb->args[0]) { 15200 /* subtract the 1 again here */ 15201 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 15202 struct wireless_dev *tmp; 15203 15204 if (!wiphy) 15205 return -ENODEV; 15206 *rdev = wiphy_to_rdev(wiphy); 15207 *wdev = NULL; 15208 15209 if (cb->args[1]) { 15210 list_for_each_entry(tmp, &wiphy->wdev_list, list) { 15211 if (tmp->identifier == cb->args[1] - 1) { 15212 *wdev = tmp; 15213 break; 15214 } 15215 } 15216 } 15217 15218 /* keep rtnl locked in successful case */ 15219 return 0; 15220 } 15221 15222 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 15223 if (!attrbuf) 15224 return -ENOMEM; 15225 15226 err = nlmsg_parse_deprecated(cb->nlh, 15227 GENL_HDRLEN + nl80211_fam.hdrsize, 15228 attrbuf, nl80211_fam.maxattr, 15229 nl80211_policy, NULL); 15230 if (err) 15231 goto out; 15232 15233 if (!attrbuf[NL80211_ATTR_VENDOR_ID] || 15234 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) { 15235 err = -EINVAL; 15236 goto out; 15237 } 15238 15239 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf); 15240 if (IS_ERR(*wdev)) 15241 *wdev = NULL; 15242 15243 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 15244 if (IS_ERR(*rdev)) { 15245 err = PTR_ERR(*rdev); 15246 goto out; 15247 } 15248 15249 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]); 15250 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]); 15251 15252 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) { 15253 const struct wiphy_vendor_command *vcmd; 15254 15255 vcmd = &(*rdev)->wiphy.vendor_commands[i]; 15256 15257 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 15258 continue; 15259 15260 if (!vcmd->dumpit) { 15261 err = -EOPNOTSUPP; 15262 goto out; 15263 } 15264 15265 vcmd_idx = i; 15266 break; 15267 } 15268 15269 if (vcmd_idx < 0) { 15270 err = -EOPNOTSUPP; 15271 goto out; 15272 } 15273 15274 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) { 15275 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15276 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15277 15278 err = nl80211_vendor_check_policy( 15279 &(*rdev)->wiphy.vendor_commands[vcmd_idx], 15280 attrbuf[NL80211_ATTR_VENDOR_DATA], 15281 cb->extack); 15282 if (err) 15283 goto out; 15284 } 15285 15286 /* 0 is the first index - add 1 to parse only once */ 15287 cb->args[0] = (*rdev)->wiphy_idx + 1; 15288 /* add 1 to know if it was NULL */ 15289 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0; 15290 cb->args[2] = vcmd_idx; 15291 cb->args[3] = (unsigned long)data; 15292 cb->args[4] = data_len; 15293 15294 /* keep rtnl locked in successful case */ 15295 err = 0; 15296 out: 15297 kfree(attrbuf); 15298 return err; 15299 } 15300 15301 static int nl80211_vendor_cmd_dump(struct sk_buff *skb, 15302 struct netlink_callback *cb) 15303 { 15304 struct cfg80211_registered_device *rdev; 15305 struct wireless_dev *wdev; 15306 unsigned int vcmd_idx; 15307 const struct wiphy_vendor_command *vcmd; 15308 void *data; 15309 int data_len; 15310 int err; 15311 struct nlattr *vendor_data; 15312 15313 rtnl_lock(); 15314 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev); 15315 if (err) 15316 goto out; 15317 15318 vcmd_idx = cb->args[2]; 15319 data = (void *)cb->args[3]; 15320 data_len = cb->args[4]; 15321 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx]; 15322 15323 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 15324 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 15325 if (!wdev) { 15326 err = -EINVAL; 15327 goto out; 15328 } 15329 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 15330 !wdev->netdev) { 15331 err = -EINVAL; 15332 goto out; 15333 } 15334 15335 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 15336 if (!wdev_running(wdev)) { 15337 err = -ENETDOWN; 15338 goto out; 15339 } 15340 } 15341 } 15342 15343 while (1) { 15344 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 15345 cb->nlh->nlmsg_seq, NLM_F_MULTI, 15346 NL80211_CMD_VENDOR); 15347 if (!hdr) 15348 break; 15349 15350 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15351 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 15352 wdev_id(wdev), 15353 NL80211_ATTR_PAD))) { 15354 genlmsg_cancel(skb, hdr); 15355 break; 15356 } 15357 15358 vendor_data = nla_nest_start_noflag(skb, 15359 NL80211_ATTR_VENDOR_DATA); 15360 if (!vendor_data) { 15361 genlmsg_cancel(skb, hdr); 15362 break; 15363 } 15364 15365 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len, 15366 (unsigned long *)&cb->args[5]); 15367 nla_nest_end(skb, vendor_data); 15368 15369 if (err == -ENOBUFS || err == -ENOENT) { 15370 genlmsg_cancel(skb, hdr); 15371 break; 15372 } else if (err <= 0) { 15373 genlmsg_cancel(skb, hdr); 15374 goto out; 15375 } 15376 15377 genlmsg_end(skb, hdr); 15378 } 15379 15380 err = skb->len; 15381 out: 15382 rtnl_unlock(); 15383 return err; 15384 } 15385 15386 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy, 15387 enum nl80211_commands cmd, 15388 enum nl80211_attrs attr, 15389 int approxlen) 15390 { 15391 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15392 15393 if (WARN_ON(!rdev->cur_cmd_info)) 15394 return NULL; 15395 15396 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen, 15397 rdev->cur_cmd_info->snd_portid, 15398 rdev->cur_cmd_info->snd_seq, 15399 cmd, attr, NULL, GFP_KERNEL); 15400 } 15401 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb); 15402 15403 int cfg80211_vendor_cmd_reply(struct sk_buff *skb) 15404 { 15405 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 15406 void *hdr = ((void **)skb->cb)[1]; 15407 struct nlattr *data = ((void **)skb->cb)[2]; 15408 15409 /* clear CB data for netlink core to own from now on */ 15410 memset(skb->cb, 0, sizeof(skb->cb)); 15411 15412 if (WARN_ON(!rdev->cur_cmd_info)) { 15413 kfree_skb(skb); 15414 return -EINVAL; 15415 } 15416 15417 nla_nest_end(skb, data); 15418 genlmsg_end(skb, hdr); 15419 return genlmsg_reply(skb, rdev->cur_cmd_info); 15420 } 15421 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply); 15422 15423 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy) 15424 { 15425 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15426 15427 if (WARN_ON(!rdev->cur_cmd_info)) 15428 return 0; 15429 15430 return rdev->cur_cmd_info->snd_portid; 15431 } 15432 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender); 15433 15434 static int nl80211_set_qos_map(struct sk_buff *skb, 15435 struct genl_info *info) 15436 { 15437 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15438 struct cfg80211_qos_map *qos_map = NULL; 15439 struct net_device *dev = info->user_ptr[1]; 15440 u8 *pos, len, num_des, des_len, des; 15441 int ret; 15442 15443 if (!rdev->ops->set_qos_map) 15444 return -EOPNOTSUPP; 15445 15446 if (info->attrs[NL80211_ATTR_QOS_MAP]) { 15447 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]); 15448 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]); 15449 15450 if (len % 2) 15451 return -EINVAL; 15452 15453 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL); 15454 if (!qos_map) 15455 return -ENOMEM; 15456 15457 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1; 15458 if (num_des) { 15459 des_len = num_des * 15460 sizeof(struct cfg80211_dscp_exception); 15461 memcpy(qos_map->dscp_exception, pos, des_len); 15462 qos_map->num_des = num_des; 15463 for (des = 0; des < num_des; des++) { 15464 if (qos_map->dscp_exception[des].up > 7) { 15465 kfree(qos_map); 15466 return -EINVAL; 15467 } 15468 } 15469 pos += des_len; 15470 } 15471 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN); 15472 } 15473 15474 ret = nl80211_key_allowed(dev->ieee80211_ptr); 15475 if (!ret) 15476 ret = rdev_set_qos_map(rdev, dev, qos_map); 15477 15478 kfree(qos_map); 15479 return ret; 15480 } 15481 15482 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info) 15483 { 15484 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15485 struct net_device *dev = info->user_ptr[1]; 15486 struct wireless_dev *wdev = dev->ieee80211_ptr; 15487 const u8 *peer; 15488 u8 tsid, up; 15489 u16 admitted_time = 0; 15490 15491 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)) 15492 return -EOPNOTSUPP; 15493 15494 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] || 15495 !info->attrs[NL80211_ATTR_USER_PRIO]) 15496 return -EINVAL; 15497 15498 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15499 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]); 15500 15501 /* WMM uses TIDs 0-7 even for TSPEC */ 15502 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) { 15503 /* TODO: handle 802.11 TSPEC/admission control 15504 * need more attributes for that (e.g. BA session requirement); 15505 * change the WMM admission test above to allow both then 15506 */ 15507 return -EINVAL; 15508 } 15509 15510 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15511 15512 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) { 15513 admitted_time = 15514 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]); 15515 if (!admitted_time) 15516 return -EINVAL; 15517 } 15518 15519 switch (wdev->iftype) { 15520 case NL80211_IFTYPE_STATION: 15521 case NL80211_IFTYPE_P2P_CLIENT: 15522 if (wdev->connected) 15523 break; 15524 return -ENOTCONN; 15525 default: 15526 return -EOPNOTSUPP; 15527 } 15528 15529 return rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time); 15530 } 15531 15532 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info) 15533 { 15534 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15535 struct net_device *dev = info->user_ptr[1]; 15536 const u8 *peer; 15537 u8 tsid; 15538 15539 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC]) 15540 return -EINVAL; 15541 15542 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15543 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15544 15545 return rdev_del_tx_ts(rdev, dev, tsid, peer); 15546 } 15547 15548 static int nl80211_tdls_channel_switch(struct sk_buff *skb, 15549 struct genl_info *info) 15550 { 15551 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15552 struct net_device *dev = info->user_ptr[1]; 15553 struct wireless_dev *wdev = dev->ieee80211_ptr; 15554 struct cfg80211_chan_def chandef = {}; 15555 const u8 *addr; 15556 u8 oper_class; 15557 int err; 15558 15559 if (!rdev->ops->tdls_channel_switch || 15560 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15561 return -EOPNOTSUPP; 15562 15563 switch (dev->ieee80211_ptr->iftype) { 15564 case NL80211_IFTYPE_STATION: 15565 case NL80211_IFTYPE_P2P_CLIENT: 15566 break; 15567 default: 15568 return -EOPNOTSUPP; 15569 } 15570 15571 if (!info->attrs[NL80211_ATTR_MAC] || 15572 !info->attrs[NL80211_ATTR_OPER_CLASS]) 15573 return -EINVAL; 15574 15575 err = nl80211_parse_chandef(rdev, info, &chandef); 15576 if (err) 15577 return err; 15578 15579 /* 15580 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012 15581 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the 15582 * specification is not defined for them. 15583 */ 15584 if (chandef.chan->band == NL80211_BAND_2GHZ && 15585 chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 15586 chandef.width != NL80211_CHAN_WIDTH_20) 15587 return -EINVAL; 15588 15589 /* we will be active on the TDLS link */ 15590 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 15591 wdev->iftype)) 15592 return -EINVAL; 15593 15594 /* don't allow switching to DFS channels */ 15595 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype)) 15596 return -EINVAL; 15597 15598 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15599 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]); 15600 15601 return rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef); 15602 } 15603 15604 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb, 15605 struct genl_info *info) 15606 { 15607 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15608 struct net_device *dev = info->user_ptr[1]; 15609 const u8 *addr; 15610 15611 if (!rdev->ops->tdls_channel_switch || 15612 !rdev->ops->tdls_cancel_channel_switch || 15613 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15614 return -EOPNOTSUPP; 15615 15616 switch (dev->ieee80211_ptr->iftype) { 15617 case NL80211_IFTYPE_STATION: 15618 case NL80211_IFTYPE_P2P_CLIENT: 15619 break; 15620 default: 15621 return -EOPNOTSUPP; 15622 } 15623 15624 if (!info->attrs[NL80211_ATTR_MAC]) 15625 return -EINVAL; 15626 15627 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15628 15629 rdev_tdls_cancel_channel_switch(rdev, dev, addr); 15630 15631 return 0; 15632 } 15633 15634 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb, 15635 struct genl_info *info) 15636 { 15637 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15638 struct net_device *dev = info->user_ptr[1]; 15639 struct wireless_dev *wdev = dev->ieee80211_ptr; 15640 const struct nlattr *nla; 15641 bool enabled; 15642 15643 if (!rdev->ops->set_multicast_to_unicast) 15644 return -EOPNOTSUPP; 15645 15646 if (wdev->iftype != NL80211_IFTYPE_AP && 15647 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15648 return -EOPNOTSUPP; 15649 15650 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED]; 15651 enabled = nla_get_flag(nla); 15652 15653 return rdev_set_multicast_to_unicast(rdev, dev, enabled); 15654 } 15655 15656 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info) 15657 { 15658 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15659 struct net_device *dev = info->user_ptr[1]; 15660 struct wireless_dev *wdev = dev->ieee80211_ptr; 15661 struct cfg80211_pmk_conf pmk_conf = {}; 15662 15663 if (wdev->iftype != NL80211_IFTYPE_STATION && 15664 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15665 return -EOPNOTSUPP; 15666 15667 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15668 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15669 return -EOPNOTSUPP; 15670 15671 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK]) 15672 return -EINVAL; 15673 15674 if (!wdev->connected) 15675 return -ENOTCONN; 15676 15677 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15678 if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN)) 15679 return -EINVAL; 15680 15681 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 15682 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 15683 if (pmk_conf.pmk_len != WLAN_PMK_LEN && 15684 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) 15685 return -EINVAL; 15686 15687 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) 15688 pmk_conf.pmk_r0_name = 15689 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]); 15690 15691 return rdev_set_pmk(rdev, dev, &pmk_conf); 15692 } 15693 15694 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info) 15695 { 15696 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15697 struct net_device *dev = info->user_ptr[1]; 15698 struct wireless_dev *wdev = dev->ieee80211_ptr; 15699 const u8 *aa; 15700 15701 if (wdev->iftype != NL80211_IFTYPE_STATION && 15702 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15703 return -EOPNOTSUPP; 15704 15705 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15706 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15707 return -EOPNOTSUPP; 15708 15709 if (!info->attrs[NL80211_ATTR_MAC]) 15710 return -EINVAL; 15711 15712 aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15713 return rdev_del_pmk(rdev, dev, aa); 15714 } 15715 15716 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info) 15717 { 15718 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15719 struct net_device *dev = info->user_ptr[1]; 15720 struct cfg80211_external_auth_params params; 15721 15722 if (!rdev->ops->external_auth) 15723 return -EOPNOTSUPP; 15724 15725 if (!info->attrs[NL80211_ATTR_SSID] && 15726 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 15727 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 15728 return -EINVAL; 15729 15730 if (!info->attrs[NL80211_ATTR_BSSID]) 15731 return -EINVAL; 15732 15733 if (!info->attrs[NL80211_ATTR_STATUS_CODE]) 15734 return -EINVAL; 15735 15736 memset(¶ms, 0, sizeof(params)); 15737 15738 if (info->attrs[NL80211_ATTR_SSID]) { 15739 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 15740 if (params.ssid.ssid_len == 0) 15741 return -EINVAL; 15742 memcpy(params.ssid.ssid, 15743 nla_data(info->attrs[NL80211_ATTR_SSID]), 15744 params.ssid.ssid_len); 15745 } 15746 15747 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]), 15748 ETH_ALEN); 15749 15750 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15751 15752 if (info->attrs[NL80211_ATTR_PMKID]) 15753 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 15754 15755 return rdev_external_auth(rdev, dev, ¶ms); 15756 } 15757 15758 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info) 15759 { 15760 bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK]; 15761 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15762 struct net_device *dev = info->user_ptr[1]; 15763 struct wireless_dev *wdev = dev->ieee80211_ptr; 15764 const u8 *buf; 15765 size_t len; 15766 u8 *dest; 15767 u16 proto; 15768 bool noencrypt; 15769 u64 cookie = 0; 15770 int link_id; 15771 int err; 15772 15773 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15774 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 15775 return -EOPNOTSUPP; 15776 15777 if (!rdev->ops->tx_control_port) 15778 return -EOPNOTSUPP; 15779 15780 if (!info->attrs[NL80211_ATTR_FRAME] || 15781 !info->attrs[NL80211_ATTR_MAC] || 15782 !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 15783 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing"); 15784 return -EINVAL; 15785 } 15786 15787 switch (wdev->iftype) { 15788 case NL80211_IFTYPE_AP: 15789 case NL80211_IFTYPE_P2P_GO: 15790 case NL80211_IFTYPE_MESH_POINT: 15791 break; 15792 case NL80211_IFTYPE_ADHOC: 15793 if (wdev->u.ibss.current_bss) 15794 break; 15795 return -ENOTCONN; 15796 case NL80211_IFTYPE_STATION: 15797 case NL80211_IFTYPE_P2P_CLIENT: 15798 if (wdev->connected) 15799 break; 15800 return -ENOTCONN; 15801 default: 15802 return -EOPNOTSUPP; 15803 } 15804 15805 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15806 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15807 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15808 proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 15809 noencrypt = 15810 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]); 15811 15812 link_id = nl80211_link_id_or_invalid(info->attrs); 15813 15814 err = rdev_tx_control_port(rdev, dev, buf, len, 15815 dest, cpu_to_be16(proto), noencrypt, link_id, 15816 dont_wait_for_ack ? NULL : &cookie); 15817 if (!err && !dont_wait_for_ack) 15818 nl_set_extack_cookie_u64(info->extack, cookie); 15819 return err; 15820 } 15821 15822 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb, 15823 struct genl_info *info) 15824 { 15825 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15826 struct net_device *dev = info->user_ptr[1]; 15827 struct wireless_dev *wdev = dev->ieee80211_ptr; 15828 struct cfg80211_ftm_responder_stats ftm_stats = {}; 15829 unsigned int link_id = nl80211_link_id(info->attrs); 15830 struct sk_buff *msg; 15831 void *hdr; 15832 struct nlattr *ftm_stats_attr; 15833 int err; 15834 15835 if (wdev->iftype != NL80211_IFTYPE_AP || 15836 !wdev->links[link_id].ap.beacon_interval) 15837 return -EOPNOTSUPP; 15838 15839 err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats); 15840 if (err) 15841 return err; 15842 15843 if (!ftm_stats.filled) 15844 return -ENODATA; 15845 15846 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15847 if (!msg) 15848 return -ENOMEM; 15849 15850 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15851 NL80211_CMD_GET_FTM_RESPONDER_STATS); 15852 if (!hdr) 15853 goto nla_put_failure; 15854 15855 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 15856 goto nla_put_failure; 15857 15858 ftm_stats_attr = nla_nest_start_noflag(msg, 15859 NL80211_ATTR_FTM_RESPONDER_STATS); 15860 if (!ftm_stats_attr) 15861 goto nla_put_failure; 15862 15863 #define SET_FTM(field, name, type) \ 15864 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15865 nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \ 15866 ftm_stats.field)) \ 15867 goto nla_put_failure; } while (0) 15868 #define SET_FTM_U64(field, name) \ 15869 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15870 nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \ 15871 ftm_stats.field, NL80211_FTM_STATS_PAD)) \ 15872 goto nla_put_failure; } while (0) 15873 15874 SET_FTM(success_num, SUCCESS_NUM, u32); 15875 SET_FTM(partial_num, PARTIAL_NUM, u32); 15876 SET_FTM(failed_num, FAILED_NUM, u32); 15877 SET_FTM(asap_num, ASAP_NUM, u32); 15878 SET_FTM(non_asap_num, NON_ASAP_NUM, u32); 15879 SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC); 15880 SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32); 15881 SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32); 15882 SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32); 15883 #undef SET_FTM 15884 15885 nla_nest_end(msg, ftm_stats_attr); 15886 15887 genlmsg_end(msg, hdr); 15888 return genlmsg_reply(msg, info); 15889 15890 nla_put_failure: 15891 nlmsg_free(msg); 15892 return -ENOBUFS; 15893 } 15894 15895 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info) 15896 { 15897 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15898 struct cfg80211_update_owe_info owe_info; 15899 struct net_device *dev = info->user_ptr[1]; 15900 15901 if (!rdev->ops->update_owe_info) 15902 return -EOPNOTSUPP; 15903 15904 if (!info->attrs[NL80211_ATTR_STATUS_CODE] || 15905 !info->attrs[NL80211_ATTR_MAC]) 15906 return -EINVAL; 15907 15908 memset(&owe_info, 0, sizeof(owe_info)); 15909 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15910 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN); 15911 15912 if (info->attrs[NL80211_ATTR_IE]) { 15913 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 15914 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 15915 } 15916 15917 return rdev_update_owe_info(rdev, dev, &owe_info); 15918 } 15919 15920 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info) 15921 { 15922 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15923 struct net_device *dev = info->user_ptr[1]; 15924 struct wireless_dev *wdev = dev->ieee80211_ptr; 15925 struct station_info sinfo = {}; 15926 const u8 *buf; 15927 size_t len; 15928 u8 *dest; 15929 int err; 15930 15931 if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station) 15932 return -EOPNOTSUPP; 15933 15934 if (!info->attrs[NL80211_ATTR_MAC] || 15935 !info->attrs[NL80211_ATTR_FRAME]) { 15936 GENL_SET_ERR_MSG(info, "Frame or MAC missing"); 15937 return -EINVAL; 15938 } 15939 15940 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 15941 return -EOPNOTSUPP; 15942 15943 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15944 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15945 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15946 15947 if (len < sizeof(struct ethhdr)) 15948 return -EINVAL; 15949 15950 if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) || 15951 !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr)) 15952 return -EINVAL; 15953 15954 err = rdev_get_station(rdev, dev, dest, &sinfo); 15955 if (err) 15956 return err; 15957 15958 cfg80211_sinfo_release_content(&sinfo); 15959 15960 return rdev_probe_mesh_link(rdev, dev, dest, buf, len); 15961 } 15962 15963 static int parse_tid_conf(struct cfg80211_registered_device *rdev, 15964 struct nlattr *attrs[], struct net_device *dev, 15965 struct cfg80211_tid_cfg *tid_conf, 15966 struct genl_info *info, const u8 *peer, 15967 unsigned int link_id) 15968 { 15969 struct netlink_ext_ack *extack = info->extack; 15970 u64 mask; 15971 int err; 15972 15973 if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS]) 15974 return -EINVAL; 15975 15976 tid_conf->config_override = 15977 nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]); 15978 tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]); 15979 15980 if (tid_conf->config_override) { 15981 if (rdev->ops->reset_tid_config) { 15982 err = rdev_reset_tid_config(rdev, dev, peer, 15983 tid_conf->tids); 15984 if (err) 15985 return err; 15986 } else { 15987 return -EINVAL; 15988 } 15989 } 15990 15991 if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) { 15992 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK); 15993 tid_conf->noack = 15994 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]); 15995 } 15996 15997 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) { 15998 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT); 15999 tid_conf->retry_short = 16000 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]); 16001 16002 if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count) 16003 return -EINVAL; 16004 } 16005 16006 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) { 16007 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG); 16008 tid_conf->retry_long = 16009 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]); 16010 16011 if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count) 16012 return -EINVAL; 16013 } 16014 16015 if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) { 16016 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL); 16017 tid_conf->ampdu = 16018 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]); 16019 } 16020 16021 if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) { 16022 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL); 16023 tid_conf->rtscts = 16024 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]); 16025 } 16026 16027 if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) { 16028 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL); 16029 tid_conf->amsdu = 16030 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]); 16031 } 16032 16033 if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) { 16034 u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr; 16035 16036 tid_conf->txrate_type = nla_get_u8(attrs[idx]); 16037 16038 if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) { 16039 attr = NL80211_TID_CONFIG_ATTR_TX_RATE; 16040 err = nl80211_parse_tx_bitrate_mask(info, attrs, attr, 16041 &tid_conf->txrate_mask, dev, 16042 true, link_id); 16043 if (err) 16044 return err; 16045 16046 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE); 16047 } 16048 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE); 16049 } 16050 16051 if (peer) 16052 mask = rdev->wiphy.tid_config_support.peer; 16053 else 16054 mask = rdev->wiphy.tid_config_support.vif; 16055 16056 if (tid_conf->mask & ~mask) { 16057 NL_SET_ERR_MSG(extack, "unsupported TID configuration"); 16058 return -EOPNOTSUPP; 16059 } 16060 16061 return 0; 16062 } 16063 16064 static int nl80211_set_tid_config(struct sk_buff *skb, 16065 struct genl_info *info) 16066 { 16067 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16068 struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1]; 16069 unsigned int link_id = nl80211_link_id(info->attrs); 16070 struct net_device *dev = info->user_ptr[1]; 16071 struct cfg80211_tid_config *tid_config; 16072 struct nlattr *tid; 16073 int conf_idx = 0, rem_conf; 16074 int ret = -EINVAL; 16075 u32 num_conf = 0; 16076 16077 if (!info->attrs[NL80211_ATTR_TID_CONFIG]) 16078 return -EINVAL; 16079 16080 if (!rdev->ops->set_tid_config) 16081 return -EOPNOTSUPP; 16082 16083 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 16084 rem_conf) 16085 num_conf++; 16086 16087 tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf), 16088 GFP_KERNEL); 16089 if (!tid_config) 16090 return -ENOMEM; 16091 16092 tid_config->n_tid_conf = num_conf; 16093 16094 if (info->attrs[NL80211_ATTR_MAC]) 16095 tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 16096 16097 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 16098 rem_conf) { 16099 ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX, 16100 tid, NULL, NULL); 16101 16102 if (ret) 16103 goto bad_tid_conf; 16104 16105 ret = parse_tid_conf(rdev, attrs, dev, 16106 &tid_config->tid_conf[conf_idx], 16107 info, tid_config->peer, link_id); 16108 if (ret) 16109 goto bad_tid_conf; 16110 16111 conf_idx++; 16112 } 16113 16114 ret = rdev_set_tid_config(rdev, dev, tid_config); 16115 16116 bad_tid_conf: 16117 kfree(tid_config); 16118 return ret; 16119 } 16120 16121 static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info) 16122 { 16123 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16124 struct cfg80211_color_change_settings params = {}; 16125 struct net_device *dev = info->user_ptr[1]; 16126 struct wireless_dev *wdev = dev->ieee80211_ptr; 16127 struct nlattr **tb; 16128 u16 offset; 16129 int err; 16130 16131 if (!rdev->ops->color_change) 16132 return -EOPNOTSUPP; 16133 16134 if (!wiphy_ext_feature_isset(&rdev->wiphy, 16135 NL80211_EXT_FEATURE_BSS_COLOR)) 16136 return -EOPNOTSUPP; 16137 16138 if (wdev->iftype != NL80211_IFTYPE_AP) 16139 return -EOPNOTSUPP; 16140 16141 if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] || 16142 !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] || 16143 !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS]) 16144 return -EINVAL; 16145 16146 params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]); 16147 params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]); 16148 16149 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_next, 16150 info->extack); 16151 if (err) 16152 return err; 16153 16154 tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL); 16155 if (!tb) 16156 return -ENOMEM; 16157 16158 err = nla_parse_nested(tb, NL80211_ATTR_MAX, 16159 info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS], 16160 nl80211_policy, info->extack); 16161 if (err) 16162 goto out; 16163 16164 err = nl80211_parse_beacon(rdev, tb, ¶ms.beacon_color_change, 16165 info->extack); 16166 if (err) 16167 goto out; 16168 16169 if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 16170 err = -EINVAL; 16171 goto out; 16172 } 16173 16174 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) { 16175 err = -EINVAL; 16176 goto out; 16177 } 16178 16179 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 16180 if (offset >= params.beacon_color_change.tail_len) { 16181 err = -EINVAL; 16182 goto out; 16183 } 16184 16185 if (params.beacon_color_change.tail[offset] != params.count) { 16186 err = -EINVAL; 16187 goto out; 16188 } 16189 16190 params.counter_offset_beacon = offset; 16191 16192 if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 16193 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) != 16194 sizeof(u16)) { 16195 err = -EINVAL; 16196 goto out; 16197 } 16198 16199 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 16200 if (offset >= params.beacon_color_change.probe_resp_len) { 16201 err = -EINVAL; 16202 goto out; 16203 } 16204 16205 if (params.beacon_color_change.probe_resp[offset] != 16206 params.count) { 16207 err = -EINVAL; 16208 goto out; 16209 } 16210 16211 params.counter_offset_presp = offset; 16212 } 16213 16214 params.link_id = nl80211_link_id(info->attrs); 16215 err = rdev_color_change(rdev, dev, ¶ms); 16216 16217 out: 16218 kfree(params.beacon_next.mbssid_ies); 16219 kfree(params.beacon_color_change.mbssid_ies); 16220 kfree(params.beacon_next.rnr_ies); 16221 kfree(params.beacon_color_change.rnr_ies); 16222 kfree(tb); 16223 return err; 16224 } 16225 16226 static int nl80211_set_fils_aad(struct sk_buff *skb, 16227 struct genl_info *info) 16228 { 16229 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16230 struct net_device *dev = info->user_ptr[1]; 16231 struct cfg80211_fils_aad fils_aad = {}; 16232 u8 *nonces; 16233 16234 if (!info->attrs[NL80211_ATTR_MAC] || 16235 !info->attrs[NL80211_ATTR_FILS_KEK] || 16236 !info->attrs[NL80211_ATTR_FILS_NONCES]) 16237 return -EINVAL; 16238 16239 fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16240 fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 16241 fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 16242 nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 16243 fils_aad.snonce = nonces; 16244 fils_aad.anonce = nonces + FILS_NONCE_LEN; 16245 16246 return rdev_set_fils_aad(rdev, dev, &fils_aad); 16247 } 16248 16249 static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info) 16250 { 16251 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16252 unsigned int link_id = nl80211_link_id(info->attrs); 16253 struct net_device *dev = info->user_ptr[1]; 16254 struct wireless_dev *wdev = dev->ieee80211_ptr; 16255 int ret; 16256 16257 if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO)) 16258 return -EINVAL; 16259 16260 switch (wdev->iftype) { 16261 case NL80211_IFTYPE_AP: 16262 break; 16263 default: 16264 return -EINVAL; 16265 } 16266 16267 if (!info->attrs[NL80211_ATTR_MAC] || 16268 !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC]))) 16269 return -EINVAL; 16270 16271 wdev->valid_links |= BIT(link_id); 16272 ether_addr_copy(wdev->links[link_id].addr, 16273 nla_data(info->attrs[NL80211_ATTR_MAC])); 16274 16275 ret = rdev_add_intf_link(rdev, wdev, link_id); 16276 if (ret) { 16277 wdev->valid_links &= ~BIT(link_id); 16278 eth_zero_addr(wdev->links[link_id].addr); 16279 } 16280 16281 return ret; 16282 } 16283 16284 static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info) 16285 { 16286 unsigned int link_id = nl80211_link_id(info->attrs); 16287 struct net_device *dev = info->user_ptr[1]; 16288 struct wireless_dev *wdev = dev->ieee80211_ptr; 16289 16290 /* cannot remove if there's no link */ 16291 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16292 return -EINVAL; 16293 16294 switch (wdev->iftype) { 16295 case NL80211_IFTYPE_AP: 16296 break; 16297 default: 16298 return -EINVAL; 16299 } 16300 16301 cfg80211_remove_link(wdev, link_id); 16302 16303 return 0; 16304 } 16305 16306 static int 16307 nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info, 16308 bool add) 16309 { 16310 struct link_station_parameters params = {}; 16311 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16312 struct net_device *dev = info->user_ptr[1]; 16313 int err; 16314 16315 if ((add && !rdev->ops->add_link_station) || 16316 (!add && !rdev->ops->mod_link_station)) 16317 return -EOPNOTSUPP; 16318 16319 if (add && !info->attrs[NL80211_ATTR_MAC]) 16320 return -EINVAL; 16321 16322 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 16323 return -EINVAL; 16324 16325 if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 16326 return -EINVAL; 16327 16328 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16329 16330 if (info->attrs[NL80211_ATTR_MAC]) { 16331 params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 16332 if (!is_valid_ether_addr(params.link_mac)) 16333 return -EINVAL; 16334 } 16335 16336 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16337 return -EINVAL; 16338 16339 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16340 16341 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 16342 params.supported_rates = 16343 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16344 params.supported_rates_len = 16345 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16346 } 16347 16348 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 16349 params.ht_capa = 16350 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 16351 16352 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 16353 params.vht_capa = 16354 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 16355 16356 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 16357 params.he_capa = 16358 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16359 params.he_capa_len = 16360 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16361 16362 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 16363 params.eht_capa = 16364 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16365 params.eht_capa_len = 16366 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16367 16368 if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa, 16369 (const u8 *)params.eht_capa, 16370 params.eht_capa_len, 16371 false)) 16372 return -EINVAL; 16373 } 16374 } 16375 16376 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 16377 params.he_6ghz_capa = 16378 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 16379 16380 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 16381 params.opmode_notif_used = true; 16382 params.opmode_notif = 16383 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 16384 } 16385 16386 err = nl80211_parse_sta_txpower_setting(info, ¶ms.txpwr, 16387 ¶ms.txpwr_set); 16388 if (err) 16389 return err; 16390 16391 if (add) 16392 return rdev_add_link_station(rdev, dev, ¶ms); 16393 16394 return rdev_mod_link_station(rdev, dev, ¶ms); 16395 } 16396 16397 static int 16398 nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info) 16399 { 16400 return nl80211_add_mod_link_station(skb, info, true); 16401 } 16402 16403 static int 16404 nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info) 16405 { 16406 return nl80211_add_mod_link_station(skb, info, false); 16407 } 16408 16409 static int 16410 nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info) 16411 { 16412 struct link_station_del_parameters params = {}; 16413 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16414 struct net_device *dev = info->user_ptr[1]; 16415 16416 if (!rdev->ops->del_link_station) 16417 return -EOPNOTSUPP; 16418 16419 if (!info->attrs[NL80211_ATTR_MLD_ADDR] || 16420 !info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16421 return -EINVAL; 16422 16423 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16424 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16425 16426 return rdev_del_link_station(rdev, dev, ¶ms); 16427 } 16428 16429 static int nl80211_set_hw_timestamp(struct sk_buff *skb, 16430 struct genl_info *info) 16431 { 16432 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16433 struct net_device *dev = info->user_ptr[1]; 16434 struct cfg80211_set_hw_timestamp hwts = {}; 16435 16436 if (!rdev->wiphy.hw_timestamp_max_peers) 16437 return -EOPNOTSUPP; 16438 16439 if (!info->attrs[NL80211_ATTR_MAC] && 16440 rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS) 16441 return -EOPNOTSUPP; 16442 16443 if (info->attrs[NL80211_ATTR_MAC]) 16444 hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16445 16446 hwts.enable = 16447 nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]); 16448 16449 return rdev_set_hw_timestamp(rdev, dev, &hwts); 16450 } 16451 16452 static int 16453 nl80211_set_ttlm(struct sk_buff *skb, struct genl_info *info) 16454 { 16455 struct cfg80211_ttlm_params params = {}; 16456 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16457 struct net_device *dev = info->user_ptr[1]; 16458 struct wireless_dev *wdev = dev->ieee80211_ptr; 16459 16460 if (wdev->iftype != NL80211_IFTYPE_STATION && 16461 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16462 return -EOPNOTSUPP; 16463 16464 if (!wdev->connected) 16465 return -ENOLINK; 16466 16467 if (!info->attrs[NL80211_ATTR_MLO_TTLM_DLINK] || 16468 !info->attrs[NL80211_ATTR_MLO_TTLM_ULINK]) 16469 return -EINVAL; 16470 16471 nla_memcpy(params.dlink, 16472 info->attrs[NL80211_ATTR_MLO_TTLM_DLINK], 16473 sizeof(params.dlink)); 16474 nla_memcpy(params.ulink, 16475 info->attrs[NL80211_ATTR_MLO_TTLM_ULINK], 16476 sizeof(params.ulink)); 16477 16478 return rdev_set_ttlm(rdev, dev, ¶ms); 16479 } 16480 16481 static int nl80211_assoc_ml_reconf(struct sk_buff *skb, struct genl_info *info) 16482 { 16483 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16484 struct net_device *dev = info->user_ptr[1]; 16485 struct wireless_dev *wdev = dev->ieee80211_ptr; 16486 struct cfg80211_assoc_link links[IEEE80211_MLD_MAX_NUM_LINKS] = {}; 16487 unsigned int link_id; 16488 u16 add_links, rem_links; 16489 int err; 16490 16491 if (!wdev->valid_links) 16492 return -EINVAL; 16493 16494 if (dev->ieee80211_ptr->conn_owner_nlportid && 16495 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 16496 return -EPERM; 16497 16498 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 16499 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 16500 return -EOPNOTSUPP; 16501 16502 add_links = 0; 16503 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 16504 err = nl80211_process_links(rdev, links, NULL, 0, info); 16505 if (err) 16506 return err; 16507 16508 for (link_id = 0; link_id < IEEE80211_MLD_MAX_NUM_LINKS; 16509 link_id++) { 16510 if (!links[link_id].bss) 16511 continue; 16512 add_links |= BIT(link_id); 16513 } 16514 } 16515 16516 if (info->attrs[NL80211_ATTR_MLO_RECONF_REM_LINKS]) 16517 rem_links = 16518 nla_get_u16(info->attrs[NL80211_ATTR_MLO_RECONF_REM_LINKS]); 16519 else 16520 rem_links = 0; 16521 16522 /* Validate that existing links are not added, removed links are valid 16523 * and don't allow adding and removing the same links 16524 */ 16525 if ((add_links & rem_links) || !(add_links | rem_links) || 16526 (wdev->valid_links & add_links) || 16527 ((wdev->valid_links & rem_links) != rem_links)) { 16528 err = -EINVAL; 16529 goto out; 16530 } 16531 16532 err = cfg80211_assoc_ml_reconf(rdev, dev, links, rem_links); 16533 16534 out: 16535 for (link_id = 0; link_id < ARRAY_SIZE(links); link_id++) 16536 cfg80211_put_bss(&rdev->wiphy, links[link_id].bss); 16537 16538 return err; 16539 } 16540 16541 static int 16542 nl80211_epcs_cfg(struct sk_buff *skb, struct genl_info *info) 16543 { 16544 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16545 struct net_device *dev = info->user_ptr[1]; 16546 struct wireless_dev *wdev = dev->ieee80211_ptr; 16547 bool val; 16548 16549 if (wdev->iftype != NL80211_IFTYPE_STATION && 16550 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16551 return -EOPNOTSUPP; 16552 16553 if (!wdev->connected) 16554 return -ENOLINK; 16555 16556 val = nla_get_flag(info->attrs[NL80211_ATTR_EPCS]); 16557 16558 return rdev_set_epcs(rdev, dev, val); 16559 } 16560 16561 #define NL80211_FLAG_NEED_WIPHY 0x01 16562 #define NL80211_FLAG_NEED_NETDEV 0x02 16563 #define NL80211_FLAG_NEED_RTNL 0x04 16564 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08 16565 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\ 16566 NL80211_FLAG_CHECK_NETDEV_UP) 16567 #define NL80211_FLAG_NEED_WDEV 0x10 16568 /* If a netdev is associated, it must be UP, P2P must be started */ 16569 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\ 16570 NL80211_FLAG_CHECK_NETDEV_UP) 16571 #define NL80211_FLAG_CLEAR_SKB 0x20 16572 #define NL80211_FLAG_NO_WIPHY_MTX 0x40 16573 #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80 16574 #define NL80211_FLAG_MLO_UNSUPPORTED 0x100 16575 16576 #define INTERNAL_FLAG_SELECTORS(__sel) \ 16577 SELECTOR(__sel, NONE, 0) /* must be first */ \ 16578 SELECTOR(__sel, WIPHY, \ 16579 NL80211_FLAG_NEED_WIPHY) \ 16580 SELECTOR(__sel, WDEV, \ 16581 NL80211_FLAG_NEED_WDEV) \ 16582 SELECTOR(__sel, NETDEV, \ 16583 NL80211_FLAG_NEED_NETDEV) \ 16584 SELECTOR(__sel, NETDEV_LINK, \ 16585 NL80211_FLAG_NEED_NETDEV | \ 16586 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16587 SELECTOR(__sel, NETDEV_NO_MLO, \ 16588 NL80211_FLAG_NEED_NETDEV | \ 16589 NL80211_FLAG_MLO_UNSUPPORTED) \ 16590 SELECTOR(__sel, WIPHY_RTNL, \ 16591 NL80211_FLAG_NEED_WIPHY | \ 16592 NL80211_FLAG_NEED_RTNL) \ 16593 SELECTOR(__sel, WIPHY_RTNL_NOMTX, \ 16594 NL80211_FLAG_NEED_WIPHY | \ 16595 NL80211_FLAG_NEED_RTNL | \ 16596 NL80211_FLAG_NO_WIPHY_MTX) \ 16597 SELECTOR(__sel, WDEV_RTNL, \ 16598 NL80211_FLAG_NEED_WDEV | \ 16599 NL80211_FLAG_NEED_RTNL) \ 16600 SELECTOR(__sel, NETDEV_RTNL, \ 16601 NL80211_FLAG_NEED_NETDEV | \ 16602 NL80211_FLAG_NEED_RTNL) \ 16603 SELECTOR(__sel, NETDEV_UP, \ 16604 NL80211_FLAG_NEED_NETDEV_UP) \ 16605 SELECTOR(__sel, NETDEV_UP_LINK, \ 16606 NL80211_FLAG_NEED_NETDEV_UP | \ 16607 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16608 SELECTOR(__sel, NETDEV_UP_NO_MLO, \ 16609 NL80211_FLAG_NEED_NETDEV_UP | \ 16610 NL80211_FLAG_MLO_UNSUPPORTED) \ 16611 SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \ 16612 NL80211_FLAG_NEED_NETDEV_UP | \ 16613 NL80211_FLAG_CLEAR_SKB | \ 16614 NL80211_FLAG_MLO_UNSUPPORTED) \ 16615 SELECTOR(__sel, NETDEV_UP_NOTMX, \ 16616 NL80211_FLAG_NEED_NETDEV_UP | \ 16617 NL80211_FLAG_NO_WIPHY_MTX) \ 16618 SELECTOR(__sel, NETDEV_UP_NOTMX_MLO, \ 16619 NL80211_FLAG_NEED_NETDEV_UP | \ 16620 NL80211_FLAG_NO_WIPHY_MTX | \ 16621 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16622 SELECTOR(__sel, NETDEV_UP_CLEAR, \ 16623 NL80211_FLAG_NEED_NETDEV_UP | \ 16624 NL80211_FLAG_CLEAR_SKB) \ 16625 SELECTOR(__sel, WDEV_UP, \ 16626 NL80211_FLAG_NEED_WDEV_UP) \ 16627 SELECTOR(__sel, WDEV_UP_LINK, \ 16628 NL80211_FLAG_NEED_WDEV_UP | \ 16629 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16630 SELECTOR(__sel, WDEV_UP_RTNL, \ 16631 NL80211_FLAG_NEED_WDEV_UP | \ 16632 NL80211_FLAG_NEED_RTNL) \ 16633 SELECTOR(__sel, WIPHY_CLEAR, \ 16634 NL80211_FLAG_NEED_WIPHY | \ 16635 NL80211_FLAG_CLEAR_SKB) 16636 16637 enum nl80211_internal_flags_selector { 16638 #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name, 16639 INTERNAL_FLAG_SELECTORS(_) 16640 #undef SELECTOR 16641 }; 16642 16643 static u32 nl80211_internal_flags[] = { 16644 #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value, 16645 INTERNAL_FLAG_SELECTORS(_) 16646 #undef SELECTOR 16647 }; 16648 16649 static int nl80211_pre_doit(const struct genl_split_ops *ops, 16650 struct sk_buff *skb, 16651 struct genl_info *info) 16652 { 16653 struct cfg80211_registered_device *rdev = NULL; 16654 struct wireless_dev *wdev = NULL; 16655 struct net_device *dev = NULL; 16656 u32 internal_flags; 16657 int err; 16658 16659 if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags))) 16660 return -EINVAL; 16661 16662 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16663 16664 rtnl_lock(); 16665 if (internal_flags & NL80211_FLAG_NEED_WIPHY) { 16666 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 16667 if (IS_ERR(rdev)) { 16668 err = PTR_ERR(rdev); 16669 goto out_unlock; 16670 } 16671 info->user_ptr[0] = rdev; 16672 } else if (internal_flags & NL80211_FLAG_NEED_NETDEV || 16673 internal_flags & NL80211_FLAG_NEED_WDEV) { 16674 wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info), 16675 info->attrs); 16676 if (IS_ERR(wdev)) { 16677 err = PTR_ERR(wdev); 16678 goto out_unlock; 16679 } 16680 16681 dev = wdev->netdev; 16682 dev_hold(dev); 16683 rdev = wiphy_to_rdev(wdev->wiphy); 16684 16685 if (internal_flags & NL80211_FLAG_NEED_NETDEV) { 16686 if (!dev) { 16687 err = -EINVAL; 16688 goto out_unlock; 16689 } 16690 16691 info->user_ptr[1] = dev; 16692 } else { 16693 info->user_ptr[1] = wdev; 16694 } 16695 16696 if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP && 16697 !wdev_running(wdev)) { 16698 err = -ENETDOWN; 16699 goto out_unlock; 16700 } 16701 16702 info->user_ptr[0] = rdev; 16703 } 16704 16705 if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) { 16706 struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID]; 16707 16708 if (!wdev) { 16709 err = -EINVAL; 16710 goto out_unlock; 16711 } 16712 16713 /* MLO -> require valid link ID */ 16714 if (wdev->valid_links && 16715 (!link_id || 16716 !(wdev->valid_links & BIT(nla_get_u8(link_id))))) { 16717 err = -EINVAL; 16718 goto out_unlock; 16719 } 16720 16721 /* non-MLO -> no link ID attribute accepted */ 16722 if (!wdev->valid_links && link_id) { 16723 err = -EINVAL; 16724 goto out_unlock; 16725 } 16726 } 16727 16728 if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) { 16729 if (info->attrs[NL80211_ATTR_MLO_LINK_ID] || 16730 (wdev && wdev->valid_links)) { 16731 err = -EINVAL; 16732 goto out_unlock; 16733 } 16734 } 16735 16736 if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16737 wiphy_lock(&rdev->wiphy); 16738 /* we keep the mutex locked until post_doit */ 16739 __release(&rdev->wiphy.mtx); 16740 } 16741 if (!(internal_flags & NL80211_FLAG_NEED_RTNL)) 16742 rtnl_unlock(); 16743 16744 return 0; 16745 out_unlock: 16746 rtnl_unlock(); 16747 dev_put(dev); 16748 return err; 16749 } 16750 16751 static void nl80211_post_doit(const struct genl_split_ops *ops, 16752 struct sk_buff *skb, 16753 struct genl_info *info) 16754 { 16755 u32 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16756 16757 if (info->user_ptr[1]) { 16758 if (internal_flags & NL80211_FLAG_NEED_WDEV) { 16759 struct wireless_dev *wdev = info->user_ptr[1]; 16760 16761 dev_put(wdev->netdev); 16762 } else { 16763 dev_put(info->user_ptr[1]); 16764 } 16765 } 16766 16767 if (info->user_ptr[0] && 16768 !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16769 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16770 16771 /* we kept the mutex locked since pre_doit */ 16772 __acquire(&rdev->wiphy.mtx); 16773 wiphy_unlock(&rdev->wiphy); 16774 } 16775 16776 if (internal_flags & NL80211_FLAG_NEED_RTNL) 16777 rtnl_unlock(); 16778 16779 /* If needed, clear the netlink message payload from the SKB 16780 * as it might contain key data that shouldn't stick around on 16781 * the heap after the SKB is freed. The netlink message header 16782 * is still needed for further processing, so leave it intact. 16783 */ 16784 if (internal_flags & NL80211_FLAG_CLEAR_SKB) { 16785 struct nlmsghdr *nlh = nlmsg_hdr(skb); 16786 16787 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh)); 16788 } 16789 } 16790 16791 static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev, 16792 struct cfg80211_sar_specs *sar_specs, 16793 struct nlattr *spec[], int index) 16794 { 16795 u32 range_index, i; 16796 16797 if (!sar_specs || !spec) 16798 return -EINVAL; 16799 16800 if (!spec[NL80211_SAR_ATTR_SPECS_POWER] || 16801 !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]) 16802 return -EINVAL; 16803 16804 range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]); 16805 16806 /* check if range_index exceeds num_freq_ranges */ 16807 if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges) 16808 return -EINVAL; 16809 16810 /* check if range_index duplicates */ 16811 for (i = 0; i < index; i++) { 16812 if (sar_specs->sub_specs[i].freq_range_index == range_index) 16813 return -EINVAL; 16814 } 16815 16816 sar_specs->sub_specs[index].power = 16817 nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]); 16818 16819 sar_specs->sub_specs[index].freq_range_index = range_index; 16820 16821 return 0; 16822 } 16823 16824 static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info) 16825 { 16826 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16827 struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1]; 16828 struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1]; 16829 struct cfg80211_sar_specs *sar_spec; 16830 enum nl80211_sar_type type; 16831 struct nlattr *spec_list; 16832 u32 specs; 16833 int rem, err; 16834 16835 if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs) 16836 return -EOPNOTSUPP; 16837 16838 if (!info->attrs[NL80211_ATTR_SAR_SPEC]) 16839 return -EINVAL; 16840 16841 nla_parse_nested(tb, NL80211_SAR_ATTR_MAX, 16842 info->attrs[NL80211_ATTR_SAR_SPEC], 16843 NULL, NULL); 16844 16845 if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS]) 16846 return -EINVAL; 16847 16848 type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]); 16849 if (type != rdev->wiphy.sar_capa->type) 16850 return -EINVAL; 16851 16852 specs = 0; 16853 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) 16854 specs++; 16855 16856 if (specs > rdev->wiphy.sar_capa->num_freq_ranges) 16857 return -EINVAL; 16858 16859 sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL); 16860 if (!sar_spec) 16861 return -ENOMEM; 16862 16863 sar_spec->type = type; 16864 specs = 0; 16865 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) { 16866 nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX, 16867 spec_list, NULL, NULL); 16868 16869 switch (type) { 16870 case NL80211_SAR_TYPE_POWER: 16871 if (nl80211_set_sar_sub_specs(rdev, sar_spec, 16872 spec, specs)) { 16873 err = -EINVAL; 16874 goto error; 16875 } 16876 break; 16877 default: 16878 err = -EINVAL; 16879 goto error; 16880 } 16881 specs++; 16882 } 16883 16884 sar_spec->num_sub_specs = specs; 16885 16886 rdev->cur_cmd_info = info; 16887 err = rdev_set_sar_specs(rdev, sar_spec); 16888 rdev->cur_cmd_info = NULL; 16889 error: 16890 kfree(sar_spec); 16891 return err; 16892 } 16893 16894 #define SELECTOR(__sel, name, value) \ 16895 ((__sel) == (value)) ? NL80211_IFL_SEL_##name : 16896 int __missing_selector(void); 16897 #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector() 16898 16899 static const struct genl_ops nl80211_ops[] = { 16900 { 16901 .cmd = NL80211_CMD_GET_WIPHY, 16902 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16903 .doit = nl80211_get_wiphy, 16904 .dumpit = nl80211_dump_wiphy, 16905 .done = nl80211_dump_wiphy_done, 16906 /* can be retrieved by unprivileged users */ 16907 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 16908 }, 16909 }; 16910 16911 static const struct genl_small_ops nl80211_small_ops[] = { 16912 { 16913 .cmd = NL80211_CMD_SET_WIPHY, 16914 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16915 .doit = nl80211_set_wiphy, 16916 .flags = GENL_UNS_ADMIN_PERM, 16917 }, 16918 { 16919 .cmd = NL80211_CMD_GET_INTERFACE, 16920 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16921 .doit = nl80211_get_interface, 16922 .dumpit = nl80211_dump_interface, 16923 /* can be retrieved by unprivileged users */ 16924 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 16925 }, 16926 { 16927 .cmd = NL80211_CMD_SET_INTERFACE, 16928 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16929 .doit = nl80211_set_interface, 16930 .flags = GENL_UNS_ADMIN_PERM, 16931 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 16932 NL80211_FLAG_NEED_RTNL), 16933 }, 16934 { 16935 .cmd = NL80211_CMD_NEW_INTERFACE, 16936 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16937 .doit = nl80211_new_interface, 16938 .flags = GENL_UNS_ADMIN_PERM, 16939 .internal_flags = 16940 IFLAGS(NL80211_FLAG_NEED_WIPHY | 16941 NL80211_FLAG_NEED_RTNL | 16942 /* we take the wiphy mutex later ourselves */ 16943 NL80211_FLAG_NO_WIPHY_MTX), 16944 }, 16945 { 16946 .cmd = NL80211_CMD_DEL_INTERFACE, 16947 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16948 .doit = nl80211_del_interface, 16949 .flags = GENL_UNS_ADMIN_PERM, 16950 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 16951 NL80211_FLAG_NEED_RTNL), 16952 }, 16953 { 16954 .cmd = NL80211_CMD_GET_KEY, 16955 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16956 .doit = nl80211_get_key, 16957 .flags = GENL_UNS_ADMIN_PERM, 16958 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16959 }, 16960 { 16961 .cmd = NL80211_CMD_SET_KEY, 16962 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16963 .doit = nl80211_set_key, 16964 .flags = GENL_UNS_ADMIN_PERM, 16965 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */ 16966 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16967 NL80211_FLAG_CLEAR_SKB), 16968 }, 16969 { 16970 .cmd = NL80211_CMD_NEW_KEY, 16971 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16972 .doit = nl80211_new_key, 16973 .flags = GENL_UNS_ADMIN_PERM, 16974 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16975 NL80211_FLAG_CLEAR_SKB), 16976 }, 16977 { 16978 .cmd = NL80211_CMD_DEL_KEY, 16979 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16980 .doit = nl80211_del_key, 16981 .flags = GENL_UNS_ADMIN_PERM, 16982 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16983 }, 16984 { 16985 .cmd = NL80211_CMD_SET_BEACON, 16986 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16987 .flags = GENL_UNS_ADMIN_PERM, 16988 .doit = nl80211_set_beacon, 16989 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16990 NL80211_FLAG_MLO_VALID_LINK_ID), 16991 }, 16992 { 16993 .cmd = NL80211_CMD_START_AP, 16994 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16995 .flags = GENL_UNS_ADMIN_PERM, 16996 .doit = nl80211_start_ap, 16997 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16998 NL80211_FLAG_MLO_VALID_LINK_ID), 16999 }, 17000 { 17001 .cmd = NL80211_CMD_STOP_AP, 17002 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17003 .flags = GENL_UNS_ADMIN_PERM, 17004 .doit = nl80211_stop_ap, 17005 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17006 NL80211_FLAG_MLO_VALID_LINK_ID), 17007 }, 17008 { 17009 .cmd = NL80211_CMD_GET_STATION, 17010 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17011 .doit = nl80211_get_station, 17012 .dumpit = nl80211_dump_station, 17013 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17014 }, 17015 { 17016 .cmd = NL80211_CMD_SET_STATION, 17017 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17018 .doit = nl80211_set_station, 17019 .flags = GENL_UNS_ADMIN_PERM, 17020 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17021 }, 17022 { 17023 .cmd = NL80211_CMD_NEW_STATION, 17024 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17025 .doit = nl80211_new_station, 17026 .flags = GENL_UNS_ADMIN_PERM, 17027 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17028 }, 17029 { 17030 .cmd = NL80211_CMD_DEL_STATION, 17031 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17032 .doit = nl80211_del_station, 17033 .flags = GENL_UNS_ADMIN_PERM, 17034 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on 17035 * whether MAC address is passed or not. If MAC address is 17036 * passed, then even during MLO, link ID is not required. 17037 */ 17038 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17039 }, 17040 { 17041 .cmd = NL80211_CMD_GET_MPATH, 17042 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17043 .doit = nl80211_get_mpath, 17044 .dumpit = nl80211_dump_mpath, 17045 .flags = GENL_UNS_ADMIN_PERM, 17046 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17047 }, 17048 { 17049 .cmd = NL80211_CMD_GET_MPP, 17050 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17051 .doit = nl80211_get_mpp, 17052 .dumpit = nl80211_dump_mpp, 17053 .flags = GENL_UNS_ADMIN_PERM, 17054 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17055 }, 17056 { 17057 .cmd = NL80211_CMD_SET_MPATH, 17058 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17059 .doit = nl80211_set_mpath, 17060 .flags = GENL_UNS_ADMIN_PERM, 17061 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17062 }, 17063 { 17064 .cmd = NL80211_CMD_NEW_MPATH, 17065 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17066 .doit = nl80211_new_mpath, 17067 .flags = GENL_UNS_ADMIN_PERM, 17068 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17069 }, 17070 { 17071 .cmd = NL80211_CMD_DEL_MPATH, 17072 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17073 .doit = nl80211_del_mpath, 17074 .flags = GENL_UNS_ADMIN_PERM, 17075 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17076 }, 17077 { 17078 .cmd = NL80211_CMD_SET_BSS, 17079 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17080 .doit = nl80211_set_bss, 17081 .flags = GENL_UNS_ADMIN_PERM, 17082 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17083 NL80211_FLAG_MLO_VALID_LINK_ID), 17084 }, 17085 { 17086 .cmd = NL80211_CMD_GET_REG, 17087 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17088 .doit = nl80211_get_reg_do, 17089 .dumpit = nl80211_get_reg_dump, 17090 /* can be retrieved by unprivileged users */ 17091 }, 17092 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 17093 { 17094 .cmd = NL80211_CMD_SET_REG, 17095 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17096 .doit = nl80211_set_reg, 17097 .flags = GENL_ADMIN_PERM, 17098 }, 17099 #endif 17100 { 17101 .cmd = NL80211_CMD_REQ_SET_REG, 17102 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17103 .doit = nl80211_req_set_reg, 17104 .flags = GENL_ADMIN_PERM, 17105 }, 17106 { 17107 .cmd = NL80211_CMD_RELOAD_REGDB, 17108 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17109 .doit = nl80211_reload_regdb, 17110 .flags = GENL_ADMIN_PERM, 17111 }, 17112 { 17113 .cmd = NL80211_CMD_GET_MESH_CONFIG, 17114 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17115 .doit = nl80211_get_mesh_config, 17116 /* can be retrieved by unprivileged users */ 17117 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17118 }, 17119 { 17120 .cmd = NL80211_CMD_SET_MESH_CONFIG, 17121 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17122 .doit = nl80211_update_mesh_config, 17123 .flags = GENL_UNS_ADMIN_PERM, 17124 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17125 }, 17126 { 17127 .cmd = NL80211_CMD_TRIGGER_SCAN, 17128 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17129 .doit = nl80211_trigger_scan, 17130 .flags = GENL_UNS_ADMIN_PERM, 17131 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17132 }, 17133 { 17134 .cmd = NL80211_CMD_ABORT_SCAN, 17135 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17136 .doit = nl80211_abort_scan, 17137 .flags = GENL_UNS_ADMIN_PERM, 17138 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17139 }, 17140 { 17141 .cmd = NL80211_CMD_GET_SCAN, 17142 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17143 .dumpit = nl80211_dump_scan, 17144 }, 17145 { 17146 .cmd = NL80211_CMD_START_SCHED_SCAN, 17147 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17148 .doit = nl80211_start_sched_scan, 17149 .flags = GENL_UNS_ADMIN_PERM, 17150 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17151 }, 17152 { 17153 .cmd = NL80211_CMD_STOP_SCHED_SCAN, 17154 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17155 .doit = nl80211_stop_sched_scan, 17156 .flags = GENL_UNS_ADMIN_PERM, 17157 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17158 }, 17159 { 17160 .cmd = NL80211_CMD_AUTHENTICATE, 17161 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17162 .doit = nl80211_authenticate, 17163 .flags = GENL_UNS_ADMIN_PERM, 17164 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17165 NL80211_FLAG_CLEAR_SKB), 17166 }, 17167 { 17168 .cmd = NL80211_CMD_ASSOCIATE, 17169 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17170 .doit = nl80211_associate, 17171 .flags = GENL_UNS_ADMIN_PERM, 17172 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17173 NL80211_FLAG_CLEAR_SKB), 17174 }, 17175 { 17176 .cmd = NL80211_CMD_DEAUTHENTICATE, 17177 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17178 .doit = nl80211_deauthenticate, 17179 .flags = GENL_UNS_ADMIN_PERM, 17180 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17181 }, 17182 { 17183 .cmd = NL80211_CMD_DISASSOCIATE, 17184 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17185 .doit = nl80211_disassociate, 17186 .flags = GENL_UNS_ADMIN_PERM, 17187 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17188 }, 17189 { 17190 .cmd = NL80211_CMD_JOIN_IBSS, 17191 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17192 .doit = nl80211_join_ibss, 17193 .flags = GENL_UNS_ADMIN_PERM, 17194 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17195 }, 17196 { 17197 .cmd = NL80211_CMD_LEAVE_IBSS, 17198 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17199 .doit = nl80211_leave_ibss, 17200 .flags = GENL_UNS_ADMIN_PERM, 17201 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17202 }, 17203 #ifdef CONFIG_NL80211_TESTMODE 17204 { 17205 .cmd = NL80211_CMD_TESTMODE, 17206 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17207 .doit = nl80211_testmode_do, 17208 .dumpit = nl80211_testmode_dump, 17209 .flags = GENL_UNS_ADMIN_PERM, 17210 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17211 }, 17212 #endif 17213 { 17214 .cmd = NL80211_CMD_CONNECT, 17215 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17216 .doit = nl80211_connect, 17217 .flags = GENL_UNS_ADMIN_PERM, 17218 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17219 NL80211_FLAG_CLEAR_SKB), 17220 }, 17221 { 17222 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS, 17223 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17224 .doit = nl80211_update_connect_params, 17225 .flags = GENL_ADMIN_PERM, 17226 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17227 NL80211_FLAG_CLEAR_SKB), 17228 }, 17229 { 17230 .cmd = NL80211_CMD_DISCONNECT, 17231 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17232 .doit = nl80211_disconnect, 17233 .flags = GENL_UNS_ADMIN_PERM, 17234 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17235 }, 17236 { 17237 .cmd = NL80211_CMD_SET_WIPHY_NETNS, 17238 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17239 .doit = nl80211_wiphy_netns, 17240 .flags = GENL_UNS_ADMIN_PERM, 17241 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17242 NL80211_FLAG_NEED_RTNL | 17243 NL80211_FLAG_NO_WIPHY_MTX), 17244 }, 17245 { 17246 .cmd = NL80211_CMD_GET_SURVEY, 17247 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17248 .dumpit = nl80211_dump_survey, 17249 }, 17250 { 17251 .cmd = NL80211_CMD_SET_PMKSA, 17252 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17253 .doit = nl80211_set_pmksa, 17254 .flags = GENL_UNS_ADMIN_PERM, 17255 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17256 NL80211_FLAG_CLEAR_SKB), 17257 }, 17258 { 17259 .cmd = NL80211_CMD_DEL_PMKSA, 17260 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17261 .doit = nl80211_del_pmksa, 17262 .flags = GENL_UNS_ADMIN_PERM, 17263 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17264 }, 17265 { 17266 .cmd = NL80211_CMD_FLUSH_PMKSA, 17267 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17268 .doit = nl80211_flush_pmksa, 17269 .flags = GENL_UNS_ADMIN_PERM, 17270 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17271 }, 17272 { 17273 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL, 17274 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17275 .doit = nl80211_remain_on_channel, 17276 .flags = GENL_UNS_ADMIN_PERM, 17277 /* FIXME: requiring a link ID here is probably not good */ 17278 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17279 NL80211_FLAG_MLO_VALID_LINK_ID), 17280 }, 17281 { 17282 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 17283 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17284 .doit = nl80211_cancel_remain_on_channel, 17285 .flags = GENL_UNS_ADMIN_PERM, 17286 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17287 }, 17288 { 17289 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK, 17290 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17291 .doit = nl80211_set_tx_bitrate_mask, 17292 .flags = GENL_UNS_ADMIN_PERM, 17293 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17294 NL80211_FLAG_MLO_VALID_LINK_ID), 17295 }, 17296 { 17297 .cmd = NL80211_CMD_REGISTER_FRAME, 17298 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17299 .doit = nl80211_register_mgmt, 17300 .flags = GENL_UNS_ADMIN_PERM, 17301 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 17302 }, 17303 { 17304 .cmd = NL80211_CMD_FRAME, 17305 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17306 .doit = nl80211_tx_mgmt, 17307 .flags = GENL_UNS_ADMIN_PERM, 17308 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17309 }, 17310 { 17311 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL, 17312 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17313 .doit = nl80211_tx_mgmt_cancel_wait, 17314 .flags = GENL_UNS_ADMIN_PERM, 17315 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17316 }, 17317 { 17318 .cmd = NL80211_CMD_SET_POWER_SAVE, 17319 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17320 .doit = nl80211_set_power_save, 17321 .flags = GENL_UNS_ADMIN_PERM, 17322 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17323 }, 17324 { 17325 .cmd = NL80211_CMD_GET_POWER_SAVE, 17326 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17327 .doit = nl80211_get_power_save, 17328 /* can be retrieved by unprivileged users */ 17329 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17330 }, 17331 { 17332 .cmd = NL80211_CMD_SET_CQM, 17333 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17334 .doit = nl80211_set_cqm, 17335 .flags = GENL_UNS_ADMIN_PERM, 17336 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17337 }, 17338 { 17339 .cmd = NL80211_CMD_SET_CHANNEL, 17340 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17341 .doit = nl80211_set_channel, 17342 .flags = GENL_UNS_ADMIN_PERM, 17343 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17344 NL80211_FLAG_MLO_VALID_LINK_ID), 17345 }, 17346 { 17347 .cmd = NL80211_CMD_JOIN_MESH, 17348 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17349 .doit = nl80211_join_mesh, 17350 .flags = GENL_UNS_ADMIN_PERM, 17351 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17352 }, 17353 { 17354 .cmd = NL80211_CMD_LEAVE_MESH, 17355 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17356 .doit = nl80211_leave_mesh, 17357 .flags = GENL_UNS_ADMIN_PERM, 17358 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17359 }, 17360 { 17361 .cmd = NL80211_CMD_JOIN_OCB, 17362 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17363 .doit = nl80211_join_ocb, 17364 .flags = GENL_UNS_ADMIN_PERM, 17365 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17366 }, 17367 { 17368 .cmd = NL80211_CMD_LEAVE_OCB, 17369 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17370 .doit = nl80211_leave_ocb, 17371 .flags = GENL_UNS_ADMIN_PERM, 17372 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17373 }, 17374 #ifdef CONFIG_PM 17375 { 17376 .cmd = NL80211_CMD_GET_WOWLAN, 17377 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17378 .doit = nl80211_get_wowlan, 17379 /* can be retrieved by unprivileged users */ 17380 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17381 }, 17382 { 17383 .cmd = NL80211_CMD_SET_WOWLAN, 17384 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17385 .doit = nl80211_set_wowlan, 17386 .flags = GENL_UNS_ADMIN_PERM, 17387 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17388 }, 17389 #endif 17390 { 17391 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD, 17392 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17393 .doit = nl80211_set_rekey_data, 17394 .flags = GENL_UNS_ADMIN_PERM, 17395 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17396 NL80211_FLAG_CLEAR_SKB), 17397 }, 17398 { 17399 .cmd = NL80211_CMD_TDLS_MGMT, 17400 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17401 .doit = nl80211_tdls_mgmt, 17402 .flags = GENL_UNS_ADMIN_PERM, 17403 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17404 NL80211_FLAG_MLO_VALID_LINK_ID), 17405 }, 17406 { 17407 .cmd = NL80211_CMD_TDLS_OPER, 17408 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17409 .doit = nl80211_tdls_oper, 17410 .flags = GENL_UNS_ADMIN_PERM, 17411 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17412 }, 17413 { 17414 .cmd = NL80211_CMD_UNEXPECTED_FRAME, 17415 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17416 .doit = nl80211_register_unexpected_frame, 17417 .flags = GENL_UNS_ADMIN_PERM, 17418 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17419 }, 17420 { 17421 .cmd = NL80211_CMD_PROBE_CLIENT, 17422 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17423 .doit = nl80211_probe_client, 17424 .flags = GENL_UNS_ADMIN_PERM, 17425 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17426 }, 17427 { 17428 .cmd = NL80211_CMD_REGISTER_BEACONS, 17429 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17430 .doit = nl80211_register_beacons, 17431 .flags = GENL_UNS_ADMIN_PERM, 17432 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17433 }, 17434 { 17435 .cmd = NL80211_CMD_SET_NOACK_MAP, 17436 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17437 .doit = nl80211_set_noack_map, 17438 .flags = GENL_UNS_ADMIN_PERM, 17439 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17440 }, 17441 { 17442 .cmd = NL80211_CMD_START_P2P_DEVICE, 17443 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17444 .doit = nl80211_start_p2p_device, 17445 .flags = GENL_UNS_ADMIN_PERM, 17446 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17447 NL80211_FLAG_NEED_RTNL), 17448 }, 17449 { 17450 .cmd = NL80211_CMD_STOP_P2P_DEVICE, 17451 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17452 .doit = nl80211_stop_p2p_device, 17453 .flags = GENL_UNS_ADMIN_PERM, 17454 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17455 NL80211_FLAG_NEED_RTNL), 17456 }, 17457 { 17458 .cmd = NL80211_CMD_START_NAN, 17459 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17460 .doit = nl80211_start_nan, 17461 .flags = GENL_ADMIN_PERM, 17462 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17463 NL80211_FLAG_NEED_RTNL), 17464 }, 17465 { 17466 .cmd = NL80211_CMD_STOP_NAN, 17467 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17468 .doit = nl80211_stop_nan, 17469 .flags = GENL_ADMIN_PERM, 17470 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17471 NL80211_FLAG_NEED_RTNL), 17472 }, 17473 { 17474 .cmd = NL80211_CMD_ADD_NAN_FUNCTION, 17475 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17476 .doit = nl80211_nan_add_func, 17477 .flags = GENL_ADMIN_PERM, 17478 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17479 }, 17480 { 17481 .cmd = NL80211_CMD_DEL_NAN_FUNCTION, 17482 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17483 .doit = nl80211_nan_del_func, 17484 .flags = GENL_ADMIN_PERM, 17485 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17486 }, 17487 { 17488 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG, 17489 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17490 .doit = nl80211_nan_change_config, 17491 .flags = GENL_ADMIN_PERM, 17492 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17493 }, 17494 { 17495 .cmd = NL80211_CMD_SET_MCAST_RATE, 17496 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17497 .doit = nl80211_set_mcast_rate, 17498 .flags = GENL_UNS_ADMIN_PERM, 17499 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17500 }, 17501 { 17502 .cmd = NL80211_CMD_SET_MAC_ACL, 17503 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17504 .doit = nl80211_set_mac_acl, 17505 .flags = GENL_UNS_ADMIN_PERM, 17506 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17507 NL80211_FLAG_MLO_UNSUPPORTED), 17508 }, 17509 { 17510 .cmd = NL80211_CMD_RADAR_DETECT, 17511 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17512 .doit = nl80211_start_radar_detection, 17513 .flags = GENL_UNS_ADMIN_PERM, 17514 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17515 NL80211_FLAG_NO_WIPHY_MTX | 17516 NL80211_FLAG_MLO_VALID_LINK_ID), 17517 }, 17518 { 17519 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES, 17520 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17521 .doit = nl80211_get_protocol_features, 17522 }, 17523 { 17524 .cmd = NL80211_CMD_UPDATE_FT_IES, 17525 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17526 .doit = nl80211_update_ft_ies, 17527 .flags = GENL_UNS_ADMIN_PERM, 17528 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17529 }, 17530 { 17531 .cmd = NL80211_CMD_CRIT_PROTOCOL_START, 17532 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17533 .doit = nl80211_crit_protocol_start, 17534 .flags = GENL_UNS_ADMIN_PERM, 17535 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17536 }, 17537 { 17538 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP, 17539 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17540 .doit = nl80211_crit_protocol_stop, 17541 .flags = GENL_UNS_ADMIN_PERM, 17542 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17543 }, 17544 { 17545 .cmd = NL80211_CMD_GET_COALESCE, 17546 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17547 .doit = nl80211_get_coalesce, 17548 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17549 }, 17550 { 17551 .cmd = NL80211_CMD_SET_COALESCE, 17552 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17553 .doit = nl80211_set_coalesce, 17554 .flags = GENL_UNS_ADMIN_PERM, 17555 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17556 }, 17557 { 17558 .cmd = NL80211_CMD_CHANNEL_SWITCH, 17559 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17560 .doit = nl80211_channel_switch, 17561 .flags = GENL_UNS_ADMIN_PERM, 17562 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17563 NL80211_FLAG_MLO_VALID_LINK_ID), 17564 }, 17565 { 17566 .cmd = NL80211_CMD_VENDOR, 17567 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17568 .doit = nl80211_vendor_cmd, 17569 .dumpit = nl80211_vendor_cmd_dump, 17570 .flags = GENL_UNS_ADMIN_PERM, 17571 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17572 NL80211_FLAG_CLEAR_SKB), 17573 }, 17574 { 17575 .cmd = NL80211_CMD_SET_QOS_MAP, 17576 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17577 .doit = nl80211_set_qos_map, 17578 .flags = GENL_UNS_ADMIN_PERM, 17579 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17580 }, 17581 { 17582 .cmd = NL80211_CMD_ADD_TX_TS, 17583 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17584 .doit = nl80211_add_tx_ts, 17585 .flags = GENL_UNS_ADMIN_PERM, 17586 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17587 NL80211_FLAG_MLO_UNSUPPORTED), 17588 }, 17589 { 17590 .cmd = NL80211_CMD_DEL_TX_TS, 17591 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17592 .doit = nl80211_del_tx_ts, 17593 .flags = GENL_UNS_ADMIN_PERM, 17594 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17595 }, 17596 { 17597 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH, 17598 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17599 .doit = nl80211_tdls_channel_switch, 17600 .flags = GENL_UNS_ADMIN_PERM, 17601 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17602 }, 17603 { 17604 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH, 17605 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17606 .doit = nl80211_tdls_cancel_channel_switch, 17607 .flags = GENL_UNS_ADMIN_PERM, 17608 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17609 }, 17610 { 17611 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST, 17612 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17613 .doit = nl80211_set_multicast_to_unicast, 17614 .flags = GENL_UNS_ADMIN_PERM, 17615 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17616 }, 17617 { 17618 .cmd = NL80211_CMD_SET_PMK, 17619 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17620 .doit = nl80211_set_pmk, 17621 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17622 NL80211_FLAG_CLEAR_SKB), 17623 }, 17624 { 17625 .cmd = NL80211_CMD_DEL_PMK, 17626 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17627 .doit = nl80211_del_pmk, 17628 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17629 }, 17630 { 17631 .cmd = NL80211_CMD_EXTERNAL_AUTH, 17632 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17633 .doit = nl80211_external_auth, 17634 .flags = GENL_ADMIN_PERM, 17635 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17636 }, 17637 { 17638 .cmd = NL80211_CMD_CONTROL_PORT_FRAME, 17639 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17640 .doit = nl80211_tx_control_port, 17641 .flags = GENL_UNS_ADMIN_PERM, 17642 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17643 }, 17644 { 17645 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS, 17646 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17647 .doit = nl80211_get_ftm_responder_stats, 17648 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17649 NL80211_FLAG_MLO_VALID_LINK_ID), 17650 }, 17651 { 17652 .cmd = NL80211_CMD_PEER_MEASUREMENT_START, 17653 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17654 .doit = nl80211_pmsr_start, 17655 .flags = GENL_UNS_ADMIN_PERM, 17656 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17657 }, 17658 { 17659 .cmd = NL80211_CMD_NOTIFY_RADAR, 17660 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17661 .doit = nl80211_notify_radar_detection, 17662 .flags = GENL_UNS_ADMIN_PERM, 17663 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17664 }, 17665 { 17666 .cmd = NL80211_CMD_UPDATE_OWE_INFO, 17667 .doit = nl80211_update_owe_info, 17668 .flags = GENL_ADMIN_PERM, 17669 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17670 }, 17671 { 17672 .cmd = NL80211_CMD_PROBE_MESH_LINK, 17673 .doit = nl80211_probe_mesh_link, 17674 .flags = GENL_UNS_ADMIN_PERM, 17675 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17676 }, 17677 { 17678 .cmd = NL80211_CMD_SET_TID_CONFIG, 17679 .doit = nl80211_set_tid_config, 17680 .flags = GENL_UNS_ADMIN_PERM, 17681 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17682 NL80211_FLAG_MLO_VALID_LINK_ID), 17683 }, 17684 { 17685 .cmd = NL80211_CMD_SET_SAR_SPECS, 17686 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17687 .doit = nl80211_set_sar_specs, 17688 .flags = GENL_UNS_ADMIN_PERM, 17689 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17690 NL80211_FLAG_NEED_RTNL), 17691 }, 17692 { 17693 .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST, 17694 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17695 .doit = nl80211_color_change, 17696 .flags = GENL_UNS_ADMIN_PERM, 17697 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17698 NL80211_FLAG_MLO_VALID_LINK_ID), 17699 }, 17700 { 17701 .cmd = NL80211_CMD_SET_FILS_AAD, 17702 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17703 .doit = nl80211_set_fils_aad, 17704 .flags = GENL_UNS_ADMIN_PERM, 17705 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17706 }, 17707 { 17708 .cmd = NL80211_CMD_ADD_LINK, 17709 .doit = nl80211_add_link, 17710 .flags = GENL_UNS_ADMIN_PERM, 17711 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17712 }, 17713 { 17714 .cmd = NL80211_CMD_REMOVE_LINK, 17715 .doit = nl80211_remove_link, 17716 .flags = GENL_UNS_ADMIN_PERM, 17717 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17718 NL80211_FLAG_MLO_VALID_LINK_ID), 17719 }, 17720 { 17721 .cmd = NL80211_CMD_ADD_LINK_STA, 17722 .doit = nl80211_add_link_station, 17723 .flags = GENL_UNS_ADMIN_PERM, 17724 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17725 NL80211_FLAG_MLO_VALID_LINK_ID), 17726 }, 17727 { 17728 .cmd = NL80211_CMD_MODIFY_LINK_STA, 17729 .doit = nl80211_modify_link_station, 17730 .flags = GENL_UNS_ADMIN_PERM, 17731 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17732 NL80211_FLAG_MLO_VALID_LINK_ID), 17733 }, 17734 { 17735 .cmd = NL80211_CMD_REMOVE_LINK_STA, 17736 .doit = nl80211_remove_link_station, 17737 .flags = GENL_UNS_ADMIN_PERM, 17738 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17739 NL80211_FLAG_MLO_VALID_LINK_ID), 17740 }, 17741 { 17742 .cmd = NL80211_CMD_SET_HW_TIMESTAMP, 17743 .doit = nl80211_set_hw_timestamp, 17744 .flags = GENL_UNS_ADMIN_PERM, 17745 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17746 }, 17747 { 17748 .cmd = NL80211_CMD_SET_TID_TO_LINK_MAPPING, 17749 .doit = nl80211_set_ttlm, 17750 .flags = GENL_UNS_ADMIN_PERM, 17751 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17752 }, 17753 { 17754 .cmd = NL80211_CMD_ASSOC_MLO_RECONF, 17755 .doit = nl80211_assoc_ml_reconf, 17756 .flags = GENL_UNS_ADMIN_PERM, 17757 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17758 }, 17759 { 17760 .cmd = NL80211_CMD_EPCS_CFG, 17761 .doit = nl80211_epcs_cfg, 17762 .flags = GENL_UNS_ADMIN_PERM, 17763 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17764 }, 17765 }; 17766 17767 static struct genl_family nl80211_fam __ro_after_init = { 17768 .name = NL80211_GENL_NAME, /* have users key off the name instead */ 17769 .hdrsize = 0, /* no private header */ 17770 .version = 1, /* no particular meaning now */ 17771 .maxattr = NL80211_ATTR_MAX, 17772 .policy = nl80211_policy, 17773 .netnsok = true, 17774 .pre_doit = nl80211_pre_doit, 17775 .post_doit = nl80211_post_doit, 17776 .module = THIS_MODULE, 17777 .ops = nl80211_ops, 17778 .n_ops = ARRAY_SIZE(nl80211_ops), 17779 .small_ops = nl80211_small_ops, 17780 .n_small_ops = ARRAY_SIZE(nl80211_small_ops), 17781 .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1, 17782 .mcgrps = nl80211_mcgrps, 17783 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps), 17784 .parallel_ops = true, 17785 }; 17786 17787 /* notification functions */ 17788 17789 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev, 17790 enum nl80211_commands cmd) 17791 { 17792 struct sk_buff *msg; 17793 struct nl80211_dump_wiphy_state state = {}; 17794 17795 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY && 17796 cmd != NL80211_CMD_DEL_WIPHY); 17797 17798 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17799 if (!msg) 17800 return; 17801 17802 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) { 17803 nlmsg_free(msg); 17804 return; 17805 } 17806 17807 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17808 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17809 } 17810 17811 void nl80211_notify_iface(struct cfg80211_registered_device *rdev, 17812 struct wireless_dev *wdev, 17813 enum nl80211_commands cmd) 17814 { 17815 struct sk_buff *msg; 17816 17817 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17818 if (!msg) 17819 return; 17820 17821 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) { 17822 nlmsg_free(msg); 17823 return; 17824 } 17825 17826 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17827 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17828 } 17829 17830 static int nl80211_add_scan_req(struct sk_buff *msg, 17831 struct cfg80211_registered_device *rdev) 17832 { 17833 struct cfg80211_scan_request *req = rdev->scan_req; 17834 struct nlattr *nest; 17835 int i; 17836 struct cfg80211_scan_info *info; 17837 17838 if (WARN_ON(!req)) 17839 return 0; 17840 17841 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS); 17842 if (!nest) 17843 goto nla_put_failure; 17844 for (i = 0; i < req->n_ssids; i++) { 17845 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid)) 17846 goto nla_put_failure; 17847 } 17848 nla_nest_end(msg, nest); 17849 17850 if (req->flags & NL80211_SCAN_FLAG_FREQ_KHZ) { 17851 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ); 17852 if (!nest) 17853 goto nla_put_failure; 17854 for (i = 0; i < req->n_channels; i++) { 17855 if (nla_put_u32(msg, i, 17856 ieee80211_channel_to_khz(req->channels[i]))) 17857 goto nla_put_failure; 17858 } 17859 nla_nest_end(msg, nest); 17860 } else { 17861 nest = nla_nest_start_noflag(msg, 17862 NL80211_ATTR_SCAN_FREQUENCIES); 17863 if (!nest) 17864 goto nla_put_failure; 17865 for (i = 0; i < req->n_channels; i++) { 17866 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 17867 goto nla_put_failure; 17868 } 17869 nla_nest_end(msg, nest); 17870 } 17871 17872 if (req->ie && 17873 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie)) 17874 goto nla_put_failure; 17875 17876 if (req->flags && 17877 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags)) 17878 goto nla_put_failure; 17879 17880 info = rdev->int_scan_req ? &rdev->int_scan_req->info : 17881 &rdev->scan_req->info; 17882 if (info->scan_start_tsf && 17883 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF, 17884 info->scan_start_tsf, NL80211_BSS_PAD) || 17885 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN, 17886 info->tsf_bssid))) 17887 goto nla_put_failure; 17888 17889 return 0; 17890 nla_put_failure: 17891 return -ENOBUFS; 17892 } 17893 17894 static int nl80211_prep_scan_msg(struct sk_buff *msg, 17895 struct cfg80211_registered_device *rdev, 17896 struct wireless_dev *wdev, 17897 u32 portid, u32 seq, int flags, 17898 u32 cmd) 17899 { 17900 void *hdr; 17901 17902 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 17903 if (!hdr) 17904 return -1; 17905 17906 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17907 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 17908 wdev->netdev->ifindex)) || 17909 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 17910 NL80211_ATTR_PAD)) 17911 goto nla_put_failure; 17912 17913 /* ignore errors and send incomplete event anyway */ 17914 nl80211_add_scan_req(msg, rdev); 17915 17916 genlmsg_end(msg, hdr); 17917 return 0; 17918 17919 nla_put_failure: 17920 genlmsg_cancel(msg, hdr); 17921 return -EMSGSIZE; 17922 } 17923 17924 static int 17925 nl80211_prep_sched_scan_msg(struct sk_buff *msg, 17926 struct cfg80211_sched_scan_request *req, u32 cmd) 17927 { 17928 void *hdr; 17929 17930 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 17931 if (!hdr) 17932 return -1; 17933 17934 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, 17935 wiphy_to_rdev(req->wiphy)->wiphy_idx) || 17936 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) || 17937 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid, 17938 NL80211_ATTR_PAD)) 17939 goto nla_put_failure; 17940 17941 genlmsg_end(msg, hdr); 17942 return 0; 17943 17944 nla_put_failure: 17945 genlmsg_cancel(msg, hdr); 17946 return -EMSGSIZE; 17947 } 17948 17949 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev, 17950 struct wireless_dev *wdev) 17951 { 17952 struct sk_buff *msg; 17953 17954 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17955 if (!msg) 17956 return; 17957 17958 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17959 NL80211_CMD_TRIGGER_SCAN) < 0) { 17960 nlmsg_free(msg); 17961 return; 17962 } 17963 17964 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17965 NL80211_MCGRP_SCAN, GFP_KERNEL); 17966 } 17967 17968 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev, 17969 struct wireless_dev *wdev, bool aborted) 17970 { 17971 struct sk_buff *msg; 17972 17973 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17974 if (!msg) 17975 return NULL; 17976 17977 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17978 aborted ? NL80211_CMD_SCAN_ABORTED : 17979 NL80211_CMD_NEW_SCAN_RESULTS) < 0) { 17980 nlmsg_free(msg); 17981 return NULL; 17982 } 17983 17984 return msg; 17985 } 17986 17987 /* send message created by nl80211_build_scan_msg() */ 17988 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev, 17989 struct sk_buff *msg) 17990 { 17991 if (!msg) 17992 return; 17993 17994 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17995 NL80211_MCGRP_SCAN, GFP_KERNEL); 17996 } 17997 17998 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd) 17999 { 18000 struct sk_buff *msg; 18001 18002 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18003 if (!msg) 18004 return; 18005 18006 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) { 18007 nlmsg_free(msg); 18008 return; 18009 } 18010 18011 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0, 18012 NL80211_MCGRP_SCAN, GFP_KERNEL); 18013 } 18014 18015 static bool nl80211_reg_change_event_fill(struct sk_buff *msg, 18016 struct regulatory_request *request) 18017 { 18018 /* Userspace can always count this one always being set */ 18019 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator)) 18020 goto nla_put_failure; 18021 18022 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') { 18023 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 18024 NL80211_REGDOM_TYPE_WORLD)) 18025 goto nla_put_failure; 18026 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') { 18027 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 18028 NL80211_REGDOM_TYPE_CUSTOM_WORLD)) 18029 goto nla_put_failure; 18030 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') || 18031 request->intersect) { 18032 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 18033 NL80211_REGDOM_TYPE_INTERSECTION)) 18034 goto nla_put_failure; 18035 } else { 18036 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 18037 NL80211_REGDOM_TYPE_COUNTRY) || 18038 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, 18039 request->alpha2)) 18040 goto nla_put_failure; 18041 } 18042 18043 if (request->wiphy_idx != WIPHY_IDX_INVALID) { 18044 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx); 18045 18046 if (wiphy && 18047 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx)) 18048 goto nla_put_failure; 18049 18050 if (wiphy && 18051 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 18052 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 18053 goto nla_put_failure; 18054 } 18055 18056 return true; 18057 18058 nla_put_failure: 18059 return false; 18060 } 18061 18062 /* 18063 * This can happen on global regulatory changes or device specific settings 18064 * based on custom regulatory domains. 18065 */ 18066 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id, 18067 struct regulatory_request *request) 18068 { 18069 struct sk_buff *msg; 18070 void *hdr; 18071 18072 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18073 if (!msg) 18074 return; 18075 18076 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id); 18077 if (!hdr) 18078 goto nla_put_failure; 18079 18080 if (!nl80211_reg_change_event_fill(msg, request)) 18081 goto nla_put_failure; 18082 18083 genlmsg_end(msg, hdr); 18084 18085 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 18086 NL80211_MCGRP_REGULATORY); 18087 18088 return; 18089 18090 nla_put_failure: 18091 nlmsg_free(msg); 18092 } 18093 18094 struct nl80211_mlme_event { 18095 enum nl80211_commands cmd; 18096 const u8 *buf; 18097 size_t buf_len; 18098 int uapsd_queues; 18099 const u8 *req_ies; 18100 size_t req_ies_len; 18101 bool reconnect; 18102 }; 18103 18104 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev, 18105 struct net_device *netdev, 18106 const struct nl80211_mlme_event *event, 18107 gfp_t gfp) 18108 { 18109 struct sk_buff *msg; 18110 void *hdr; 18111 18112 msg = nlmsg_new(100 + event->buf_len + event->req_ies_len, gfp); 18113 if (!msg) 18114 return; 18115 18116 hdr = nl80211hdr_put(msg, 0, 0, 0, event->cmd); 18117 if (!hdr) { 18118 nlmsg_free(msg); 18119 return; 18120 } 18121 18122 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18123 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18124 nla_put(msg, NL80211_ATTR_FRAME, event->buf_len, event->buf) || 18125 (event->req_ies && 18126 nla_put(msg, NL80211_ATTR_REQ_IE, event->req_ies_len, 18127 event->req_ies))) 18128 goto nla_put_failure; 18129 18130 if (event->reconnect && 18131 nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED)) 18132 goto nla_put_failure; 18133 18134 if (event->uapsd_queues >= 0) { 18135 struct nlattr *nla_wmm = 18136 nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME); 18137 if (!nla_wmm) 18138 goto nla_put_failure; 18139 18140 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES, 18141 event->uapsd_queues)) 18142 goto nla_put_failure; 18143 18144 nla_nest_end(msg, nla_wmm); 18145 } 18146 18147 genlmsg_end(msg, hdr); 18148 18149 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18150 NL80211_MCGRP_MLME, gfp); 18151 return; 18152 18153 nla_put_failure: 18154 nlmsg_free(msg); 18155 } 18156 18157 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev, 18158 struct net_device *netdev, const u8 *buf, 18159 size_t len, gfp_t gfp) 18160 { 18161 struct nl80211_mlme_event event = { 18162 .cmd = NL80211_CMD_AUTHENTICATE, 18163 .buf = buf, 18164 .buf_len = len, 18165 .uapsd_queues = -1, 18166 }; 18167 18168 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 18169 } 18170 18171 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev, 18172 struct net_device *netdev, 18173 const struct cfg80211_rx_assoc_resp_data *data) 18174 { 18175 struct nl80211_mlme_event event = { 18176 .cmd = NL80211_CMD_ASSOCIATE, 18177 .buf = data->buf, 18178 .buf_len = data->len, 18179 .uapsd_queues = data->uapsd_queues, 18180 .req_ies = data->req_ies, 18181 .req_ies_len = data->req_ies_len, 18182 }; 18183 18184 nl80211_send_mlme_event(rdev, netdev, &event, GFP_KERNEL); 18185 } 18186 18187 void nl80211_send_deauth(struct cfg80211_registered_device *rdev, 18188 struct net_device *netdev, const u8 *buf, 18189 size_t len, bool reconnect, gfp_t gfp) 18190 { 18191 struct nl80211_mlme_event event = { 18192 .cmd = NL80211_CMD_DEAUTHENTICATE, 18193 .buf = buf, 18194 .buf_len = len, 18195 .reconnect = reconnect, 18196 .uapsd_queues = -1, 18197 }; 18198 18199 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 18200 } 18201 18202 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev, 18203 struct net_device *netdev, const u8 *buf, 18204 size_t len, bool reconnect, gfp_t gfp) 18205 { 18206 struct nl80211_mlme_event event = { 18207 .cmd = NL80211_CMD_DISASSOCIATE, 18208 .buf = buf, 18209 .buf_len = len, 18210 .reconnect = reconnect, 18211 .uapsd_queues = -1, 18212 }; 18213 18214 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 18215 } 18216 18217 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf, 18218 size_t len) 18219 { 18220 struct wireless_dev *wdev = dev->ieee80211_ptr; 18221 struct wiphy *wiphy = wdev->wiphy; 18222 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18223 const struct ieee80211_mgmt *mgmt = (void *)buf; 18224 struct nl80211_mlme_event event = { 18225 .buf = buf, 18226 .buf_len = len, 18227 .uapsd_queues = -1, 18228 }; 18229 18230 if (WARN_ON(len < 2)) 18231 return; 18232 18233 if (ieee80211_is_deauth(mgmt->frame_control)) { 18234 event.cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE; 18235 } else if (ieee80211_is_disassoc(mgmt->frame_control)) { 18236 event.cmd = NL80211_CMD_UNPROT_DISASSOCIATE; 18237 } else if (ieee80211_is_beacon(mgmt->frame_control)) { 18238 if (wdev->unprot_beacon_reported && 18239 elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000) 18240 return; 18241 event.cmd = NL80211_CMD_UNPROT_BEACON; 18242 wdev->unprot_beacon_reported = jiffies; 18243 } else { 18244 return; 18245 } 18246 18247 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len); 18248 nl80211_send_mlme_event(rdev, dev, &event, GFP_ATOMIC); 18249 } 18250 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt); 18251 18252 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev, 18253 struct net_device *netdev, int cmd, 18254 const u8 *addr, gfp_t gfp) 18255 { 18256 struct sk_buff *msg; 18257 void *hdr; 18258 18259 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18260 if (!msg) 18261 return; 18262 18263 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18264 if (!hdr) { 18265 nlmsg_free(msg); 18266 return; 18267 } 18268 18269 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18270 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18271 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 18272 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 18273 goto nla_put_failure; 18274 18275 genlmsg_end(msg, hdr); 18276 18277 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18278 NL80211_MCGRP_MLME, gfp); 18279 return; 18280 18281 nla_put_failure: 18282 nlmsg_free(msg); 18283 } 18284 18285 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev, 18286 struct net_device *netdev, const u8 *addr, 18287 gfp_t gfp) 18288 { 18289 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE, 18290 addr, gfp); 18291 } 18292 18293 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev, 18294 struct net_device *netdev, const u8 *addr, 18295 gfp_t gfp) 18296 { 18297 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE, 18298 addr, gfp); 18299 } 18300 18301 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev, 18302 struct net_device *netdev, 18303 struct cfg80211_connect_resp_params *cr, 18304 gfp_t gfp) 18305 { 18306 struct sk_buff *msg; 18307 void *hdr; 18308 unsigned int link; 18309 size_t link_info_size = 0; 18310 const u8 *connected_addr = cr->valid_links ? 18311 cr->ap_mld_addr : cr->links[0].bssid; 18312 18313 if (cr->valid_links) { 18314 for_each_valid_link(cr, link) { 18315 /* Nested attribute header */ 18316 link_info_size += NLA_HDRLEN; 18317 /* Link ID */ 18318 link_info_size += nla_total_size(sizeof(u8)); 18319 link_info_size += cr->links[link].addr ? 18320 nla_total_size(ETH_ALEN) : 0; 18321 link_info_size += (cr->links[link].bssid || 18322 cr->links[link].bss) ? 18323 nla_total_size(ETH_ALEN) : 0; 18324 link_info_size += nla_total_size(sizeof(u16)); 18325 } 18326 } 18327 18328 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len + 18329 cr->fils.kek_len + cr->fils.pmk_len + 18330 (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size, 18331 gfp); 18332 if (!msg) 18333 return; 18334 18335 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT); 18336 if (!hdr) { 18337 nlmsg_free(msg); 18338 return; 18339 } 18340 18341 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18342 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18343 (connected_addr && 18344 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) || 18345 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18346 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE : 18347 cr->status) || 18348 (cr->status < 0 && 18349 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 18350 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON, 18351 cr->timeout_reason))) || 18352 (cr->req_ie && 18353 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) || 18354 (cr->resp_ie && 18355 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len, 18356 cr->resp_ie)) || 18357 (cr->fils.update_erp_next_seq_num && 18358 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18359 cr->fils.erp_next_seq_num)) || 18360 (cr->status == WLAN_STATUS_SUCCESS && 18361 ((cr->fils.kek && 18362 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len, 18363 cr->fils.kek)) || 18364 (cr->fils.pmk && 18365 nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) || 18366 (cr->fils.pmkid && 18367 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid))))) 18368 goto nla_put_failure; 18369 18370 if (cr->valid_links) { 18371 int i = 1; 18372 struct nlattr *nested; 18373 18374 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18375 if (!nested) 18376 goto nla_put_failure; 18377 18378 for_each_valid_link(cr, link) { 18379 struct nlattr *nested_mlo_links; 18380 const u8 *bssid = cr->links[link].bss ? 18381 cr->links[link].bss->bssid : 18382 cr->links[link].bssid; 18383 18384 nested_mlo_links = nla_nest_start(msg, i); 18385 if (!nested_mlo_links) 18386 goto nla_put_failure; 18387 18388 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18389 (bssid && 18390 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18391 (cr->links[link].addr && 18392 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18393 cr->links[link].addr)) || 18394 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18395 cr->links[link].status)) 18396 goto nla_put_failure; 18397 18398 nla_nest_end(msg, nested_mlo_links); 18399 i++; 18400 } 18401 nla_nest_end(msg, nested); 18402 } 18403 18404 genlmsg_end(msg, hdr); 18405 18406 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18407 NL80211_MCGRP_MLME, gfp); 18408 return; 18409 18410 nla_put_failure: 18411 nlmsg_free(msg); 18412 } 18413 18414 void nl80211_send_roamed(struct cfg80211_registered_device *rdev, 18415 struct net_device *netdev, 18416 struct cfg80211_roam_info *info, gfp_t gfp) 18417 { 18418 struct sk_buff *msg; 18419 void *hdr; 18420 size_t link_info_size = 0; 18421 unsigned int link; 18422 const u8 *connected_addr = info->ap_mld_addr ? 18423 info->ap_mld_addr : 18424 (info->links[0].bss ? 18425 info->links[0].bss->bssid : 18426 info->links[0].bssid); 18427 18428 if (info->valid_links) { 18429 for_each_valid_link(info, link) { 18430 /* Nested attribute header */ 18431 link_info_size += NLA_HDRLEN; 18432 /* Link ID */ 18433 link_info_size += nla_total_size(sizeof(u8)); 18434 link_info_size += info->links[link].addr ? 18435 nla_total_size(ETH_ALEN) : 0; 18436 link_info_size += (info->links[link].bssid || 18437 info->links[link].bss) ? 18438 nla_total_size(ETH_ALEN) : 0; 18439 } 18440 } 18441 18442 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len + 18443 info->fils.kek_len + info->fils.pmk_len + 18444 (info->fils.pmkid ? WLAN_PMKID_LEN : 0) + 18445 link_info_size, gfp); 18446 if (!msg) 18447 return; 18448 18449 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM); 18450 if (!hdr) { 18451 nlmsg_free(msg); 18452 return; 18453 } 18454 18455 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18456 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18457 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) || 18458 (info->req_ie && 18459 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len, 18460 info->req_ie)) || 18461 (info->resp_ie && 18462 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len, 18463 info->resp_ie)) || 18464 (info->fils.update_erp_next_seq_num && 18465 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18466 info->fils.erp_next_seq_num)) || 18467 (info->fils.kek && 18468 nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len, 18469 info->fils.kek)) || 18470 (info->fils.pmk && 18471 nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) || 18472 (info->fils.pmkid && 18473 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid))) 18474 goto nla_put_failure; 18475 18476 if (info->valid_links) { 18477 int i = 1; 18478 struct nlattr *nested; 18479 18480 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18481 if (!nested) 18482 goto nla_put_failure; 18483 18484 for_each_valid_link(info, link) { 18485 struct nlattr *nested_mlo_links; 18486 const u8 *bssid = info->links[link].bss ? 18487 info->links[link].bss->bssid : 18488 info->links[link].bssid; 18489 18490 nested_mlo_links = nla_nest_start(msg, i); 18491 if (!nested_mlo_links) 18492 goto nla_put_failure; 18493 18494 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18495 (bssid && 18496 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18497 (info->links[link].addr && 18498 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18499 info->links[link].addr))) 18500 goto nla_put_failure; 18501 18502 nla_nest_end(msg, nested_mlo_links); 18503 i++; 18504 } 18505 nla_nest_end(msg, nested); 18506 } 18507 18508 genlmsg_end(msg, hdr); 18509 18510 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18511 NL80211_MCGRP_MLME, gfp); 18512 return; 18513 18514 nla_put_failure: 18515 nlmsg_free(msg); 18516 } 18517 18518 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev, 18519 struct net_device *netdev, const u8 *peer_addr, 18520 const u8 *td_bitmap, u8 td_bitmap_len) 18521 { 18522 struct sk_buff *msg; 18523 void *hdr; 18524 18525 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18526 if (!msg) 18527 return; 18528 18529 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED); 18530 if (!hdr) { 18531 nlmsg_free(msg); 18532 return; 18533 } 18534 18535 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18536 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18537 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr)) 18538 goto nla_put_failure; 18539 18540 if (td_bitmap_len > 0 && td_bitmap && 18541 nla_put(msg, NL80211_ATTR_TD_BITMAP, td_bitmap_len, td_bitmap)) 18542 goto nla_put_failure; 18543 18544 genlmsg_end(msg, hdr); 18545 18546 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18547 NL80211_MCGRP_MLME, GFP_KERNEL); 18548 return; 18549 18550 nla_put_failure: 18551 nlmsg_free(msg); 18552 } 18553 18554 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev, 18555 struct net_device *netdev, u16 reason, 18556 const u8 *ie, size_t ie_len, bool from_ap) 18557 { 18558 struct sk_buff *msg; 18559 void *hdr; 18560 18561 msg = nlmsg_new(100 + ie_len, GFP_KERNEL); 18562 if (!msg) 18563 return; 18564 18565 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT); 18566 if (!hdr) { 18567 nlmsg_free(msg); 18568 return; 18569 } 18570 18571 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18572 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18573 (reason && 18574 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) || 18575 (from_ap && 18576 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) || 18577 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie))) 18578 goto nla_put_failure; 18579 18580 genlmsg_end(msg, hdr); 18581 18582 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18583 NL80211_MCGRP_MLME, GFP_KERNEL); 18584 return; 18585 18586 nla_put_failure: 18587 nlmsg_free(msg); 18588 } 18589 18590 void cfg80211_links_removed(struct net_device *dev, u16 link_mask) 18591 { 18592 struct wireless_dev *wdev = dev->ieee80211_ptr; 18593 struct wiphy *wiphy = wdev->wiphy; 18594 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18595 struct sk_buff *msg; 18596 struct nlattr *links; 18597 void *hdr; 18598 18599 lockdep_assert_wiphy(wdev->wiphy); 18600 trace_cfg80211_links_removed(dev, link_mask); 18601 18602 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION && 18603 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)) 18604 return; 18605 18606 if (WARN_ON(!wdev->valid_links || !link_mask || 18607 (wdev->valid_links & link_mask) != link_mask || 18608 wdev->valid_links == link_mask)) 18609 return; 18610 18611 cfg80211_wdev_release_link_bsses(wdev, link_mask); 18612 wdev->valid_links &= ~link_mask; 18613 18614 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18615 if (!msg) 18616 return; 18617 18618 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_LINKS_REMOVED); 18619 if (!hdr) { 18620 nlmsg_free(msg); 18621 return; 18622 } 18623 18624 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18625 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 18626 goto nla_put_failure; 18627 18628 links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18629 if (!links) 18630 goto nla_put_failure; 18631 18632 while (link_mask) { 18633 struct nlattr *link; 18634 int link_id = __ffs(link_mask); 18635 18636 link = nla_nest_start(msg, link_id + 1); 18637 if (!link) 18638 goto nla_put_failure; 18639 18640 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 18641 goto nla_put_failure; 18642 18643 nla_nest_end(msg, link); 18644 link_mask &= ~(1 << link_id); 18645 } 18646 18647 nla_nest_end(msg, links); 18648 18649 genlmsg_end(msg, hdr); 18650 18651 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18652 NL80211_MCGRP_MLME, GFP_KERNEL); 18653 return; 18654 18655 nla_put_failure: 18656 nlmsg_free(msg); 18657 } 18658 EXPORT_SYMBOL(cfg80211_links_removed); 18659 18660 void nl80211_mlo_reconf_add_done(struct net_device *dev, 18661 struct cfg80211_mlo_reconf_done_data *data) 18662 { 18663 struct wireless_dev *wdev = dev->ieee80211_ptr; 18664 struct wiphy *wiphy = wdev->wiphy; 18665 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18666 struct nl80211_mlme_event event = { 18667 .cmd = NL80211_CMD_ASSOC_MLO_RECONF, 18668 .buf = data->buf, 18669 .buf_len = data->len, 18670 .uapsd_queues = -1, 18671 }; 18672 18673 nl80211_send_mlme_event(rdev, dev, &event, GFP_KERNEL); 18674 } 18675 EXPORT_SYMBOL(nl80211_mlo_reconf_add_done); 18676 18677 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev, 18678 struct net_device *netdev, const u8 *bssid, 18679 gfp_t gfp) 18680 { 18681 struct sk_buff *msg; 18682 void *hdr; 18683 18684 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18685 if (!msg) 18686 return; 18687 18688 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS); 18689 if (!hdr) { 18690 nlmsg_free(msg); 18691 return; 18692 } 18693 18694 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18695 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18696 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 18697 goto nla_put_failure; 18698 18699 genlmsg_end(msg, hdr); 18700 18701 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18702 NL80211_MCGRP_MLME, gfp); 18703 return; 18704 18705 nla_put_failure: 18706 nlmsg_free(msg); 18707 } 18708 18709 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr, 18710 const u8 *ie, u8 ie_len, 18711 int sig_dbm, gfp_t gfp) 18712 { 18713 struct wireless_dev *wdev = dev->ieee80211_ptr; 18714 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18715 struct sk_buff *msg; 18716 void *hdr; 18717 18718 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT)) 18719 return; 18720 18721 trace_cfg80211_notify_new_peer_candidate(dev, addr); 18722 18723 msg = nlmsg_new(100 + ie_len, gfp); 18724 if (!msg) 18725 return; 18726 18727 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE); 18728 if (!hdr) { 18729 nlmsg_free(msg); 18730 return; 18731 } 18732 18733 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18734 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18735 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 18736 (ie_len && ie && 18737 nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) || 18738 (sig_dbm && 18739 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm))) 18740 goto nla_put_failure; 18741 18742 genlmsg_end(msg, hdr); 18743 18744 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18745 NL80211_MCGRP_MLME, gfp); 18746 return; 18747 18748 nla_put_failure: 18749 nlmsg_free(msg); 18750 } 18751 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate); 18752 18753 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev, 18754 struct net_device *netdev, const u8 *addr, 18755 enum nl80211_key_type key_type, int key_id, 18756 const u8 *tsc, gfp_t gfp) 18757 { 18758 struct sk_buff *msg; 18759 void *hdr; 18760 18761 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18762 if (!msg) 18763 return; 18764 18765 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE); 18766 if (!hdr) { 18767 nlmsg_free(msg); 18768 return; 18769 } 18770 18771 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18772 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18773 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) || 18774 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) || 18775 (key_id != -1 && 18776 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) || 18777 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc))) 18778 goto nla_put_failure; 18779 18780 genlmsg_end(msg, hdr); 18781 18782 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18783 NL80211_MCGRP_MLME, gfp); 18784 return; 18785 18786 nla_put_failure: 18787 nlmsg_free(msg); 18788 } 18789 18790 void nl80211_send_beacon_hint_event(struct wiphy *wiphy, 18791 struct ieee80211_channel *channel_before, 18792 struct ieee80211_channel *channel_after) 18793 { 18794 struct sk_buff *msg; 18795 void *hdr; 18796 struct nlattr *nl_freq; 18797 18798 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC); 18799 if (!msg) 18800 return; 18801 18802 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT); 18803 if (!hdr) { 18804 nlmsg_free(msg); 18805 return; 18806 } 18807 18808 /* 18809 * Since we are applying the beacon hint to a wiphy we know its 18810 * wiphy_idx is valid 18811 */ 18812 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 18813 goto nla_put_failure; 18814 18815 /* Before */ 18816 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE); 18817 if (!nl_freq) 18818 goto nla_put_failure; 18819 18820 if (nl80211_msg_put_channel(msg, wiphy, channel_before, false)) 18821 goto nla_put_failure; 18822 nla_nest_end(msg, nl_freq); 18823 18824 /* After */ 18825 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER); 18826 if (!nl_freq) 18827 goto nla_put_failure; 18828 18829 if (nl80211_msg_put_channel(msg, wiphy, channel_after, false)) 18830 goto nla_put_failure; 18831 nla_nest_end(msg, nl_freq); 18832 18833 genlmsg_end(msg, hdr); 18834 18835 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 18836 NL80211_MCGRP_REGULATORY); 18837 18838 return; 18839 18840 nla_put_failure: 18841 nlmsg_free(msg); 18842 } 18843 18844 static void nl80211_send_remain_on_chan_event( 18845 int cmd, struct cfg80211_registered_device *rdev, 18846 struct wireless_dev *wdev, u64 cookie, 18847 struct ieee80211_channel *chan, 18848 unsigned int duration, gfp_t gfp) 18849 { 18850 struct sk_buff *msg; 18851 void *hdr; 18852 18853 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18854 if (!msg) 18855 return; 18856 18857 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18858 if (!hdr) { 18859 nlmsg_free(msg); 18860 return; 18861 } 18862 18863 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18864 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18865 wdev->netdev->ifindex)) || 18866 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18867 NL80211_ATTR_PAD) || 18868 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) || 18869 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 18870 NL80211_CHAN_NO_HT) || 18871 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 18872 NL80211_ATTR_PAD)) 18873 goto nla_put_failure; 18874 18875 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL && 18876 nla_put_u32(msg, NL80211_ATTR_DURATION, duration)) 18877 goto nla_put_failure; 18878 18879 genlmsg_end(msg, hdr); 18880 18881 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18882 NL80211_MCGRP_MLME, gfp); 18883 return; 18884 18885 nla_put_failure: 18886 nlmsg_free(msg); 18887 } 18888 18889 void cfg80211_assoc_comeback(struct net_device *netdev, 18890 const u8 *ap_addr, u32 timeout) 18891 { 18892 struct wireless_dev *wdev = netdev->ieee80211_ptr; 18893 struct wiphy *wiphy = wdev->wiphy; 18894 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18895 struct sk_buff *msg; 18896 void *hdr; 18897 18898 trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout); 18899 18900 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18901 if (!msg) 18902 return; 18903 18904 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK); 18905 if (!hdr) { 18906 nlmsg_free(msg); 18907 return; 18908 } 18909 18910 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18911 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18912 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) || 18913 nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout)) 18914 goto nla_put_failure; 18915 18916 genlmsg_end(msg, hdr); 18917 18918 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18919 NL80211_MCGRP_MLME, GFP_KERNEL); 18920 return; 18921 18922 nla_put_failure: 18923 nlmsg_free(msg); 18924 } 18925 EXPORT_SYMBOL(cfg80211_assoc_comeback); 18926 18927 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie, 18928 struct ieee80211_channel *chan, 18929 unsigned int duration, gfp_t gfp) 18930 { 18931 struct wiphy *wiphy = wdev->wiphy; 18932 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18933 18934 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration); 18935 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL, 18936 rdev, wdev, cookie, chan, 18937 duration, gfp); 18938 } 18939 EXPORT_SYMBOL(cfg80211_ready_on_channel); 18940 18941 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie, 18942 struct ieee80211_channel *chan, 18943 gfp_t gfp) 18944 { 18945 struct wiphy *wiphy = wdev->wiphy; 18946 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18947 18948 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan); 18949 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 18950 rdev, wdev, cookie, chan, 0, gfp); 18951 } 18952 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired); 18953 18954 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie, 18955 struct ieee80211_channel *chan, 18956 gfp_t gfp) 18957 { 18958 struct wiphy *wiphy = wdev->wiphy; 18959 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18960 18961 trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan); 18962 nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL, 18963 rdev, wdev, cookie, chan, 0, gfp); 18964 } 18965 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired); 18966 18967 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr, 18968 struct station_info *sinfo, gfp_t gfp) 18969 { 18970 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18971 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18972 struct sk_buff *msg; 18973 18974 trace_cfg80211_new_sta(dev, mac_addr, sinfo); 18975 18976 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18977 if (!msg) 18978 return; 18979 18980 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0, 18981 rdev, dev, mac_addr, sinfo) < 0) { 18982 nlmsg_free(msg); 18983 return; 18984 } 18985 18986 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18987 NL80211_MCGRP_MLME, gfp); 18988 } 18989 EXPORT_SYMBOL(cfg80211_new_sta); 18990 18991 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr, 18992 struct station_info *sinfo, gfp_t gfp) 18993 { 18994 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18995 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18996 struct sk_buff *msg; 18997 struct station_info empty_sinfo = {}; 18998 18999 if (!sinfo) 19000 sinfo = &empty_sinfo; 19001 19002 trace_cfg80211_del_sta(dev, mac_addr); 19003 19004 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19005 if (!msg) { 19006 cfg80211_sinfo_release_content(sinfo); 19007 return; 19008 } 19009 19010 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0, 19011 rdev, dev, mac_addr, sinfo) < 0) { 19012 nlmsg_free(msg); 19013 return; 19014 } 19015 19016 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19017 NL80211_MCGRP_MLME, gfp); 19018 } 19019 EXPORT_SYMBOL(cfg80211_del_sta_sinfo); 19020 19021 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr, 19022 enum nl80211_connect_failed_reason reason, 19023 gfp_t gfp) 19024 { 19025 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 19026 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19027 struct sk_buff *msg; 19028 void *hdr; 19029 19030 msg = nlmsg_new(NLMSG_GOODSIZE, gfp); 19031 if (!msg) 19032 return; 19033 19034 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED); 19035 if (!hdr) { 19036 nlmsg_free(msg); 19037 return; 19038 } 19039 19040 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19041 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 19042 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason)) 19043 goto nla_put_failure; 19044 19045 genlmsg_end(msg, hdr); 19046 19047 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19048 NL80211_MCGRP_MLME, gfp); 19049 return; 19050 19051 nla_put_failure: 19052 nlmsg_free(msg); 19053 } 19054 EXPORT_SYMBOL(cfg80211_conn_failed); 19055 19056 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd, 19057 const u8 *addr, gfp_t gfp) 19058 { 19059 struct wireless_dev *wdev = dev->ieee80211_ptr; 19060 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19061 struct sk_buff *msg; 19062 void *hdr; 19063 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid); 19064 19065 if (!nlportid) 19066 return false; 19067 19068 msg = nlmsg_new(100, gfp); 19069 if (!msg) 19070 return true; 19071 19072 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19073 if (!hdr) { 19074 nlmsg_free(msg); 19075 return true; 19076 } 19077 19078 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19079 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19080 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 19081 goto nla_put_failure; 19082 19083 genlmsg_end(msg, hdr); 19084 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 19085 return true; 19086 19087 nla_put_failure: 19088 nlmsg_free(msg); 19089 return true; 19090 } 19091 19092 bool cfg80211_rx_spurious_frame(struct net_device *dev, 19093 const u8 *addr, gfp_t gfp) 19094 { 19095 struct wireless_dev *wdev = dev->ieee80211_ptr; 19096 bool ret; 19097 19098 trace_cfg80211_rx_spurious_frame(dev, addr); 19099 19100 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 19101 wdev->iftype != NL80211_IFTYPE_P2P_GO)) { 19102 trace_cfg80211_return_bool(false); 19103 return false; 19104 } 19105 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME, 19106 addr, gfp); 19107 trace_cfg80211_return_bool(ret); 19108 return ret; 19109 } 19110 EXPORT_SYMBOL(cfg80211_rx_spurious_frame); 19111 19112 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev, 19113 const u8 *addr, gfp_t gfp) 19114 { 19115 struct wireless_dev *wdev = dev->ieee80211_ptr; 19116 bool ret; 19117 19118 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr); 19119 19120 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 19121 wdev->iftype != NL80211_IFTYPE_P2P_GO && 19122 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) { 19123 trace_cfg80211_return_bool(false); 19124 return false; 19125 } 19126 ret = __nl80211_unexpected_frame(dev, 19127 NL80211_CMD_UNEXPECTED_4ADDR_FRAME, 19128 addr, gfp); 19129 trace_cfg80211_return_bool(ret); 19130 return ret; 19131 } 19132 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame); 19133 19134 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev, 19135 struct wireless_dev *wdev, u32 nlportid, 19136 struct cfg80211_rx_info *info, gfp_t gfp) 19137 { 19138 struct net_device *netdev = wdev->netdev; 19139 struct sk_buff *msg; 19140 void *hdr; 19141 19142 msg = nlmsg_new(100 + info->len, gfp); 19143 if (!msg) 19144 return -ENOMEM; 19145 19146 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 19147 if (!hdr) { 19148 nlmsg_free(msg); 19149 return -ENOMEM; 19150 } 19151 19152 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19153 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 19154 netdev->ifindex)) || 19155 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19156 NL80211_ATTR_PAD) || 19157 (info->have_link_id && 19158 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) || 19159 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) || 19160 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) || 19161 (info->sig_dbm && 19162 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) || 19163 nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) || 19164 (info->flags && 19165 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) || 19166 (info->rx_tstamp && nla_put_u64_64bit(msg, 19167 NL80211_ATTR_RX_HW_TIMESTAMP, 19168 info->rx_tstamp, 19169 NL80211_ATTR_PAD)) || 19170 (info->ack_tstamp && nla_put_u64_64bit(msg, 19171 NL80211_ATTR_TX_HW_TIMESTAMP, 19172 info->ack_tstamp, 19173 NL80211_ATTR_PAD))) 19174 goto nla_put_failure; 19175 19176 genlmsg_end(msg, hdr); 19177 19178 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 19179 19180 nla_put_failure: 19181 nlmsg_free(msg); 19182 return -ENOBUFS; 19183 } 19184 19185 static void nl80211_frame_tx_status(struct wireless_dev *wdev, 19186 struct cfg80211_tx_status *status, 19187 gfp_t gfp, enum nl80211_commands command) 19188 { 19189 struct wiphy *wiphy = wdev->wiphy; 19190 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19191 struct net_device *netdev = wdev->netdev; 19192 struct sk_buff *msg; 19193 void *hdr; 19194 19195 if (command == NL80211_CMD_FRAME_TX_STATUS) 19196 trace_cfg80211_mgmt_tx_status(wdev, status->cookie, 19197 status->ack); 19198 else 19199 trace_cfg80211_control_port_tx_status(wdev, status->cookie, 19200 status->ack); 19201 19202 msg = nlmsg_new(100 + status->len, gfp); 19203 if (!msg) 19204 return; 19205 19206 hdr = nl80211hdr_put(msg, 0, 0, 0, command); 19207 if (!hdr) { 19208 nlmsg_free(msg); 19209 return; 19210 } 19211 19212 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19213 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 19214 netdev->ifindex)) || 19215 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19216 NL80211_ATTR_PAD) || 19217 nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) || 19218 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie, 19219 NL80211_ATTR_PAD) || 19220 (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) || 19221 (status->tx_tstamp && 19222 nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP, 19223 status->tx_tstamp, NL80211_ATTR_PAD)) || 19224 (status->ack_tstamp && 19225 nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP, 19226 status->ack_tstamp, NL80211_ATTR_PAD))) 19227 goto nla_put_failure; 19228 19229 genlmsg_end(msg, hdr); 19230 19231 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19232 NL80211_MCGRP_MLME, gfp); 19233 return; 19234 19235 nla_put_failure: 19236 nlmsg_free(msg); 19237 } 19238 19239 void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie, 19240 const u8 *buf, size_t len, bool ack, 19241 gfp_t gfp) 19242 { 19243 struct cfg80211_tx_status status = { 19244 .cookie = cookie, 19245 .buf = buf, 19246 .len = len, 19247 .ack = ack 19248 }; 19249 19250 nl80211_frame_tx_status(wdev, &status, gfp, 19251 NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS); 19252 } 19253 EXPORT_SYMBOL(cfg80211_control_port_tx_status); 19254 19255 void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev, 19256 struct cfg80211_tx_status *status, gfp_t gfp) 19257 { 19258 nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS); 19259 } 19260 EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext); 19261 19262 static int __nl80211_rx_control_port(struct net_device *dev, 19263 struct sk_buff *skb, 19264 bool unencrypted, 19265 int link_id, 19266 gfp_t gfp) 19267 { 19268 struct wireless_dev *wdev = dev->ieee80211_ptr; 19269 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19270 struct ethhdr *ehdr = eth_hdr(skb); 19271 const u8 *addr = ehdr->h_source; 19272 u16 proto = be16_to_cpu(skb->protocol); 19273 struct sk_buff *msg; 19274 void *hdr; 19275 struct nlattr *frame; 19276 19277 u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid); 19278 19279 if (!nlportid) 19280 return -ENOENT; 19281 19282 msg = nlmsg_new(100 + skb->len, gfp); 19283 if (!msg) 19284 return -ENOMEM; 19285 19286 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME); 19287 if (!hdr) { 19288 nlmsg_free(msg); 19289 return -ENOBUFS; 19290 } 19291 19292 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19293 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19294 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19295 NL80211_ATTR_PAD) || 19296 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19297 nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) || 19298 (link_id >= 0 && 19299 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) || 19300 (unencrypted && nla_put_flag(msg, 19301 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT))) 19302 goto nla_put_failure; 19303 19304 frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len); 19305 if (!frame) 19306 goto nla_put_failure; 19307 19308 skb_copy_bits(skb, 0, nla_data(frame), skb->len); 19309 genlmsg_end(msg, hdr); 19310 19311 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 19312 19313 nla_put_failure: 19314 nlmsg_free(msg); 19315 return -ENOBUFS; 19316 } 19317 19318 bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb, 19319 bool unencrypted, int link_id) 19320 { 19321 int ret; 19322 19323 trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id); 19324 ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id, 19325 GFP_ATOMIC); 19326 trace_cfg80211_return_bool(ret == 0); 19327 return ret == 0; 19328 } 19329 EXPORT_SYMBOL(cfg80211_rx_control_port); 19330 19331 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev, 19332 const char *mac, gfp_t gfp) 19333 { 19334 struct wireless_dev *wdev = dev->ieee80211_ptr; 19335 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19336 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19337 void **cb; 19338 19339 if (!msg) 19340 return NULL; 19341 19342 cb = (void **)msg->cb; 19343 19344 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM); 19345 if (!cb[0]) { 19346 nlmsg_free(msg); 19347 return NULL; 19348 } 19349 19350 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19351 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19352 goto nla_put_failure; 19353 19354 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 19355 goto nla_put_failure; 19356 19357 cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM); 19358 if (!cb[1]) 19359 goto nla_put_failure; 19360 19361 cb[2] = rdev; 19362 19363 return msg; 19364 nla_put_failure: 19365 nlmsg_free(msg); 19366 return NULL; 19367 } 19368 19369 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp) 19370 { 19371 void **cb = (void **)msg->cb; 19372 struct cfg80211_registered_device *rdev = cb[2]; 19373 19374 nla_nest_end(msg, cb[1]); 19375 genlmsg_end(msg, cb[0]); 19376 19377 memset(msg->cb, 0, sizeof(msg->cb)); 19378 19379 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19380 NL80211_MCGRP_MLME, gfp); 19381 } 19382 19383 void cfg80211_cqm_rssi_notify(struct net_device *dev, 19384 enum nl80211_cqm_rssi_threshold_event rssi_event, 19385 s32 rssi_level, gfp_t gfp) 19386 { 19387 struct wireless_dev *wdev = dev->ieee80211_ptr; 19388 struct cfg80211_cqm_config *cqm_config; 19389 19390 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level); 19391 19392 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW && 19393 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH)) 19394 return; 19395 19396 rcu_read_lock(); 19397 cqm_config = rcu_dereference(wdev->cqm_config); 19398 if (cqm_config) { 19399 cqm_config->last_rssi_event_value = rssi_level; 19400 cqm_config->last_rssi_event_type = rssi_event; 19401 wiphy_work_queue(wdev->wiphy, &wdev->cqm_rssi_work); 19402 } 19403 rcu_read_unlock(); 19404 } 19405 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify); 19406 19407 void cfg80211_cqm_rssi_notify_work(struct wiphy *wiphy, struct wiphy_work *work) 19408 { 19409 struct wireless_dev *wdev = container_of(work, struct wireless_dev, 19410 cqm_rssi_work); 19411 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19412 enum nl80211_cqm_rssi_threshold_event rssi_event; 19413 struct cfg80211_cqm_config *cqm_config; 19414 struct sk_buff *msg; 19415 s32 rssi_level; 19416 19417 cqm_config = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 19418 if (!cqm_config) 19419 return; 19420 19421 if (cqm_config->use_range_api) 19422 cfg80211_cqm_rssi_update(rdev, wdev->netdev, cqm_config); 19423 19424 rssi_level = cqm_config->last_rssi_event_value; 19425 rssi_event = cqm_config->last_rssi_event_type; 19426 19427 msg = cfg80211_prepare_cqm(wdev->netdev, NULL, GFP_KERNEL); 19428 if (!msg) 19429 return; 19430 19431 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT, 19432 rssi_event)) 19433 goto nla_put_failure; 19434 19435 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL, 19436 rssi_level)) 19437 goto nla_put_failure; 19438 19439 cfg80211_send_cqm(msg, GFP_KERNEL); 19440 19441 return; 19442 19443 nla_put_failure: 19444 nlmsg_free(msg); 19445 } 19446 19447 void cfg80211_cqm_txe_notify(struct net_device *dev, 19448 const u8 *peer, u32 num_packets, 19449 u32 rate, u32 intvl, gfp_t gfp) 19450 { 19451 struct sk_buff *msg; 19452 19453 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19454 if (!msg) 19455 return; 19456 19457 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets)) 19458 goto nla_put_failure; 19459 19460 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate)) 19461 goto nla_put_failure; 19462 19463 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl)) 19464 goto nla_put_failure; 19465 19466 cfg80211_send_cqm(msg, gfp); 19467 return; 19468 19469 nla_put_failure: 19470 nlmsg_free(msg); 19471 } 19472 EXPORT_SYMBOL(cfg80211_cqm_txe_notify); 19473 19474 void cfg80211_cqm_pktloss_notify(struct net_device *dev, 19475 const u8 *peer, u32 num_packets, gfp_t gfp) 19476 { 19477 struct sk_buff *msg; 19478 19479 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets); 19480 19481 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19482 if (!msg) 19483 return; 19484 19485 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets)) 19486 goto nla_put_failure; 19487 19488 cfg80211_send_cqm(msg, gfp); 19489 return; 19490 19491 nla_put_failure: 19492 nlmsg_free(msg); 19493 } 19494 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify); 19495 19496 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp) 19497 { 19498 struct sk_buff *msg; 19499 19500 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 19501 if (!msg) 19502 return; 19503 19504 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT)) 19505 goto nla_put_failure; 19506 19507 cfg80211_send_cqm(msg, gfp); 19508 return; 19509 19510 nla_put_failure: 19511 nlmsg_free(msg); 19512 } 19513 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify); 19514 19515 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev, 19516 struct net_device *netdev, const u8 *bssid, 19517 const u8 *replay_ctr, gfp_t gfp) 19518 { 19519 struct sk_buff *msg; 19520 struct nlattr *rekey_attr; 19521 void *hdr; 19522 19523 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19524 if (!msg) 19525 return; 19526 19527 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD); 19528 if (!hdr) { 19529 nlmsg_free(msg); 19530 return; 19531 } 19532 19533 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19534 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19535 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 19536 goto nla_put_failure; 19537 19538 rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA); 19539 if (!rekey_attr) 19540 goto nla_put_failure; 19541 19542 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR, 19543 NL80211_REPLAY_CTR_LEN, replay_ctr)) 19544 goto nla_put_failure; 19545 19546 nla_nest_end(msg, rekey_attr); 19547 19548 genlmsg_end(msg, hdr); 19549 19550 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19551 NL80211_MCGRP_MLME, gfp); 19552 return; 19553 19554 nla_put_failure: 19555 nlmsg_free(msg); 19556 } 19557 19558 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid, 19559 const u8 *replay_ctr, gfp_t gfp) 19560 { 19561 struct wireless_dev *wdev = dev->ieee80211_ptr; 19562 struct wiphy *wiphy = wdev->wiphy; 19563 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19564 19565 trace_cfg80211_gtk_rekey_notify(dev, bssid); 19566 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp); 19567 } 19568 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify); 19569 19570 static void 19571 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev, 19572 struct net_device *netdev, int index, 19573 const u8 *bssid, bool preauth, gfp_t gfp) 19574 { 19575 struct sk_buff *msg; 19576 struct nlattr *attr; 19577 void *hdr; 19578 19579 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19580 if (!msg) 19581 return; 19582 19583 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE); 19584 if (!hdr) { 19585 nlmsg_free(msg); 19586 return; 19587 } 19588 19589 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19590 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19591 goto nla_put_failure; 19592 19593 attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE); 19594 if (!attr) 19595 goto nla_put_failure; 19596 19597 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) || 19598 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) || 19599 (preauth && 19600 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH))) 19601 goto nla_put_failure; 19602 19603 nla_nest_end(msg, attr); 19604 19605 genlmsg_end(msg, hdr); 19606 19607 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19608 NL80211_MCGRP_MLME, gfp); 19609 return; 19610 19611 nla_put_failure: 19612 nlmsg_free(msg); 19613 } 19614 19615 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index, 19616 const u8 *bssid, bool preauth, gfp_t gfp) 19617 { 19618 struct wireless_dev *wdev = dev->ieee80211_ptr; 19619 struct wiphy *wiphy = wdev->wiphy; 19620 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19621 19622 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth); 19623 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp); 19624 } 19625 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify); 19626 19627 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev, 19628 struct net_device *netdev, 19629 unsigned int link_id, 19630 struct cfg80211_chan_def *chandef, 19631 gfp_t gfp, 19632 enum nl80211_commands notif, 19633 u8 count, bool quiet) 19634 { 19635 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19636 struct sk_buff *msg; 19637 void *hdr; 19638 19639 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19640 if (!msg) 19641 return; 19642 19643 hdr = nl80211hdr_put(msg, 0, 0, 0, notif); 19644 if (!hdr) { 19645 nlmsg_free(msg); 19646 return; 19647 } 19648 19649 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19650 goto nla_put_failure; 19651 19652 if (wdev->valid_links && 19653 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19654 goto nla_put_failure; 19655 19656 if (nl80211_send_chandef(msg, chandef)) 19657 goto nla_put_failure; 19658 19659 if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) { 19660 if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)) 19661 goto nla_put_failure; 19662 if (quiet && 19663 nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX)) 19664 goto nla_put_failure; 19665 } 19666 19667 genlmsg_end(msg, hdr); 19668 19669 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19670 NL80211_MCGRP_MLME, gfp); 19671 return; 19672 19673 nla_put_failure: 19674 nlmsg_free(msg); 19675 } 19676 19677 void cfg80211_ch_switch_notify(struct net_device *dev, 19678 struct cfg80211_chan_def *chandef, 19679 unsigned int link_id) 19680 { 19681 struct wireless_dev *wdev = dev->ieee80211_ptr; 19682 struct wiphy *wiphy = wdev->wiphy; 19683 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19684 19685 lockdep_assert_wiphy(wdev->wiphy); 19686 WARN_INVALID_LINK_ID(wdev, link_id); 19687 19688 trace_cfg80211_ch_switch_notify(dev, chandef, link_id); 19689 19690 switch (wdev->iftype) { 19691 case NL80211_IFTYPE_STATION: 19692 case NL80211_IFTYPE_P2P_CLIENT: 19693 if (!WARN_ON(!wdev->links[link_id].client.current_bss)) 19694 cfg80211_update_assoc_bss_entry(wdev, link_id, 19695 chandef->chan); 19696 break; 19697 case NL80211_IFTYPE_MESH_POINT: 19698 wdev->u.mesh.chandef = *chandef; 19699 wdev->u.mesh.preset_chandef = *chandef; 19700 break; 19701 case NL80211_IFTYPE_AP: 19702 case NL80211_IFTYPE_P2P_GO: 19703 wdev->links[link_id].ap.chandef = *chandef; 19704 break; 19705 case NL80211_IFTYPE_ADHOC: 19706 wdev->u.ibss.chandef = *chandef; 19707 break; 19708 default: 19709 WARN_ON(1); 19710 break; 19711 } 19712 19713 cfg80211_schedule_channels_check(wdev); 19714 cfg80211_sched_dfs_chan_update(rdev); 19715 19716 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19717 NL80211_CMD_CH_SWITCH_NOTIFY, 0, false); 19718 } 19719 EXPORT_SYMBOL(cfg80211_ch_switch_notify); 19720 19721 void cfg80211_ch_switch_started_notify(struct net_device *dev, 19722 struct cfg80211_chan_def *chandef, 19723 unsigned int link_id, u8 count, 19724 bool quiet) 19725 { 19726 struct wireless_dev *wdev = dev->ieee80211_ptr; 19727 struct wiphy *wiphy = wdev->wiphy; 19728 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19729 19730 lockdep_assert_wiphy(wdev->wiphy); 19731 WARN_INVALID_LINK_ID(wdev, link_id); 19732 19733 trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id); 19734 19735 19736 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19737 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, 19738 count, quiet); 19739 } 19740 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify); 19741 19742 int cfg80211_bss_color_notify(struct net_device *dev, 19743 enum nl80211_commands cmd, u8 count, 19744 u64 color_bitmap, u8 link_id) 19745 { 19746 struct wireless_dev *wdev = dev->ieee80211_ptr; 19747 struct wiphy *wiphy = wdev->wiphy; 19748 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19749 struct sk_buff *msg; 19750 void *hdr; 19751 19752 lockdep_assert_wiphy(wdev->wiphy); 19753 19754 trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap); 19755 19756 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19757 if (!msg) 19758 return -ENOMEM; 19759 19760 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19761 if (!hdr) 19762 goto nla_put_failure; 19763 19764 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19765 goto nla_put_failure; 19766 19767 if (wdev->valid_links && 19768 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19769 goto nla_put_failure; 19770 19771 if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED && 19772 nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count)) 19773 goto nla_put_failure; 19774 19775 if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION && 19776 nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP, 19777 color_bitmap, NL80211_ATTR_PAD)) 19778 goto nla_put_failure; 19779 19780 genlmsg_end(msg, hdr); 19781 19782 return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 19783 msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL); 19784 19785 nla_put_failure: 19786 nlmsg_free(msg); 19787 return -EINVAL; 19788 } 19789 EXPORT_SYMBOL(cfg80211_bss_color_notify); 19790 19791 void 19792 nl80211_radar_notify(struct cfg80211_registered_device *rdev, 19793 const struct cfg80211_chan_def *chandef, 19794 enum nl80211_radar_event event, 19795 struct net_device *netdev, gfp_t gfp) 19796 { 19797 struct sk_buff *msg; 19798 void *hdr; 19799 19800 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19801 if (!msg) 19802 return; 19803 19804 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT); 19805 if (!hdr) { 19806 nlmsg_free(msg); 19807 return; 19808 } 19809 19810 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19811 goto nla_put_failure; 19812 19813 /* NOP and radar events don't need a netdev parameter */ 19814 if (netdev) { 19815 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19816 19817 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19818 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19819 NL80211_ATTR_PAD)) 19820 goto nla_put_failure; 19821 } 19822 19823 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event)) 19824 goto nla_put_failure; 19825 19826 if (nl80211_send_chandef(msg, chandef)) 19827 goto nla_put_failure; 19828 19829 genlmsg_end(msg, hdr); 19830 19831 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19832 NL80211_MCGRP_MLME, gfp); 19833 return; 19834 19835 nla_put_failure: 19836 nlmsg_free(msg); 19837 } 19838 19839 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac, 19840 struct sta_opmode_info *sta_opmode, 19841 gfp_t gfp) 19842 { 19843 struct sk_buff *msg; 19844 struct wireless_dev *wdev = dev->ieee80211_ptr; 19845 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19846 void *hdr; 19847 19848 if (WARN_ON(!mac)) 19849 return; 19850 19851 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19852 if (!msg) 19853 return; 19854 19855 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED); 19856 if (!hdr) { 19857 nlmsg_free(msg); 19858 return; 19859 } 19860 19861 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19862 goto nla_put_failure; 19863 19864 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19865 goto nla_put_failure; 19866 19867 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 19868 goto nla_put_failure; 19869 19870 if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) && 19871 nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode)) 19872 goto nla_put_failure; 19873 19874 if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) && 19875 nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw)) 19876 goto nla_put_failure; 19877 19878 if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) && 19879 nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss)) 19880 goto nla_put_failure; 19881 19882 genlmsg_end(msg, hdr); 19883 19884 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19885 NL80211_MCGRP_MLME, gfp); 19886 19887 return; 19888 19889 nla_put_failure: 19890 nlmsg_free(msg); 19891 } 19892 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify); 19893 19894 void cfg80211_probe_status(struct net_device *dev, const u8 *addr, 19895 u64 cookie, bool acked, s32 ack_signal, 19896 bool is_valid_ack_signal, gfp_t gfp) 19897 { 19898 struct wireless_dev *wdev = dev->ieee80211_ptr; 19899 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19900 struct sk_buff *msg; 19901 void *hdr; 19902 19903 trace_cfg80211_probe_status(dev, addr, cookie, acked); 19904 19905 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19906 19907 if (!msg) 19908 return; 19909 19910 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT); 19911 if (!hdr) { 19912 nlmsg_free(msg); 19913 return; 19914 } 19915 19916 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19917 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19918 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19919 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 19920 NL80211_ATTR_PAD) || 19921 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) || 19922 (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL, 19923 ack_signal))) 19924 goto nla_put_failure; 19925 19926 genlmsg_end(msg, hdr); 19927 19928 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19929 NL80211_MCGRP_MLME, gfp); 19930 return; 19931 19932 nla_put_failure: 19933 nlmsg_free(msg); 19934 } 19935 EXPORT_SYMBOL(cfg80211_probe_status); 19936 19937 void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame, 19938 size_t len, int freq, int sig_dbm) 19939 { 19940 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19941 struct sk_buff *msg; 19942 void *hdr; 19943 struct cfg80211_beacon_registration *reg; 19944 19945 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm); 19946 19947 spin_lock_bh(&rdev->beacon_registrations_lock); 19948 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 19949 msg = nlmsg_new(len + 100, GFP_ATOMIC); 19950 if (!msg) { 19951 spin_unlock_bh(&rdev->beacon_registrations_lock); 19952 return; 19953 } 19954 19955 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 19956 if (!hdr) 19957 goto nla_put_failure; 19958 19959 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19960 (freq && 19961 (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 19962 KHZ_TO_MHZ(freq)) || 19963 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 19964 freq % 1000))) || 19965 (sig_dbm && 19966 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 19967 nla_put(msg, NL80211_ATTR_FRAME, len, frame)) 19968 goto nla_put_failure; 19969 19970 genlmsg_end(msg, hdr); 19971 19972 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid); 19973 } 19974 spin_unlock_bh(&rdev->beacon_registrations_lock); 19975 return; 19976 19977 nla_put_failure: 19978 spin_unlock_bh(&rdev->beacon_registrations_lock); 19979 nlmsg_free(msg); 19980 } 19981 EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz); 19982 19983 #ifdef CONFIG_PM 19984 static int cfg80211_net_detect_results(struct sk_buff *msg, 19985 struct cfg80211_wowlan_wakeup *wakeup) 19986 { 19987 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect; 19988 struct nlattr *nl_results, *nl_match, *nl_freqs; 19989 int i, j; 19990 19991 nl_results = nla_nest_start_noflag(msg, 19992 NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS); 19993 if (!nl_results) 19994 return -EMSGSIZE; 19995 19996 for (i = 0; i < nd->n_matches; i++) { 19997 struct cfg80211_wowlan_nd_match *match = nd->matches[i]; 19998 19999 nl_match = nla_nest_start_noflag(msg, i); 20000 if (!nl_match) 20001 break; 20002 20003 /* The SSID attribute is optional in nl80211, but for 20004 * simplicity reasons it's always present in the 20005 * cfg80211 structure. If a driver can't pass the 20006 * SSID, that needs to be changed. A zero length SSID 20007 * is still a valid SSID (wildcard), so it cannot be 20008 * used for this purpose. 20009 */ 20010 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len, 20011 match->ssid.ssid)) { 20012 nla_nest_cancel(msg, nl_match); 20013 goto out; 20014 } 20015 20016 if (match->n_channels) { 20017 nl_freqs = nla_nest_start_noflag(msg, 20018 NL80211_ATTR_SCAN_FREQUENCIES); 20019 if (!nl_freqs) { 20020 nla_nest_cancel(msg, nl_match); 20021 goto out; 20022 } 20023 20024 for (j = 0; j < match->n_channels; j++) { 20025 if (nla_put_u32(msg, j, match->channels[j])) { 20026 nla_nest_cancel(msg, nl_freqs); 20027 nla_nest_cancel(msg, nl_match); 20028 goto out; 20029 } 20030 } 20031 20032 nla_nest_end(msg, nl_freqs); 20033 } 20034 20035 nla_nest_end(msg, nl_match); 20036 } 20037 20038 out: 20039 nla_nest_end(msg, nl_results); 20040 return 0; 20041 } 20042 20043 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev, 20044 struct cfg80211_wowlan_wakeup *wakeup, 20045 gfp_t gfp) 20046 { 20047 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20048 struct sk_buff *msg; 20049 void *hdr; 20050 int size = 200; 20051 20052 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup); 20053 20054 if (wakeup) 20055 size += wakeup->packet_present_len; 20056 20057 msg = nlmsg_new(size, gfp); 20058 if (!msg) 20059 return; 20060 20061 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN); 20062 if (!hdr) 20063 goto free_msg; 20064 20065 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20066 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20067 NL80211_ATTR_PAD)) 20068 goto free_msg; 20069 20070 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 20071 wdev->netdev->ifindex)) 20072 goto free_msg; 20073 20074 if (wakeup) { 20075 struct nlattr *reasons; 20076 20077 reasons = nla_nest_start_noflag(msg, 20078 NL80211_ATTR_WOWLAN_TRIGGERS); 20079 if (!reasons) 20080 goto free_msg; 20081 20082 if (wakeup->disconnect && 20083 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) 20084 goto free_msg; 20085 if (wakeup->magic_pkt && 20086 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) 20087 goto free_msg; 20088 if (wakeup->gtk_rekey_failure && 20089 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) 20090 goto free_msg; 20091 if (wakeup->eap_identity_req && 20092 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) 20093 goto free_msg; 20094 if (wakeup->four_way_handshake && 20095 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) 20096 goto free_msg; 20097 if (wakeup->rfkill_release && 20098 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)) 20099 goto free_msg; 20100 20101 if (wakeup->pattern_idx >= 0 && 20102 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 20103 wakeup->pattern_idx)) 20104 goto free_msg; 20105 20106 if (wakeup->tcp_match && 20107 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH)) 20108 goto free_msg; 20109 20110 if (wakeup->tcp_connlost && 20111 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST)) 20112 goto free_msg; 20113 20114 if (wakeup->tcp_nomoretokens && 20115 nla_put_flag(msg, 20116 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS)) 20117 goto free_msg; 20118 20119 if (wakeup->unprot_deauth_disassoc && 20120 nla_put_flag(msg, 20121 NL80211_WOWLAN_TRIG_UNPROTECTED_DEAUTH_DISASSOC)) 20122 goto free_msg; 20123 20124 if (wakeup->packet) { 20125 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211; 20126 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN; 20127 20128 if (!wakeup->packet_80211) { 20129 pkt_attr = 20130 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023; 20131 len_attr = 20132 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN; 20133 } 20134 20135 if (wakeup->packet_len && 20136 nla_put_u32(msg, len_attr, wakeup->packet_len)) 20137 goto free_msg; 20138 20139 if (nla_put(msg, pkt_attr, wakeup->packet_present_len, 20140 wakeup->packet)) 20141 goto free_msg; 20142 } 20143 20144 if (wakeup->net_detect && 20145 cfg80211_net_detect_results(msg, wakeup)) 20146 goto free_msg; 20147 20148 nla_nest_end(msg, reasons); 20149 } 20150 20151 genlmsg_end(msg, hdr); 20152 20153 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20154 NL80211_MCGRP_MLME, gfp); 20155 return; 20156 20157 free_msg: 20158 nlmsg_free(msg); 20159 } 20160 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup); 20161 #endif 20162 20163 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer, 20164 enum nl80211_tdls_operation oper, 20165 u16 reason_code, gfp_t gfp) 20166 { 20167 struct wireless_dev *wdev = dev->ieee80211_ptr; 20168 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20169 struct sk_buff *msg; 20170 void *hdr; 20171 20172 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper, 20173 reason_code); 20174 20175 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20176 if (!msg) 20177 return; 20178 20179 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER); 20180 if (!hdr) { 20181 nlmsg_free(msg); 20182 return; 20183 } 20184 20185 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20186 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20187 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) || 20188 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) || 20189 (reason_code > 0 && 20190 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code))) 20191 goto nla_put_failure; 20192 20193 genlmsg_end(msg, hdr); 20194 20195 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20196 NL80211_MCGRP_MLME, gfp); 20197 return; 20198 20199 nla_put_failure: 20200 nlmsg_free(msg); 20201 } 20202 EXPORT_SYMBOL(cfg80211_tdls_oper_request); 20203 20204 static int nl80211_netlink_notify(struct notifier_block * nb, 20205 unsigned long state, 20206 void *_notify) 20207 { 20208 struct netlink_notify *notify = _notify; 20209 struct cfg80211_registered_device *rdev; 20210 struct wireless_dev *wdev; 20211 struct cfg80211_beacon_registration *reg, *tmp; 20212 20213 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC) 20214 return NOTIFY_DONE; 20215 20216 rcu_read_lock(); 20217 20218 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 20219 struct cfg80211_sched_scan_request *sched_scan_req; 20220 20221 list_for_each_entry_rcu(sched_scan_req, 20222 &rdev->sched_scan_req_list, 20223 list) { 20224 if (sched_scan_req->owner_nlportid == notify->portid) { 20225 sched_scan_req->nl_owner_dead = true; 20226 wiphy_work_queue(&rdev->wiphy, 20227 &rdev->sched_scan_stop_wk); 20228 } 20229 } 20230 20231 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) { 20232 cfg80211_mlme_unregister_socket(wdev, notify->portid); 20233 20234 if (wdev->owner_nlportid == notify->portid) { 20235 wdev->nl_owner_dead = true; 20236 schedule_work(&rdev->destroy_work); 20237 } else if (wdev->conn_owner_nlportid == notify->portid) { 20238 schedule_work(&wdev->disconnect_wk); 20239 } 20240 20241 cfg80211_release_pmsr(wdev, notify->portid); 20242 } 20243 20244 spin_lock_bh(&rdev->beacon_registrations_lock); 20245 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations, 20246 list) { 20247 if (reg->nlportid == notify->portid) { 20248 list_del(®->list); 20249 kfree(reg); 20250 break; 20251 } 20252 } 20253 spin_unlock_bh(&rdev->beacon_registrations_lock); 20254 } 20255 20256 rcu_read_unlock(); 20257 20258 /* 20259 * It is possible that the user space process that is controlling the 20260 * indoor setting disappeared, so notify the regulatory core. 20261 */ 20262 regulatory_netlink_notify(notify->portid); 20263 return NOTIFY_OK; 20264 } 20265 20266 static struct notifier_block nl80211_netlink_notifier = { 20267 .notifier_call = nl80211_netlink_notify, 20268 }; 20269 20270 void cfg80211_ft_event(struct net_device *netdev, 20271 struct cfg80211_ft_event_params *ft_event) 20272 { 20273 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 20274 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20275 struct sk_buff *msg; 20276 void *hdr; 20277 20278 trace_cfg80211_ft_event(wiphy, netdev, ft_event); 20279 20280 if (!ft_event->target_ap) 20281 return; 20282 20283 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len, 20284 GFP_KERNEL); 20285 if (!msg) 20286 return; 20287 20288 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT); 20289 if (!hdr) 20290 goto out; 20291 20292 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20293 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20294 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap)) 20295 goto out; 20296 20297 if (ft_event->ies && 20298 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies)) 20299 goto out; 20300 if (ft_event->ric_ies && 20301 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len, 20302 ft_event->ric_ies)) 20303 goto out; 20304 20305 genlmsg_end(msg, hdr); 20306 20307 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20308 NL80211_MCGRP_MLME, GFP_KERNEL); 20309 return; 20310 out: 20311 nlmsg_free(msg); 20312 } 20313 EXPORT_SYMBOL(cfg80211_ft_event); 20314 20315 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp) 20316 { 20317 struct cfg80211_registered_device *rdev; 20318 struct sk_buff *msg; 20319 void *hdr; 20320 u32 nlportid; 20321 20322 rdev = wiphy_to_rdev(wdev->wiphy); 20323 if (!rdev->crit_proto_nlportid) 20324 return; 20325 20326 nlportid = rdev->crit_proto_nlportid; 20327 rdev->crit_proto_nlportid = 0; 20328 20329 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20330 if (!msg) 20331 return; 20332 20333 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP); 20334 if (!hdr) 20335 goto nla_put_failure; 20336 20337 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20338 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20339 NL80211_ATTR_PAD)) 20340 goto nla_put_failure; 20341 20342 genlmsg_end(msg, hdr); 20343 20344 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20345 return; 20346 20347 nla_put_failure: 20348 nlmsg_free(msg); 20349 } 20350 EXPORT_SYMBOL(cfg80211_crit_proto_stopped); 20351 20352 void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id) 20353 { 20354 struct wiphy *wiphy = wdev->wiphy; 20355 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20356 struct sk_buff *msg; 20357 void *hdr; 20358 20359 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 20360 if (!msg) 20361 return; 20362 20363 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP); 20364 if (!hdr) 20365 goto out; 20366 20367 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20368 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 20369 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20370 NL80211_ATTR_PAD) || 20371 (wdev->valid_links && 20372 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 20373 goto out; 20374 20375 genlmsg_end(msg, hdr); 20376 20377 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 20378 NL80211_MCGRP_MLME, GFP_KERNEL); 20379 return; 20380 out: 20381 nlmsg_free(msg); 20382 } 20383 20384 int cfg80211_external_auth_request(struct net_device *dev, 20385 struct cfg80211_external_auth_params *params, 20386 gfp_t gfp) 20387 { 20388 struct wireless_dev *wdev = dev->ieee80211_ptr; 20389 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20390 struct sk_buff *msg; 20391 void *hdr; 20392 20393 if (!wdev->conn_owner_nlportid) 20394 return -EINVAL; 20395 20396 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20397 if (!msg) 20398 return -ENOMEM; 20399 20400 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH); 20401 if (!hdr) 20402 goto nla_put_failure; 20403 20404 /* Some historical mistakes in drivers <-> userspace interface (notably 20405 * between drivers and wpa_supplicant) led to a big-endian conversion 20406 * being needed on NL80211_ATTR_AKM_SUITES _only_ when its value is 20407 * WLAN_AKM_SUITE_SAE. This is now fixed on userspace side, but for the 20408 * benefit of older wpa_supplicant versions, send this particular value 20409 * in big-endian. Note that newer wpa_supplicant will also detect this 20410 * particular value in big endian still, so it all continues to work. 20411 */ 20412 if (params->key_mgmt_suite == WLAN_AKM_SUITE_SAE) { 20413 if (nla_put_be32(msg, NL80211_ATTR_AKM_SUITES, 20414 cpu_to_be32(WLAN_AKM_SUITE_SAE))) 20415 goto nla_put_failure; 20416 } else { 20417 if (nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, 20418 params->key_mgmt_suite)) 20419 goto nla_put_failure; 20420 } 20421 20422 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20423 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20424 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION, 20425 params->action) || 20426 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) || 20427 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len, 20428 params->ssid.ssid) || 20429 (!is_zero_ether_addr(params->mld_addr) && 20430 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr))) 20431 goto nla_put_failure; 20432 20433 genlmsg_end(msg, hdr); 20434 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 20435 wdev->conn_owner_nlportid); 20436 return 0; 20437 20438 nla_put_failure: 20439 nlmsg_free(msg); 20440 return -ENOBUFS; 20441 } 20442 EXPORT_SYMBOL(cfg80211_external_auth_request); 20443 20444 void cfg80211_update_owe_info_event(struct net_device *netdev, 20445 struct cfg80211_update_owe_info *owe_info, 20446 gfp_t gfp) 20447 { 20448 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 20449 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20450 struct sk_buff *msg; 20451 void *hdr; 20452 20453 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info); 20454 20455 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20456 if (!msg) 20457 return; 20458 20459 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO); 20460 if (!hdr) 20461 goto nla_put_failure; 20462 20463 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20464 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20465 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer)) 20466 goto nla_put_failure; 20467 20468 if (!owe_info->ie_len || 20469 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie)) 20470 goto nla_put_failure; 20471 20472 if (owe_info->assoc_link_id != -1) { 20473 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 20474 owe_info->assoc_link_id)) 20475 goto nla_put_failure; 20476 20477 if (!is_zero_ether_addr(owe_info->peer_mld_addr) && 20478 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 20479 owe_info->peer_mld_addr)) 20480 goto nla_put_failure; 20481 } 20482 20483 genlmsg_end(msg, hdr); 20484 20485 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20486 NL80211_MCGRP_MLME, gfp); 20487 return; 20488 20489 nla_put_failure: 20490 genlmsg_cancel(msg, hdr); 20491 nlmsg_free(msg); 20492 } 20493 EXPORT_SYMBOL(cfg80211_update_owe_info_event); 20494 20495 void cfg80211_schedule_channels_check(struct wireless_dev *wdev) 20496 { 20497 struct wiphy *wiphy = wdev->wiphy; 20498 20499 /* Schedule channels check if NO_IR or DFS relaxations are supported */ 20500 if (wdev->iftype == NL80211_IFTYPE_STATION && 20501 (wiphy_ext_feature_isset(wiphy, 20502 NL80211_EXT_FEATURE_DFS_CONCURRENT) || 20503 (IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) && 20504 wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR))) 20505 reg_check_channels(); 20506 } 20507 EXPORT_SYMBOL(cfg80211_schedule_channels_check); 20508 20509 void cfg80211_epcs_changed(struct net_device *netdev, bool enabled) 20510 { 20511 struct wireless_dev *wdev = netdev->ieee80211_ptr; 20512 struct wiphy *wiphy = wdev->wiphy; 20513 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20514 struct sk_buff *msg; 20515 void *hdr; 20516 20517 trace_cfg80211_epcs_changed(wdev, enabled); 20518 20519 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 20520 if (!msg) 20521 return; 20522 20523 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EPCS_CFG); 20524 if (!hdr) { 20525 nlmsg_free(msg); 20526 return; 20527 } 20528 20529 if (enabled && nla_put_flag(msg, NL80211_ATTR_EPCS)) 20530 goto nla_put_failure; 20531 20532 genlmsg_end(msg, hdr); 20533 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20534 NL80211_MCGRP_MLME, GFP_KERNEL); 20535 return; 20536 20537 nla_put_failure: 20538 nlmsg_free(msg); 20539 } 20540 EXPORT_SYMBOL(cfg80211_epcs_changed); 20541 20542 /* initialisation/exit functions */ 20543 20544 int __init nl80211_init(void) 20545 { 20546 int err; 20547 20548 err = genl_register_family(&nl80211_fam); 20549 if (err) 20550 return err; 20551 20552 err = netlink_register_notifier(&nl80211_netlink_notifier); 20553 if (err) 20554 goto err_out; 20555 20556 return 0; 20557 err_out: 20558 genl_unregister_family(&nl80211_fam); 20559 return err; 20560 } 20561 20562 void nl80211_exit(void) 20563 { 20564 netlink_unregister_notifier(&nl80211_netlink_notifier); 20565 genl_unregister_family(&nl80211_fam); 20566 } 20567