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 /* policy for the attributes */ 298 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR]; 299 300 static const struct nla_policy 301 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = { 302 [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, }, 303 [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY, 304 .len = U8_MAX }, 305 [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY, 306 .len = U8_MAX }, 307 }; 308 309 static const struct nla_policy 310 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = { 311 [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG }, 312 [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 }, 313 [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] = 314 NLA_POLICY_MAX(NLA_U8, 15), 315 [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 }, 316 [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] = 317 NLA_POLICY_MAX(NLA_U8, 15), 318 [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] = 319 NLA_POLICY_MAX(NLA_U8, 31), 320 [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 }, 321 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG }, 322 [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG }, 323 [NL80211_PMSR_FTM_REQ_ATTR_TRIGGER_BASED] = { .type = NLA_FLAG }, 324 [NL80211_PMSR_FTM_REQ_ATTR_NON_TRIGGER_BASED] = { .type = NLA_FLAG }, 325 [NL80211_PMSR_FTM_REQ_ATTR_LMR_FEEDBACK] = { .type = NLA_FLAG }, 326 [NL80211_PMSR_FTM_REQ_ATTR_BSS_COLOR] = { .type = NLA_U8 }, 327 }; 328 329 static const struct nla_policy 330 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = { 331 [NL80211_PMSR_TYPE_FTM] = 332 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy), 333 }; 334 335 static const struct nla_policy 336 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = { 337 [NL80211_PMSR_REQ_ATTR_DATA] = 338 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy), 339 [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG }, 340 }; 341 342 static const struct nla_policy 343 nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = { 344 [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR, 345 [NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy), 346 [NL80211_PMSR_PEER_ATTR_REQ] = 347 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy), 348 [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT }, 349 }; 350 351 static const struct nla_policy 352 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = { 353 [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT }, 354 [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT }, 355 [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT }, 356 [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT }, 357 [NL80211_PMSR_ATTR_PEERS] = 358 NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy), 359 }; 360 361 static const struct nla_policy 362 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = { 363 [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] = 364 NLA_POLICY_RANGE(NLA_U8, 1, 20), 365 [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] = 366 NLA_POLICY_RANGE(NLA_U8, 1, 20), 367 [NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] = 368 NLA_POLICY_RANGE(NLA_U8, 1, 20), 369 [NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] = 370 NLA_POLICY_EXACT_LEN(8), 371 [NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] = 372 NLA_POLICY_EXACT_LEN(8), 373 [NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 }, 374 }; 375 376 static const struct nla_policy 377 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = { 378 [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63), 379 [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG }, 380 [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG }, 381 }; 382 383 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = { 384 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY, 385 .len = NL80211_MAX_SUPP_RATES }, 386 [NL80211_TXRATE_HT] = { .type = NLA_BINARY, 387 .len = NL80211_MAX_SUPP_HT_RATES }, 388 [NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)), 389 [NL80211_TXRATE_GI] = { .type = NLA_U8 }, 390 [NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)), 391 [NL80211_TXRATE_HE_GI] = NLA_POLICY_RANGE(NLA_U8, 392 NL80211_RATE_INFO_HE_GI_0_8, 393 NL80211_RATE_INFO_HE_GI_3_2), 394 [NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8, 395 NL80211_RATE_INFO_HE_1XLTF, 396 NL80211_RATE_INFO_HE_4XLTF), 397 }; 398 399 static const struct nla_policy 400 nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = { 401 [NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 }, 402 [NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 }, 403 [NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG }, 404 [NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff), 405 [NL80211_TID_CONFIG_ATTR_NOACK] = 406 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 407 [NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 408 [NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 409 [NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] = 410 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 411 [NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] = 412 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 413 [NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] = 414 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 415 [NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] = 416 NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED), 417 [NL80211_TID_CONFIG_ATTR_TX_RATE] = 418 NLA_POLICY_NESTED(nl80211_txattr_policy), 419 }; 420 421 static const struct nla_policy 422 nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = { 423 [NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000), 424 [NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000), 425 [NL80211_FILS_DISCOVERY_ATTR_TMPL] = 426 NLA_POLICY_RANGE(NLA_BINARY, 427 NL80211_FILS_DISCOVERY_TMPL_MIN_LEN, 428 IEEE80211_MAX_DATA_LEN), 429 }; 430 431 static const struct nla_policy 432 nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = { 433 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20), 434 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY, 435 .len = IEEE80211_MAX_DATA_LEN } 436 }; 437 438 static const struct nla_policy 439 sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = { 440 [NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 }, 441 [NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 }, 442 }; 443 444 static const struct nla_policy 445 sar_policy[NL80211_SAR_ATTR_MAX + 1] = { 446 [NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE), 447 [NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy), 448 }; 449 450 static const struct nla_policy 451 nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = { 452 [NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2), 453 [NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] = 454 NLA_POLICY_MIN(NLA_U8, 1), 455 [NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 }, 456 [NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 }, 457 [NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG }, 458 }; 459 460 static const struct nla_policy 461 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = { 462 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 }, 463 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 }, 464 }; 465 466 static const struct netlink_range_validation nl80211_punct_bitmap_range = { 467 .min = 0, 468 .max = 0xffff, 469 }; 470 471 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = { 472 [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD }, 473 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 }, 474 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING, 475 .len = 20-1 }, 476 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED }, 477 478 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 }, 479 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 }, 480 [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8, 481 NL80211_EDMG_CHANNELS_MIN, 482 NL80211_EDMG_CHANNELS_MAX), 483 [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8, 484 NL80211_EDMG_BW_CONFIG_MIN, 485 NL80211_EDMG_BW_CONFIG_MAX), 486 487 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 }, 488 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 }, 489 [NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 490 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 }, 491 492 [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 493 [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 494 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 }, 495 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 }, 496 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 }, 497 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG }, 498 499 [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX), 500 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 }, 501 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 }, 502 503 [NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 504 [NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 505 506 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, }, 507 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY, 508 .len = WLAN_MAX_KEY_LEN }, 509 [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7), 510 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 }, 511 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG }, 512 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 513 [NL80211_ATTR_KEY_TYPE] = 514 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES), 515 516 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 }, 517 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 }, 518 [NL80211_ATTR_BEACON_HEAD] = 519 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 520 IEEE80211_MAX_DATA_LEN), 521 [NL80211_ATTR_BEACON_TAIL] = 522 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 523 IEEE80211_MAX_DATA_LEN), 524 [NL80211_ATTR_STA_AID] = 525 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 526 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED }, 527 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 }, 528 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY, 529 .len = NL80211_MAX_SUPP_RATES }, 530 [NL80211_ATTR_STA_PLINK_ACTION] = 531 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1), 532 [NL80211_ATTR_STA_TX_POWER_SETTING] = 533 NLA_POLICY_RANGE(NLA_U8, 534 NL80211_TX_POWER_AUTOMATIC, 535 NL80211_TX_POWER_FIXED), 536 [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 }, 537 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 }, 538 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ }, 539 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY, 540 .len = IEEE80211_MAX_MESH_ID_LEN }, 541 [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT, 542 543 /* allow 3 for NUL-termination, we used to declare this NLA_STRING */ 544 [NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3), 545 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED }, 546 547 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 }, 548 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 }, 549 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 }, 550 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY, 551 .len = NL80211_MAX_SUPP_RATES }, 552 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 }, 553 554 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED }, 555 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG }, 556 557 [NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN), 558 559 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 }, 560 [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY, 561 validate_ie_attr, 562 IEEE80211_MAX_DATA_LEN), 563 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED }, 564 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED }, 565 566 [NL80211_ATTR_SSID] = { .type = NLA_BINARY, 567 .len = IEEE80211_MAX_SSID_LEN }, 568 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 }, 569 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 }, 570 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG }, 571 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG }, 572 [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32, 573 NL80211_MFP_NO, 574 NL80211_MFP_OPTIONAL), 575 [NL80211_ATTR_STA_FLAGS2] = 576 NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)), 577 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG }, 578 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 }, 579 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG }, 580 [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG }, 581 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG }, 582 [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 }, 583 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 }, 584 [NL80211_ATTR_WPA_VERSIONS] = 585 NLA_POLICY_RANGE(NLA_U32, 0, 586 NL80211_WPA_VERSION_1 | 587 NL80211_WPA_VERSION_2 | 588 NL80211_WPA_VERSION_3), 589 [NL80211_ATTR_PID] = { .type = NLA_U32 }, 590 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 }, 591 [NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN), 592 [NL80211_ATTR_DURATION] = { .type = NLA_U32 }, 593 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 }, 594 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED }, 595 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY, 596 .len = IEEE80211_MAX_DATA_LEN }, 597 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, }, 598 [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32, 599 NL80211_PS_DISABLED, 600 NL80211_PS_ENABLED), 601 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, }, 602 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG }, 603 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 }, 604 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 }, 605 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 }, 606 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 }, 607 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 }, 608 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 }, 609 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 }, 610 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG }, 611 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 612 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED }, 613 [NL80211_ATTR_STA_PLINK_STATE] = 614 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1), 615 [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 }, 616 [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG }, 617 [NL80211_ATTR_MESH_PEER_AID] = 618 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 619 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 }, 620 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED }, 621 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED }, 622 [NL80211_ATTR_HIDDEN_SSID] = 623 NLA_POLICY_RANGE(NLA_U32, 624 NL80211_HIDDEN_SSID_NOT_IN_USE, 625 NL80211_HIDDEN_SSID_ZERO_CONTENTS), 626 [NL80211_ATTR_IE_PROBE_RESP] = 627 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 628 IEEE80211_MAX_DATA_LEN), 629 [NL80211_ATTR_IE_ASSOC_RESP] = 630 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 631 IEEE80211_MAX_DATA_LEN), 632 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG }, 633 [NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy), 634 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED }, 635 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG }, 636 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 }, 637 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 }, 638 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 }, 639 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG }, 640 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG }, 641 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG }, 642 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG }, 643 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY, 644 .len = IEEE80211_MAX_DATA_LEN }, 645 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 }, 646 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG }, 647 [NL80211_ATTR_HT_CAPABILITY_MASK] = { 648 .len = NL80211_HT_CAPABILITY_LEN 649 }, 650 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 }, 651 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 }, 652 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 }, 653 [NL80211_ATTR_WDEV] = { .type = NLA_U64 }, 654 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 }, 655 656 /* need to include at least Auth Transaction and Status Code */ 657 [NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4), 658 659 [NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN), 660 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 }, 661 [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127), 662 [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1), 663 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = 664 NLA_POLICY_RANGE(NLA_U32, 665 NL80211_MESH_POWER_UNKNOWN + 1, 666 NL80211_MESH_POWER_MAX), 667 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 }, 668 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED }, 669 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 }, 670 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, }, 671 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, }, 672 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG }, 673 [NL80211_ATTR_VHT_CAPABILITY_MASK] = { 674 .len = NL80211_VHT_CAPABILITY_LEN, 675 }, 676 [NL80211_ATTR_MDID] = { .type = NLA_U16 }, 677 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY, 678 .len = IEEE80211_MAX_DATA_LEN }, 679 [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 }, 680 [NL80211_ATTR_MAX_CRIT_PROT_DURATION] = 681 NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION), 682 [NL80211_ATTR_PEER_AID] = 683 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 684 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 }, 685 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG }, 686 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED }, 687 [NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY }, 688 [NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY }, 689 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2), 690 /* 691 * The value of the Length field of the Supported Operating 692 * Classes element is between 2 and 253. 693 */ 694 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = 695 NLA_POLICY_RANGE(NLA_BINARY, 2, 253), 696 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG }, 697 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 }, 698 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 }, 699 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 }, 700 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY }, 701 [NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY, 702 IEEE80211_QOS_MAP_LEN_MIN, 703 IEEE80211_QOS_MAP_LEN_MAX), 704 [NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 705 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 }, 706 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 }, 707 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG }, 708 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY }, 709 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG }, 710 [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1), 711 [NL80211_ATTR_USER_PRIO] = 712 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1), 713 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 }, 714 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 }, 715 [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 }, 716 [NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 717 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG }, 718 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 }, 719 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 }, 720 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG }, 721 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG }, 722 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED }, 723 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = 724 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1), 725 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = { 726 .len = VHT_MUMIMO_GROUPS_DATA_LEN 727 }, 728 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 729 [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1), 730 [NL80211_ATTR_BANDS] = { .type = NLA_U32 }, 731 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED }, 732 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY, 733 .len = FILS_MAX_KEK_LEN }, 734 [NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN), 735 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, }, 736 [NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 737 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 }, 738 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = { 739 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 740 }, 741 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 }, 742 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY, 743 .len = FILS_ERP_MAX_USERNAME_LEN }, 744 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY, 745 .len = FILS_ERP_MAX_REALM_LEN }, 746 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 }, 747 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY, 748 .len = FILS_ERP_MAX_RRK_LEN }, 749 [NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2), 750 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN }, 751 [NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN), 752 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG }, 753 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG }, 754 755 [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 }, 756 [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 }, 757 [NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 }, 758 [NL80211_ATTR_HE_CAPABILITY] = 759 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa, 760 NL80211_HE_MAX_CAPABILITY_LEN), 761 [NL80211_ATTR_FTM_RESPONDER] = 762 NLA_POLICY_NESTED(nl80211_ftm_responder_policy), 763 [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1), 764 [NL80211_ATTR_PEER_MEASUREMENTS] = 765 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy), 766 [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1), 767 [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY, 768 .len = SAE_PASSWORD_MAX_LEN }, 769 [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG }, 770 [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy), 771 [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2), 772 [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy), 773 [NL80211_ATTR_TID_CONFIG] = 774 NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy), 775 [NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG }, 776 [NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1), 777 [NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100), 778 [NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG }, 779 [NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 780 [NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED }, 781 [NL80211_ATTR_HE_6GHZ_CAPABILITY] = 782 NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)), 783 [NL80211_ATTR_FILS_DISCOVERY] = 784 NLA_POLICY_NESTED(nl80211_fils_discovery_policy), 785 [NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] = 786 NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy), 787 [NL80211_ATTR_S1G_CAPABILITY] = 788 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 789 [NL80211_ATTR_S1G_CAPABILITY_MASK] = 790 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 791 [NL80211_ATTR_SAE_PWE] = 792 NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK, 793 NL80211_SAE_PWE_BOTH), 794 [NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT }, 795 [NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy), 796 [NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG }, 797 [NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 }, 798 [NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 }, 799 [NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 }, 800 [NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy), 801 [NL80211_ATTR_MBSSID_CONFIG] = 802 NLA_POLICY_NESTED(nl80211_mbssid_config_policy), 803 [NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED }, 804 [NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG }, 805 [NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 }, 806 [NL80211_ATTR_EHT_CAPABILITY] = 807 NLA_POLICY_RANGE(NLA_BINARY, 808 NL80211_EHT_MIN_CAPABILITY_LEN, 809 NL80211_EHT_MAX_CAPABILITY_LEN), 810 [NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG }, 811 [NL80211_ATTR_MLO_LINKS] = 812 NLA_POLICY_NESTED_ARRAY(nl80211_policy), 813 [NL80211_ATTR_MLO_LINK_ID] = 814 NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS), 815 [NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN), 816 [NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG }, 817 [NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT }, 818 [NL80211_ATTR_PUNCT_BITMAP] = 819 NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range), 820 821 [NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS] = { .type = NLA_U16 }, 822 [NL80211_ATTR_HW_TIMESTAMP_ENABLED] = { .type = NLA_FLAG }, 823 [NL80211_ATTR_EMA_RNR_ELEMS] = { .type = NLA_NESTED }, 824 [NL80211_ATTR_MLO_LINK_DISABLED] = { .type = NLA_FLAG }, 825 [NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA] = { .type = NLA_FLAG }, 826 [NL80211_ATTR_MLO_TTLM_DLINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 827 [NL80211_ATTR_MLO_TTLM_ULINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8), 828 [NL80211_ATTR_ASSOC_SPP_AMSDU] = { .type = NLA_FLAG }, 829 }; 830 831 /* policy for the key attributes */ 832 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = { 833 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN }, 834 [NL80211_KEY_IDX] = { .type = NLA_U8 }, 835 [NL80211_KEY_CIPHER] = { .type = NLA_U32 }, 836 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 837 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG }, 838 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG }, 839 [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1), 840 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 841 [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX), 842 }; 843 844 /* policy for the key default flags */ 845 static const struct nla_policy 846 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = { 847 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG }, 848 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG }, 849 }; 850 851 #ifdef CONFIG_PM 852 /* policy for WoWLAN attributes */ 853 static const struct nla_policy 854 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = { 855 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG }, 856 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG }, 857 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG }, 858 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED }, 859 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG }, 860 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG }, 861 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG }, 862 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG }, 863 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED }, 864 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED }, 865 }; 866 867 static const struct nla_policy 868 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = { 869 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 }, 870 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 }, 871 [NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 872 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 }, 873 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 }, 874 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 875 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = { 876 .len = sizeof(struct nl80211_wowlan_tcp_data_seq) 877 }, 878 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = { 879 .len = sizeof(struct nl80211_wowlan_tcp_data_token) 880 }, 881 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 }, 882 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 883 [NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1), 884 }; 885 #endif /* CONFIG_PM */ 886 887 /* policy for coalesce rule attributes */ 888 static const struct nla_policy 889 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = { 890 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 }, 891 [NL80211_ATTR_COALESCE_RULE_CONDITION] = 892 NLA_POLICY_RANGE(NLA_U32, 893 NL80211_COALESCE_CONDITION_MATCH, 894 NL80211_COALESCE_CONDITION_NO_MATCH), 895 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED }, 896 }; 897 898 /* policy for GTK rekey offload attributes */ 899 static const struct nla_policy 900 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = { 901 [NL80211_REKEY_DATA_KEK] = { 902 .type = NLA_BINARY, 903 .len = NL80211_KEK_EXT_LEN 904 }, 905 [NL80211_REKEY_DATA_KCK] = { 906 .type = NLA_BINARY, 907 .len = NL80211_KCK_EXT_LEN_32 908 }, 909 [NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN), 910 [NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 }, 911 }; 912 913 static const struct nla_policy 914 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = { 915 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY, 916 .len = IEEE80211_MAX_SSID_LEN }, 917 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 918 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 }, 919 }; 920 921 static const struct nla_policy 922 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = { 923 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 }, 924 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 }, 925 }; 926 927 static const struct nla_policy 928 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = { 929 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG }, 930 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 }, 931 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = { 932 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 933 }, 934 }; 935 936 /* policy for NAN function attributes */ 937 static const struct nla_policy 938 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = { 939 [NL80211_NAN_FUNC_TYPE] = 940 NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE), 941 [NL80211_NAN_FUNC_SERVICE_ID] = { 942 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN }, 943 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 }, 944 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG }, 945 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG }, 946 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 }, 947 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 }, 948 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 949 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG }, 950 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 }, 951 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY, 952 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN }, 953 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED }, 954 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED }, 955 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED }, 956 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 }, 957 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 }, 958 }; 959 960 /* policy for Service Response Filter attributes */ 961 static const struct nla_policy 962 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = { 963 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG }, 964 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY, 965 .len = NL80211_NAN_FUNC_SRF_MAX_LEN }, 966 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 }, 967 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED }, 968 }; 969 970 /* policy for packet pattern attributes */ 971 static const struct nla_policy 972 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = { 973 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, }, 974 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, }, 975 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 }, 976 }; 977 978 static int nl80211_prepare_wdev_dump(struct netlink_callback *cb, 979 struct cfg80211_registered_device **rdev, 980 struct wireless_dev **wdev, 981 struct nlattr **attrbuf) 982 { 983 int err; 984 985 if (!cb->args[0]) { 986 struct nlattr **attrbuf_free = NULL; 987 988 if (!attrbuf) { 989 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 990 GFP_KERNEL); 991 if (!attrbuf) 992 return -ENOMEM; 993 attrbuf_free = attrbuf; 994 } 995 996 err = nlmsg_parse_deprecated(cb->nlh, 997 GENL_HDRLEN + nl80211_fam.hdrsize, 998 attrbuf, nl80211_fam.maxattr, 999 nl80211_policy, NULL); 1000 if (err) { 1001 kfree(attrbuf_free); 1002 return err; 1003 } 1004 1005 rtnl_lock(); 1006 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk), 1007 attrbuf); 1008 kfree(attrbuf_free); 1009 if (IS_ERR(*wdev)) { 1010 rtnl_unlock(); 1011 return PTR_ERR(*wdev); 1012 } 1013 *rdev = wiphy_to_rdev((*wdev)->wiphy); 1014 mutex_lock(&(*rdev)->wiphy.mtx); 1015 rtnl_unlock(); 1016 /* 0 is the first index - add 1 to parse only once */ 1017 cb->args[0] = (*rdev)->wiphy_idx + 1; 1018 cb->args[1] = (*wdev)->identifier; 1019 } else { 1020 /* subtract the 1 again here */ 1021 struct wiphy *wiphy; 1022 struct wireless_dev *tmp; 1023 1024 rtnl_lock(); 1025 wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 1026 if (!wiphy) { 1027 rtnl_unlock(); 1028 return -ENODEV; 1029 } 1030 *rdev = wiphy_to_rdev(wiphy); 1031 *wdev = NULL; 1032 1033 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) { 1034 if (tmp->identifier == cb->args[1]) { 1035 *wdev = tmp; 1036 break; 1037 } 1038 } 1039 1040 if (!*wdev) { 1041 rtnl_unlock(); 1042 return -ENODEV; 1043 } 1044 mutex_lock(&(*rdev)->wiphy.mtx); 1045 rtnl_unlock(); 1046 } 1047 1048 return 0; 1049 } 1050 1051 /* message building helper */ 1052 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq, 1053 int flags, u8 cmd) 1054 { 1055 /* since there is no private header just add the generic one */ 1056 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd); 1057 } 1058 1059 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg, 1060 const struct ieee80211_reg_rule *rule) 1061 { 1062 int j; 1063 struct nlattr *nl_wmm_rules = 1064 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM); 1065 1066 if (!nl_wmm_rules) 1067 goto nla_put_failure; 1068 1069 for (j = 0; j < IEEE80211_NUM_ACS; j++) { 1070 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j); 1071 1072 if (!nl_wmm_rule) 1073 goto nla_put_failure; 1074 1075 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN, 1076 rule->wmm_rule.client[j].cw_min) || 1077 nla_put_u16(msg, NL80211_WMMR_CW_MAX, 1078 rule->wmm_rule.client[j].cw_max) || 1079 nla_put_u8(msg, NL80211_WMMR_AIFSN, 1080 rule->wmm_rule.client[j].aifsn) || 1081 nla_put_u16(msg, NL80211_WMMR_TXOP, 1082 rule->wmm_rule.client[j].cot)) 1083 goto nla_put_failure; 1084 1085 nla_nest_end(msg, nl_wmm_rule); 1086 } 1087 nla_nest_end(msg, nl_wmm_rules); 1088 1089 return 0; 1090 1091 nla_put_failure: 1092 return -ENOBUFS; 1093 } 1094 1095 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy, 1096 struct ieee80211_channel *chan, 1097 bool large) 1098 { 1099 /* Some channels must be completely excluded from the 1100 * list to protect old user-space tools from breaking 1101 */ 1102 if (!large && chan->flags & 1103 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ)) 1104 return 0; 1105 if (!large && chan->freq_offset) 1106 return 0; 1107 1108 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ, 1109 chan->center_freq)) 1110 goto nla_put_failure; 1111 1112 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset)) 1113 goto nla_put_failure; 1114 1115 if ((chan->flags & IEEE80211_CHAN_PSD) && 1116 nla_put_s8(msg, NL80211_FREQUENCY_ATTR_PSD, chan->psd)) 1117 goto nla_put_failure; 1118 1119 if ((chan->flags & IEEE80211_CHAN_DISABLED) && 1120 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED)) 1121 goto nla_put_failure; 1122 if (chan->flags & IEEE80211_CHAN_NO_IR) { 1123 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR)) 1124 goto nla_put_failure; 1125 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS)) 1126 goto nla_put_failure; 1127 } 1128 if (chan->flags & IEEE80211_CHAN_RADAR) { 1129 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR)) 1130 goto nla_put_failure; 1131 if (large) { 1132 u32 time; 1133 1134 time = elapsed_jiffies_msecs(chan->dfs_state_entered); 1135 1136 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE, 1137 chan->dfs_state)) 1138 goto nla_put_failure; 1139 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME, 1140 time)) 1141 goto nla_put_failure; 1142 if (nla_put_u32(msg, 1143 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME, 1144 chan->dfs_cac_ms)) 1145 goto nla_put_failure; 1146 } 1147 } 1148 1149 if (large) { 1150 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) && 1151 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS)) 1152 goto nla_put_failure; 1153 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) && 1154 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS)) 1155 goto nla_put_failure; 1156 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) && 1157 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ)) 1158 goto nla_put_failure; 1159 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) && 1160 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ)) 1161 goto nla_put_failure; 1162 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) && 1163 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY)) 1164 goto nla_put_failure; 1165 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) && 1166 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT)) 1167 goto nla_put_failure; 1168 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) && 1169 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ)) 1170 goto nla_put_failure; 1171 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) && 1172 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ)) 1173 goto nla_put_failure; 1174 if ((chan->flags & IEEE80211_CHAN_NO_HE) && 1175 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE)) 1176 goto nla_put_failure; 1177 if ((chan->flags & IEEE80211_CHAN_1MHZ) && 1178 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_1MHZ)) 1179 goto nla_put_failure; 1180 if ((chan->flags & IEEE80211_CHAN_2MHZ) && 1181 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_2MHZ)) 1182 goto nla_put_failure; 1183 if ((chan->flags & IEEE80211_CHAN_4MHZ) && 1184 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_4MHZ)) 1185 goto nla_put_failure; 1186 if ((chan->flags & IEEE80211_CHAN_8MHZ) && 1187 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_8MHZ)) 1188 goto nla_put_failure; 1189 if ((chan->flags & IEEE80211_CHAN_16MHZ) && 1190 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_16MHZ)) 1191 goto nla_put_failure; 1192 if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) && 1193 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ)) 1194 goto nla_put_failure; 1195 if ((chan->flags & IEEE80211_CHAN_NO_EHT) && 1196 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT)) 1197 goto nla_put_failure; 1198 if ((chan->flags & IEEE80211_CHAN_DFS_CONCURRENT) && 1199 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DFS_CONCURRENT)) 1200 goto nla_put_failure; 1201 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_VLP_CLIENT) && 1202 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_VLP_CLIENT)) 1203 goto nla_put_failure; 1204 if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_AFC_CLIENT) && 1205 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_AFC_CLIENT)) 1206 goto nla_put_failure; 1207 } 1208 1209 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER, 1210 DBM_TO_MBM(chan->max_power))) 1211 goto nla_put_failure; 1212 1213 if (large) { 1214 const struct ieee80211_reg_rule *rule = 1215 freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq)); 1216 1217 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) { 1218 if (nl80211_msg_put_wmm_rules(msg, rule)) 1219 goto nla_put_failure; 1220 } 1221 } 1222 1223 return 0; 1224 1225 nla_put_failure: 1226 return -ENOBUFS; 1227 } 1228 1229 static bool nl80211_put_txq_stats(struct sk_buff *msg, 1230 struct cfg80211_txq_stats *txqstats, 1231 int attrtype) 1232 { 1233 struct nlattr *txqattr; 1234 1235 #define PUT_TXQVAL_U32(attr, memb) do { \ 1236 if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \ 1237 nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \ 1238 return false; \ 1239 } while (0) 1240 1241 txqattr = nla_nest_start_noflag(msg, attrtype); 1242 if (!txqattr) 1243 return false; 1244 1245 PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes); 1246 PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets); 1247 PUT_TXQVAL_U32(FLOWS, flows); 1248 PUT_TXQVAL_U32(DROPS, drops); 1249 PUT_TXQVAL_U32(ECN_MARKS, ecn_marks); 1250 PUT_TXQVAL_U32(OVERLIMIT, overlimit); 1251 PUT_TXQVAL_U32(OVERMEMORY, overmemory); 1252 PUT_TXQVAL_U32(COLLISIONS, collisions); 1253 PUT_TXQVAL_U32(TX_BYTES, tx_bytes); 1254 PUT_TXQVAL_U32(TX_PACKETS, tx_packets); 1255 PUT_TXQVAL_U32(MAX_FLOWS, max_flows); 1256 nla_nest_end(msg, txqattr); 1257 1258 #undef PUT_TXQVAL_U32 1259 return true; 1260 } 1261 1262 /* netlink command implementations */ 1263 1264 /** 1265 * nl80211_link_id - return link ID 1266 * @attrs: attributes to look at 1267 * 1268 * Returns: the link ID or 0 if not given 1269 * 1270 * Note this function doesn't do any validation of the link 1271 * ID validity wrt. links that were actually added, so it must 1272 * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID 1273 * or if additional validation is done. 1274 */ 1275 static unsigned int nl80211_link_id(struct nlattr **attrs) 1276 { 1277 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1278 1279 if (!linkid) 1280 return 0; 1281 1282 return nla_get_u8(linkid); 1283 } 1284 1285 static int nl80211_link_id_or_invalid(struct nlattr **attrs) 1286 { 1287 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1288 1289 if (!linkid) 1290 return -1; 1291 1292 return nla_get_u8(linkid); 1293 } 1294 1295 struct key_parse { 1296 struct key_params p; 1297 int idx; 1298 int type; 1299 bool def, defmgmt, defbeacon; 1300 bool def_uni, def_multi; 1301 }; 1302 1303 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key, 1304 struct key_parse *k) 1305 { 1306 struct nlattr *tb[NL80211_KEY_MAX + 1]; 1307 int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key, 1308 nl80211_key_policy, 1309 info->extack); 1310 if (err) 1311 return err; 1312 1313 k->def = !!tb[NL80211_KEY_DEFAULT]; 1314 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT]; 1315 k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON]; 1316 1317 if (k->def) { 1318 k->def_uni = true; 1319 k->def_multi = true; 1320 } 1321 if (k->defmgmt || k->defbeacon) 1322 k->def_multi = true; 1323 1324 if (tb[NL80211_KEY_IDX]) 1325 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]); 1326 1327 if (tb[NL80211_KEY_DATA]) { 1328 k->p.key = nla_data(tb[NL80211_KEY_DATA]); 1329 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]); 1330 } 1331 1332 if (tb[NL80211_KEY_SEQ]) { 1333 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]); 1334 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]); 1335 } 1336 1337 if (tb[NL80211_KEY_CIPHER]) 1338 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]); 1339 1340 if (tb[NL80211_KEY_TYPE]) 1341 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]); 1342 1343 if (tb[NL80211_KEY_DEFAULT_TYPES]) { 1344 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1345 1346 err = nla_parse_nested_deprecated(kdt, 1347 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1348 tb[NL80211_KEY_DEFAULT_TYPES], 1349 nl80211_key_default_policy, 1350 info->extack); 1351 if (err) 1352 return err; 1353 1354 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1355 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1356 } 1357 1358 if (tb[NL80211_KEY_MODE]) 1359 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]); 1360 1361 return 0; 1362 } 1363 1364 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k) 1365 { 1366 if (info->attrs[NL80211_ATTR_KEY_DATA]) { 1367 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]); 1368 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]); 1369 } 1370 1371 if (info->attrs[NL80211_ATTR_KEY_SEQ]) { 1372 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]); 1373 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]); 1374 } 1375 1376 if (info->attrs[NL80211_ATTR_KEY_IDX]) 1377 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 1378 1379 if (info->attrs[NL80211_ATTR_KEY_CIPHER]) 1380 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]); 1381 1382 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT]; 1383 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT]; 1384 1385 if (k->def) { 1386 k->def_uni = true; 1387 k->def_multi = true; 1388 } 1389 if (k->defmgmt) 1390 k->def_multi = true; 1391 1392 if (info->attrs[NL80211_ATTR_KEY_TYPE]) 1393 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 1394 1395 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) { 1396 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1397 int err = nla_parse_nested_deprecated(kdt, 1398 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1399 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES], 1400 nl80211_key_default_policy, 1401 info->extack); 1402 if (err) 1403 return err; 1404 1405 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1406 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1407 } 1408 1409 return 0; 1410 } 1411 1412 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k) 1413 { 1414 int err; 1415 1416 memset(k, 0, sizeof(*k)); 1417 k->idx = -1; 1418 k->type = -1; 1419 1420 if (info->attrs[NL80211_ATTR_KEY]) 1421 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k); 1422 else 1423 err = nl80211_parse_key_old(info, k); 1424 1425 if (err) 1426 return err; 1427 1428 if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) + 1429 (k->defbeacon ? 1 : 0) > 1) { 1430 GENL_SET_ERR_MSG(info, 1431 "key with multiple default flags is invalid"); 1432 return -EINVAL; 1433 } 1434 1435 if (k->defmgmt || k->defbeacon) { 1436 if (k->def_uni || !k->def_multi) { 1437 GENL_SET_ERR_MSG(info, 1438 "defmgmt/defbeacon key must be mcast"); 1439 return -EINVAL; 1440 } 1441 } 1442 1443 if (k->idx != -1) { 1444 if (k->defmgmt) { 1445 if (k->idx < 4 || k->idx > 5) { 1446 GENL_SET_ERR_MSG(info, 1447 "defmgmt key idx not 4 or 5"); 1448 return -EINVAL; 1449 } 1450 } else if (k->defbeacon) { 1451 if (k->idx < 6 || k->idx > 7) { 1452 GENL_SET_ERR_MSG(info, 1453 "defbeacon key idx not 6 or 7"); 1454 return -EINVAL; 1455 } 1456 } else if (k->def) { 1457 if (k->idx < 0 || k->idx > 3) { 1458 GENL_SET_ERR_MSG(info, "def key idx not 0-3"); 1459 return -EINVAL; 1460 } 1461 } else { 1462 if (k->idx < 0 || k->idx > 7) { 1463 GENL_SET_ERR_MSG(info, "key idx not 0-7"); 1464 return -EINVAL; 1465 } 1466 } 1467 } 1468 1469 return 0; 1470 } 1471 1472 static struct cfg80211_cached_keys * 1473 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev, 1474 struct genl_info *info, bool *no_ht) 1475 { 1476 struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS]; 1477 struct key_parse parse; 1478 struct nlattr *key; 1479 struct cfg80211_cached_keys *result; 1480 int rem, err, def = 0; 1481 bool have_key = false; 1482 1483 nla_for_each_nested(key, keys, rem) { 1484 have_key = true; 1485 break; 1486 } 1487 1488 if (!have_key) 1489 return NULL; 1490 1491 result = kzalloc(sizeof(*result), GFP_KERNEL); 1492 if (!result) 1493 return ERR_PTR(-ENOMEM); 1494 1495 result->def = -1; 1496 1497 nla_for_each_nested(key, keys, rem) { 1498 memset(&parse, 0, sizeof(parse)); 1499 parse.idx = -1; 1500 1501 err = nl80211_parse_key_new(info, key, &parse); 1502 if (err) 1503 goto error; 1504 err = -EINVAL; 1505 if (!parse.p.key) 1506 goto error; 1507 if (parse.idx < 0 || parse.idx > 3) { 1508 GENL_SET_ERR_MSG(info, "key index out of range [0-3]"); 1509 goto error; 1510 } 1511 if (parse.def) { 1512 if (def) { 1513 GENL_SET_ERR_MSG(info, 1514 "only one key can be default"); 1515 goto error; 1516 } 1517 def = 1; 1518 result->def = parse.idx; 1519 if (!parse.def_uni || !parse.def_multi) 1520 goto error; 1521 } else if (parse.defmgmt) 1522 goto error; 1523 err = cfg80211_validate_key_settings(rdev, &parse.p, 1524 parse.idx, false, NULL); 1525 if (err) 1526 goto error; 1527 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 && 1528 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) { 1529 GENL_SET_ERR_MSG(info, "connect key must be WEP"); 1530 err = -EINVAL; 1531 goto error; 1532 } 1533 result->params[parse.idx].cipher = parse.p.cipher; 1534 result->params[parse.idx].key_len = parse.p.key_len; 1535 result->params[parse.idx].key = result->data[parse.idx]; 1536 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len); 1537 1538 /* must be WEP key if we got here */ 1539 if (no_ht) 1540 *no_ht = true; 1541 } 1542 1543 if (result->def < 0) { 1544 err = -EINVAL; 1545 GENL_SET_ERR_MSG(info, "need a default/TX key"); 1546 goto error; 1547 } 1548 1549 return result; 1550 error: 1551 kfree(result); 1552 return ERR_PTR(err); 1553 } 1554 1555 static int nl80211_key_allowed(struct wireless_dev *wdev) 1556 { 1557 lockdep_assert_wiphy(wdev->wiphy); 1558 1559 switch (wdev->iftype) { 1560 case NL80211_IFTYPE_AP: 1561 case NL80211_IFTYPE_AP_VLAN: 1562 case NL80211_IFTYPE_P2P_GO: 1563 case NL80211_IFTYPE_MESH_POINT: 1564 break; 1565 case NL80211_IFTYPE_ADHOC: 1566 if (wdev->u.ibss.current_bss) 1567 return 0; 1568 return -ENOLINK; 1569 case NL80211_IFTYPE_STATION: 1570 case NL80211_IFTYPE_P2P_CLIENT: 1571 if (wdev->connected) 1572 return 0; 1573 return -ENOLINK; 1574 case NL80211_IFTYPE_NAN: 1575 if (wiphy_ext_feature_isset(wdev->wiphy, 1576 NL80211_EXT_FEATURE_SECURE_NAN)) 1577 return 0; 1578 return -EINVAL; 1579 case NL80211_IFTYPE_UNSPECIFIED: 1580 case NL80211_IFTYPE_OCB: 1581 case NL80211_IFTYPE_MONITOR: 1582 case NL80211_IFTYPE_P2P_DEVICE: 1583 case NL80211_IFTYPE_WDS: 1584 case NUM_NL80211_IFTYPES: 1585 return -EINVAL; 1586 } 1587 1588 return 0; 1589 } 1590 1591 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy, 1592 u32 freq) 1593 { 1594 struct ieee80211_channel *chan; 1595 1596 chan = ieee80211_get_channel_khz(wiphy, freq); 1597 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) 1598 return NULL; 1599 return chan; 1600 } 1601 1602 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes) 1603 { 1604 struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr); 1605 int i; 1606 1607 if (!nl_modes) 1608 goto nla_put_failure; 1609 1610 i = 0; 1611 while (ifmodes) { 1612 if ((ifmodes & 1) && nla_put_flag(msg, i)) 1613 goto nla_put_failure; 1614 ifmodes >>= 1; 1615 i++; 1616 } 1617 1618 nla_nest_end(msg, nl_modes); 1619 return 0; 1620 1621 nla_put_failure: 1622 return -ENOBUFS; 1623 } 1624 1625 static int nl80211_put_iface_combinations(struct wiphy *wiphy, 1626 struct sk_buff *msg, 1627 bool large) 1628 { 1629 struct nlattr *nl_combis; 1630 int i, j; 1631 1632 nl_combis = nla_nest_start_noflag(msg, 1633 NL80211_ATTR_INTERFACE_COMBINATIONS); 1634 if (!nl_combis) 1635 goto nla_put_failure; 1636 1637 for (i = 0; i < wiphy->n_iface_combinations; i++) { 1638 const struct ieee80211_iface_combination *c; 1639 struct nlattr *nl_combi, *nl_limits; 1640 1641 c = &wiphy->iface_combinations[i]; 1642 1643 nl_combi = nla_nest_start_noflag(msg, i + 1); 1644 if (!nl_combi) 1645 goto nla_put_failure; 1646 1647 nl_limits = nla_nest_start_noflag(msg, 1648 NL80211_IFACE_COMB_LIMITS); 1649 if (!nl_limits) 1650 goto nla_put_failure; 1651 1652 for (j = 0; j < c->n_limits; j++) { 1653 struct nlattr *nl_limit; 1654 1655 nl_limit = nla_nest_start_noflag(msg, j + 1); 1656 if (!nl_limit) 1657 goto nla_put_failure; 1658 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, 1659 c->limits[j].max)) 1660 goto nla_put_failure; 1661 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES, 1662 c->limits[j].types)) 1663 goto nla_put_failure; 1664 nla_nest_end(msg, nl_limit); 1665 } 1666 1667 nla_nest_end(msg, nl_limits); 1668 1669 if (c->beacon_int_infra_match && 1670 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH)) 1671 goto nla_put_failure; 1672 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS, 1673 c->num_different_channels) || 1674 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM, 1675 c->max_interfaces)) 1676 goto nla_put_failure; 1677 if (large && 1678 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS, 1679 c->radar_detect_widths) || 1680 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS, 1681 c->radar_detect_regions))) 1682 goto nla_put_failure; 1683 if (c->beacon_int_min_gcd && 1684 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD, 1685 c->beacon_int_min_gcd)) 1686 goto nla_put_failure; 1687 1688 nla_nest_end(msg, nl_combi); 1689 } 1690 1691 nla_nest_end(msg, nl_combis); 1692 1693 return 0; 1694 nla_put_failure: 1695 return -ENOBUFS; 1696 } 1697 1698 #ifdef CONFIG_PM 1699 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev, 1700 struct sk_buff *msg) 1701 { 1702 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp; 1703 struct nlattr *nl_tcp; 1704 1705 if (!tcp) 1706 return 0; 1707 1708 nl_tcp = nla_nest_start_noflag(msg, 1709 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 1710 if (!nl_tcp) 1711 return -ENOBUFS; 1712 1713 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1714 tcp->data_payload_max)) 1715 return -ENOBUFS; 1716 1717 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1718 tcp->data_payload_max)) 1719 return -ENOBUFS; 1720 1721 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ)) 1722 return -ENOBUFS; 1723 1724 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 1725 sizeof(*tcp->tok), tcp->tok)) 1726 return -ENOBUFS; 1727 1728 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 1729 tcp->data_interval_max)) 1730 return -ENOBUFS; 1731 1732 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 1733 tcp->wake_payload_max)) 1734 return -ENOBUFS; 1735 1736 nla_nest_end(msg, nl_tcp); 1737 return 0; 1738 } 1739 1740 static int nl80211_send_wowlan(struct sk_buff *msg, 1741 struct cfg80211_registered_device *rdev, 1742 bool large) 1743 { 1744 struct nlattr *nl_wowlan; 1745 1746 if (!rdev->wiphy.wowlan) 1747 return 0; 1748 1749 nl_wowlan = nla_nest_start_noflag(msg, 1750 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED); 1751 if (!nl_wowlan) 1752 return -ENOBUFS; 1753 1754 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) && 1755 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 1756 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) && 1757 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 1758 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) && 1759 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 1760 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) && 1761 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) || 1762 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) && 1763 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 1764 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) && 1765 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 1766 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) && 1767 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 1768 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) && 1769 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 1770 return -ENOBUFS; 1771 1772 if (rdev->wiphy.wowlan->n_patterns) { 1773 struct nl80211_pattern_support pat = { 1774 .max_patterns = rdev->wiphy.wowlan->n_patterns, 1775 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len, 1776 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len, 1777 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset, 1778 }; 1779 1780 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 1781 sizeof(pat), &pat)) 1782 return -ENOBUFS; 1783 } 1784 1785 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) && 1786 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT, 1787 rdev->wiphy.wowlan->max_nd_match_sets)) 1788 return -ENOBUFS; 1789 1790 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg)) 1791 return -ENOBUFS; 1792 1793 nla_nest_end(msg, nl_wowlan); 1794 1795 return 0; 1796 } 1797 #endif 1798 1799 static int nl80211_send_coalesce(struct sk_buff *msg, 1800 struct cfg80211_registered_device *rdev) 1801 { 1802 struct nl80211_coalesce_rule_support rule; 1803 1804 if (!rdev->wiphy.coalesce) 1805 return 0; 1806 1807 rule.max_rules = rdev->wiphy.coalesce->n_rules; 1808 rule.max_delay = rdev->wiphy.coalesce->max_delay; 1809 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns; 1810 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len; 1811 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len; 1812 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset; 1813 1814 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule)) 1815 return -ENOBUFS; 1816 1817 return 0; 1818 } 1819 1820 static int 1821 nl80211_send_iftype_data(struct sk_buff *msg, 1822 const struct ieee80211_supported_band *sband, 1823 const struct ieee80211_sband_iftype_data *iftdata) 1824 { 1825 const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap; 1826 const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap; 1827 1828 if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES, 1829 iftdata->types_mask)) 1830 return -ENOBUFS; 1831 1832 if (he_cap->has_he) { 1833 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC, 1834 sizeof(he_cap->he_cap_elem.mac_cap_info), 1835 he_cap->he_cap_elem.mac_cap_info) || 1836 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY, 1837 sizeof(he_cap->he_cap_elem.phy_cap_info), 1838 he_cap->he_cap_elem.phy_cap_info) || 1839 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET, 1840 sizeof(he_cap->he_mcs_nss_supp), 1841 &he_cap->he_mcs_nss_supp) || 1842 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE, 1843 sizeof(he_cap->ppe_thres), he_cap->ppe_thres)) 1844 return -ENOBUFS; 1845 } 1846 1847 if (eht_cap->has_eht && he_cap->has_he) { 1848 u8 mcs_nss_size, ppe_thresh_size; 1849 u16 ppe_thres_hdr; 1850 bool is_ap; 1851 1852 is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) || 1853 iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO); 1854 1855 mcs_nss_size = 1856 ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 1857 &eht_cap->eht_cap_elem, 1858 is_ap); 1859 1860 ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]); 1861 ppe_thresh_size = 1862 ieee80211_eht_ppe_size(ppe_thres_hdr, 1863 eht_cap->eht_cap_elem.phy_cap_info); 1864 1865 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC, 1866 sizeof(eht_cap->eht_cap_elem.mac_cap_info), 1867 eht_cap->eht_cap_elem.mac_cap_info) || 1868 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY, 1869 sizeof(eht_cap->eht_cap_elem.phy_cap_info), 1870 eht_cap->eht_cap_elem.phy_cap_info) || 1871 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET, 1872 mcs_nss_size, &eht_cap->eht_mcs_nss_supp) || 1873 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE, 1874 ppe_thresh_size, eht_cap->eht_ppe_thres)) 1875 return -ENOBUFS; 1876 } 1877 1878 if (sband->band == NL80211_BAND_6GHZ && 1879 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA, 1880 sizeof(iftdata->he_6ghz_capa), 1881 &iftdata->he_6ghz_capa)) 1882 return -ENOBUFS; 1883 1884 if (iftdata->vendor_elems.data && iftdata->vendor_elems.len && 1885 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS, 1886 iftdata->vendor_elems.len, iftdata->vendor_elems.data)) 1887 return -ENOBUFS; 1888 1889 return 0; 1890 } 1891 1892 static int nl80211_send_band_rateinfo(struct sk_buff *msg, 1893 struct ieee80211_supported_band *sband, 1894 bool large) 1895 { 1896 struct nlattr *nl_rates, *nl_rate; 1897 struct ieee80211_rate *rate; 1898 int i; 1899 1900 /* add HT info */ 1901 if (sband->ht_cap.ht_supported && 1902 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET, 1903 sizeof(sband->ht_cap.mcs), 1904 &sband->ht_cap.mcs) || 1905 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA, 1906 sband->ht_cap.cap) || 1907 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR, 1908 sband->ht_cap.ampdu_factor) || 1909 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY, 1910 sband->ht_cap.ampdu_density))) 1911 return -ENOBUFS; 1912 1913 /* add VHT info */ 1914 if (sband->vht_cap.vht_supported && 1915 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET, 1916 sizeof(sband->vht_cap.vht_mcs), 1917 &sband->vht_cap.vht_mcs) || 1918 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA, 1919 sband->vht_cap.cap))) 1920 return -ENOBUFS; 1921 1922 if (large && sband->n_iftype_data) { 1923 struct nlattr *nl_iftype_data = 1924 nla_nest_start_noflag(msg, 1925 NL80211_BAND_ATTR_IFTYPE_DATA); 1926 const struct ieee80211_sband_iftype_data *iftd; 1927 int err; 1928 1929 if (!nl_iftype_data) 1930 return -ENOBUFS; 1931 1932 for_each_sband_iftype_data(sband, i, iftd) { 1933 struct nlattr *iftdata; 1934 1935 iftdata = nla_nest_start_noflag(msg, i + 1); 1936 if (!iftdata) 1937 return -ENOBUFS; 1938 1939 err = nl80211_send_iftype_data(msg, sband, iftd); 1940 if (err) 1941 return err; 1942 1943 nla_nest_end(msg, iftdata); 1944 } 1945 1946 nla_nest_end(msg, nl_iftype_data); 1947 } 1948 1949 /* add EDMG info */ 1950 if (large && sband->edmg_cap.channels && 1951 (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS, 1952 sband->edmg_cap.channels) || 1953 nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG, 1954 sband->edmg_cap.bw_config))) 1955 1956 return -ENOBUFS; 1957 1958 /* add bitrates */ 1959 nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES); 1960 if (!nl_rates) 1961 return -ENOBUFS; 1962 1963 for (i = 0; i < sband->n_bitrates; i++) { 1964 nl_rate = nla_nest_start_noflag(msg, i); 1965 if (!nl_rate) 1966 return -ENOBUFS; 1967 1968 rate = &sband->bitrates[i]; 1969 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE, 1970 rate->bitrate)) 1971 return -ENOBUFS; 1972 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) && 1973 nla_put_flag(msg, 1974 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE)) 1975 return -ENOBUFS; 1976 1977 nla_nest_end(msg, nl_rate); 1978 } 1979 1980 nla_nest_end(msg, nl_rates); 1981 1982 /* S1G capabilities */ 1983 if (sband->band == NL80211_BAND_S1GHZ && sband->s1g_cap.s1g && 1984 (nla_put(msg, NL80211_BAND_ATTR_S1G_CAPA, 1985 sizeof(sband->s1g_cap.cap), 1986 sband->s1g_cap.cap) || 1987 nla_put(msg, NL80211_BAND_ATTR_S1G_MCS_NSS_SET, 1988 sizeof(sband->s1g_cap.nss_mcs), 1989 sband->s1g_cap.nss_mcs))) 1990 return -ENOBUFS; 1991 1992 return 0; 1993 } 1994 1995 static int 1996 nl80211_send_mgmt_stypes(struct sk_buff *msg, 1997 const struct ieee80211_txrx_stypes *mgmt_stypes) 1998 { 1999 u16 stypes; 2000 struct nlattr *nl_ftypes, *nl_ifs; 2001 enum nl80211_iftype ift; 2002 int i; 2003 2004 if (!mgmt_stypes) 2005 return 0; 2006 2007 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES); 2008 if (!nl_ifs) 2009 return -ENOBUFS; 2010 2011 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2012 nl_ftypes = nla_nest_start_noflag(msg, ift); 2013 if (!nl_ftypes) 2014 return -ENOBUFS; 2015 i = 0; 2016 stypes = mgmt_stypes[ift].tx; 2017 while (stypes) { 2018 if ((stypes & 1) && 2019 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2020 (i << 4) | IEEE80211_FTYPE_MGMT)) 2021 return -ENOBUFS; 2022 stypes >>= 1; 2023 i++; 2024 } 2025 nla_nest_end(msg, nl_ftypes); 2026 } 2027 2028 nla_nest_end(msg, nl_ifs); 2029 2030 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES); 2031 if (!nl_ifs) 2032 return -ENOBUFS; 2033 2034 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2035 nl_ftypes = nla_nest_start_noflag(msg, ift); 2036 if (!nl_ftypes) 2037 return -ENOBUFS; 2038 i = 0; 2039 stypes = mgmt_stypes[ift].rx; 2040 while (stypes) { 2041 if ((stypes & 1) && 2042 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2043 (i << 4) | IEEE80211_FTYPE_MGMT)) 2044 return -ENOBUFS; 2045 stypes >>= 1; 2046 i++; 2047 } 2048 nla_nest_end(msg, nl_ftypes); 2049 } 2050 nla_nest_end(msg, nl_ifs); 2051 2052 return 0; 2053 } 2054 2055 #define CMD(op, n) \ 2056 do { \ 2057 if (rdev->ops->op) { \ 2058 i++; \ 2059 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \ 2060 goto nla_put_failure; \ 2061 } \ 2062 } while (0) 2063 2064 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev, 2065 struct sk_buff *msg) 2066 { 2067 int i = 0; 2068 2069 /* 2070 * do *NOT* add anything into this function, new things need to be 2071 * advertised only to new versions of userspace that can deal with 2072 * the split (and they can't possibly care about new features... 2073 */ 2074 CMD(add_virtual_intf, NEW_INTERFACE); 2075 CMD(change_virtual_intf, SET_INTERFACE); 2076 CMD(add_key, NEW_KEY); 2077 CMD(start_ap, START_AP); 2078 CMD(add_station, NEW_STATION); 2079 CMD(add_mpath, NEW_MPATH); 2080 CMD(update_mesh_config, SET_MESH_CONFIG); 2081 CMD(change_bss, SET_BSS); 2082 CMD(auth, AUTHENTICATE); 2083 CMD(assoc, ASSOCIATE); 2084 CMD(deauth, DEAUTHENTICATE); 2085 CMD(disassoc, DISASSOCIATE); 2086 CMD(join_ibss, JOIN_IBSS); 2087 CMD(join_mesh, JOIN_MESH); 2088 CMD(set_pmksa, SET_PMKSA); 2089 CMD(del_pmksa, DEL_PMKSA); 2090 CMD(flush_pmksa, FLUSH_PMKSA); 2091 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) 2092 CMD(remain_on_channel, REMAIN_ON_CHANNEL); 2093 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK); 2094 CMD(mgmt_tx, FRAME); 2095 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL); 2096 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) { 2097 i++; 2098 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS)) 2099 goto nla_put_failure; 2100 } 2101 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap || 2102 rdev->ops->join_mesh) { 2103 i++; 2104 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL)) 2105 goto nla_put_failure; 2106 } 2107 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) { 2108 CMD(tdls_mgmt, TDLS_MGMT); 2109 CMD(tdls_oper, TDLS_OPER); 2110 } 2111 if (rdev->wiphy.max_sched_scan_reqs) 2112 CMD(sched_scan_start, START_SCHED_SCAN); 2113 CMD(probe_client, PROBE_CLIENT); 2114 CMD(set_noack_map, SET_NOACK_MAP); 2115 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) { 2116 i++; 2117 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS)) 2118 goto nla_put_failure; 2119 } 2120 CMD(start_p2p_device, START_P2P_DEVICE); 2121 CMD(set_mcast_rate, SET_MCAST_RATE); 2122 #ifdef CONFIG_NL80211_TESTMODE 2123 CMD(testmode_cmd, TESTMODE); 2124 #endif 2125 2126 if (rdev->ops->connect || rdev->ops->auth) { 2127 i++; 2128 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT)) 2129 goto nla_put_failure; 2130 } 2131 2132 if (rdev->ops->disconnect || rdev->ops->deauth) { 2133 i++; 2134 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT)) 2135 goto nla_put_failure; 2136 } 2137 2138 return i; 2139 nla_put_failure: 2140 return -ENOBUFS; 2141 } 2142 2143 static int 2144 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap, 2145 struct sk_buff *msg) 2146 { 2147 struct nlattr *ftm; 2148 2149 if (!cap->ftm.supported) 2150 return 0; 2151 2152 ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM); 2153 if (!ftm) 2154 return -ENOBUFS; 2155 2156 if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP)) 2157 return -ENOBUFS; 2158 if (cap->ftm.non_asap && 2159 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP)) 2160 return -ENOBUFS; 2161 if (cap->ftm.request_lci && 2162 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI)) 2163 return -ENOBUFS; 2164 if (cap->ftm.request_civicloc && 2165 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC)) 2166 return -ENOBUFS; 2167 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES, 2168 cap->ftm.preambles)) 2169 return -ENOBUFS; 2170 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS, 2171 cap->ftm.bandwidths)) 2172 return -ENOBUFS; 2173 if (cap->ftm.max_bursts_exponent >= 0 && 2174 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT, 2175 cap->ftm.max_bursts_exponent)) 2176 return -ENOBUFS; 2177 if (cap->ftm.max_ftms_per_burst && 2178 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST, 2179 cap->ftm.max_ftms_per_burst)) 2180 return -ENOBUFS; 2181 if (cap->ftm.trigger_based && 2182 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED)) 2183 return -ENOBUFS; 2184 if (cap->ftm.non_trigger_based && 2185 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED)) 2186 return -ENOBUFS; 2187 2188 nla_nest_end(msg, ftm); 2189 return 0; 2190 } 2191 2192 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev, 2193 struct sk_buff *msg) 2194 { 2195 const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa; 2196 struct nlattr *pmsr, *caps; 2197 2198 if (!cap) 2199 return 0; 2200 2201 /* 2202 * we don't need to clean up anything here since the caller 2203 * will genlmsg_cancel() if we fail 2204 */ 2205 2206 pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS); 2207 if (!pmsr) 2208 return -ENOBUFS; 2209 2210 if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers)) 2211 return -ENOBUFS; 2212 2213 if (cap->report_ap_tsf && 2214 nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF)) 2215 return -ENOBUFS; 2216 2217 if (cap->randomize_mac_addr && 2218 nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR)) 2219 return -ENOBUFS; 2220 2221 caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA); 2222 if (!caps) 2223 return -ENOBUFS; 2224 2225 if (nl80211_send_pmsr_ftm_capa(cap, msg)) 2226 return -ENOBUFS; 2227 2228 nla_nest_end(msg, caps); 2229 nla_nest_end(msg, pmsr); 2230 2231 return 0; 2232 } 2233 2234 static int 2235 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev, 2236 struct sk_buff *msg) 2237 { 2238 int i; 2239 struct nlattr *nested, *nested_akms; 2240 const struct wiphy_iftype_akm_suites *iftype_akms; 2241 2242 if (!rdev->wiphy.num_iftype_akm_suites || 2243 !rdev->wiphy.iftype_akm_suites) 2244 return 0; 2245 2246 nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES); 2247 if (!nested) 2248 return -ENOBUFS; 2249 2250 for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) { 2251 nested_akms = nla_nest_start(msg, i + 1); 2252 if (!nested_akms) 2253 return -ENOBUFS; 2254 2255 iftype_akms = &rdev->wiphy.iftype_akm_suites[i]; 2256 2257 if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES, 2258 iftype_akms->iftypes_mask)) 2259 return -ENOBUFS; 2260 2261 if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES, 2262 sizeof(u32) * iftype_akms->n_akm_suites, 2263 iftype_akms->akm_suites)) { 2264 return -ENOBUFS; 2265 } 2266 nla_nest_end(msg, nested_akms); 2267 } 2268 2269 nla_nest_end(msg, nested); 2270 2271 return 0; 2272 } 2273 2274 static int 2275 nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev, 2276 struct sk_buff *msg) 2277 { 2278 struct nlattr *supp; 2279 2280 if (!rdev->wiphy.tid_config_support.vif && 2281 !rdev->wiphy.tid_config_support.peer) 2282 return 0; 2283 2284 supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG); 2285 if (!supp) 2286 return -ENOSPC; 2287 2288 if (rdev->wiphy.tid_config_support.vif && 2289 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP, 2290 rdev->wiphy.tid_config_support.vif, 2291 NL80211_TID_CONFIG_ATTR_PAD)) 2292 goto fail; 2293 2294 if (rdev->wiphy.tid_config_support.peer && 2295 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP, 2296 rdev->wiphy.tid_config_support.peer, 2297 NL80211_TID_CONFIG_ATTR_PAD)) 2298 goto fail; 2299 2300 /* for now we just use the same value ... makes more sense */ 2301 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT, 2302 rdev->wiphy.tid_config_support.max_retry)) 2303 goto fail; 2304 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG, 2305 rdev->wiphy.tid_config_support.max_retry)) 2306 goto fail; 2307 2308 nla_nest_end(msg, supp); 2309 2310 return 0; 2311 fail: 2312 nla_nest_cancel(msg, supp); 2313 return -ENOBUFS; 2314 } 2315 2316 static int 2317 nl80211_put_sar_specs(struct cfg80211_registered_device *rdev, 2318 struct sk_buff *msg) 2319 { 2320 struct nlattr *sar_capa, *specs, *sub_freq_range; 2321 u8 num_freq_ranges; 2322 int i; 2323 2324 if (!rdev->wiphy.sar_capa) 2325 return 0; 2326 2327 num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges; 2328 2329 sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC); 2330 if (!sar_capa) 2331 return -ENOSPC; 2332 2333 if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type)) 2334 goto fail; 2335 2336 specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS); 2337 if (!specs) 2338 goto fail; 2339 2340 /* report supported freq_ranges */ 2341 for (i = 0; i < num_freq_ranges; i++) { 2342 sub_freq_range = nla_nest_start(msg, i + 1); 2343 if (!sub_freq_range) 2344 goto fail; 2345 2346 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ, 2347 rdev->wiphy.sar_capa->freq_ranges[i].start_freq)) 2348 goto fail; 2349 2350 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ, 2351 rdev->wiphy.sar_capa->freq_ranges[i].end_freq)) 2352 goto fail; 2353 2354 nla_nest_end(msg, sub_freq_range); 2355 } 2356 2357 nla_nest_end(msg, specs); 2358 nla_nest_end(msg, sar_capa); 2359 2360 return 0; 2361 fail: 2362 nla_nest_cancel(msg, sar_capa); 2363 return -ENOBUFS; 2364 } 2365 2366 static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg) 2367 { 2368 struct nlattr *config; 2369 2370 if (!wiphy->mbssid_max_interfaces) 2371 return 0; 2372 2373 config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG); 2374 if (!config) 2375 return -ENOBUFS; 2376 2377 if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES, 2378 wiphy->mbssid_max_interfaces)) 2379 goto fail; 2380 2381 if (wiphy->ema_max_profile_periodicity && 2382 nla_put_u8(msg, 2383 NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY, 2384 wiphy->ema_max_profile_periodicity)) 2385 goto fail; 2386 2387 nla_nest_end(msg, config); 2388 return 0; 2389 2390 fail: 2391 nla_nest_cancel(msg, config); 2392 return -ENOBUFS; 2393 } 2394 2395 struct nl80211_dump_wiphy_state { 2396 s64 filter_wiphy; 2397 long start; 2398 long split_start, band_start, chan_start, capa_start; 2399 bool split; 2400 }; 2401 2402 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev, 2403 enum nl80211_commands cmd, 2404 struct sk_buff *msg, u32 portid, u32 seq, 2405 int flags, struct nl80211_dump_wiphy_state *state) 2406 { 2407 void *hdr; 2408 struct nlattr *nl_bands, *nl_band; 2409 struct nlattr *nl_freqs, *nl_freq; 2410 struct nlattr *nl_cmds; 2411 enum nl80211_band band; 2412 struct ieee80211_channel *chan; 2413 int i; 2414 const struct ieee80211_txrx_stypes *mgmt_stypes = 2415 rdev->wiphy.mgmt_stypes; 2416 u32 features; 2417 2418 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 2419 if (!hdr) 2420 return -ENOBUFS; 2421 2422 if (WARN_ON(!state)) 2423 return -EINVAL; 2424 2425 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 2426 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, 2427 wiphy_name(&rdev->wiphy)) || 2428 nla_put_u32(msg, NL80211_ATTR_GENERATION, 2429 cfg80211_rdev_list_generation)) 2430 goto nla_put_failure; 2431 2432 if (cmd != NL80211_CMD_NEW_WIPHY) 2433 goto finish; 2434 2435 switch (state->split_start) { 2436 case 0: 2437 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT, 2438 rdev->wiphy.retry_short) || 2439 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG, 2440 rdev->wiphy.retry_long) || 2441 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD, 2442 rdev->wiphy.frag_threshold) || 2443 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD, 2444 rdev->wiphy.rts_threshold) || 2445 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS, 2446 rdev->wiphy.coverage_class) || 2447 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS, 2448 rdev->wiphy.max_scan_ssids) || 2449 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS, 2450 rdev->wiphy.max_sched_scan_ssids) || 2451 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN, 2452 rdev->wiphy.max_scan_ie_len) || 2453 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN, 2454 rdev->wiphy.max_sched_scan_ie_len) || 2455 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS, 2456 rdev->wiphy.max_match_sets)) 2457 goto nla_put_failure; 2458 2459 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) && 2460 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN)) 2461 goto nla_put_failure; 2462 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) && 2463 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH)) 2464 goto nla_put_failure; 2465 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) && 2466 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD)) 2467 goto nla_put_failure; 2468 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) && 2469 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT)) 2470 goto nla_put_failure; 2471 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) && 2472 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT)) 2473 goto nla_put_failure; 2474 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) && 2475 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP)) 2476 goto nla_put_failure; 2477 state->split_start++; 2478 if (state->split) 2479 break; 2480 fallthrough; 2481 case 1: 2482 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES, 2483 sizeof(u32) * rdev->wiphy.n_cipher_suites, 2484 rdev->wiphy.cipher_suites)) 2485 goto nla_put_failure; 2486 2487 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS, 2488 rdev->wiphy.max_num_pmkids)) 2489 goto nla_put_failure; 2490 2491 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 2492 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE)) 2493 goto nla_put_failure; 2494 2495 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX, 2496 rdev->wiphy.available_antennas_tx) || 2497 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX, 2498 rdev->wiphy.available_antennas_rx)) 2499 goto nla_put_failure; 2500 2501 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) && 2502 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD, 2503 rdev->wiphy.probe_resp_offload)) 2504 goto nla_put_failure; 2505 2506 if ((rdev->wiphy.available_antennas_tx || 2507 rdev->wiphy.available_antennas_rx) && 2508 rdev->ops->get_antenna) { 2509 u32 tx_ant = 0, rx_ant = 0; 2510 int res; 2511 2512 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant); 2513 if (!res) { 2514 if (nla_put_u32(msg, 2515 NL80211_ATTR_WIPHY_ANTENNA_TX, 2516 tx_ant) || 2517 nla_put_u32(msg, 2518 NL80211_ATTR_WIPHY_ANTENNA_RX, 2519 rx_ant)) 2520 goto nla_put_failure; 2521 } 2522 } 2523 2524 state->split_start++; 2525 if (state->split) 2526 break; 2527 fallthrough; 2528 case 2: 2529 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES, 2530 rdev->wiphy.interface_modes)) 2531 goto nla_put_failure; 2532 state->split_start++; 2533 if (state->split) 2534 break; 2535 fallthrough; 2536 case 3: 2537 nl_bands = nla_nest_start_noflag(msg, 2538 NL80211_ATTR_WIPHY_BANDS); 2539 if (!nl_bands) 2540 goto nla_put_failure; 2541 2542 for (band = state->band_start; 2543 band < (state->split ? 2544 NUM_NL80211_BANDS : 2545 NL80211_BAND_60GHZ + 1); 2546 band++) { 2547 struct ieee80211_supported_band *sband; 2548 2549 /* omit higher bands for ancient software */ 2550 if (band > NL80211_BAND_5GHZ && !state->split) 2551 break; 2552 2553 sband = rdev->wiphy.bands[band]; 2554 2555 if (!sband) 2556 continue; 2557 2558 nl_band = nla_nest_start_noflag(msg, band); 2559 if (!nl_band) 2560 goto nla_put_failure; 2561 2562 switch (state->chan_start) { 2563 case 0: 2564 if (nl80211_send_band_rateinfo(msg, sband, 2565 state->split)) 2566 goto nla_put_failure; 2567 state->chan_start++; 2568 if (state->split) 2569 break; 2570 fallthrough; 2571 default: 2572 /* add frequencies */ 2573 nl_freqs = nla_nest_start_noflag(msg, 2574 NL80211_BAND_ATTR_FREQS); 2575 if (!nl_freqs) 2576 goto nla_put_failure; 2577 2578 for (i = state->chan_start - 1; 2579 i < sband->n_channels; 2580 i++) { 2581 nl_freq = nla_nest_start_noflag(msg, 2582 i); 2583 if (!nl_freq) 2584 goto nla_put_failure; 2585 2586 chan = &sband->channels[i]; 2587 2588 if (nl80211_msg_put_channel( 2589 msg, &rdev->wiphy, chan, 2590 state->split)) 2591 goto nla_put_failure; 2592 2593 nla_nest_end(msg, nl_freq); 2594 if (state->split) 2595 break; 2596 } 2597 if (i < sband->n_channels) 2598 state->chan_start = i + 2; 2599 else 2600 state->chan_start = 0; 2601 nla_nest_end(msg, nl_freqs); 2602 } 2603 2604 nla_nest_end(msg, nl_band); 2605 2606 if (state->split) { 2607 /* start again here */ 2608 if (state->chan_start) 2609 band--; 2610 break; 2611 } 2612 } 2613 nla_nest_end(msg, nl_bands); 2614 2615 if (band < NUM_NL80211_BANDS) 2616 state->band_start = band + 1; 2617 else 2618 state->band_start = 0; 2619 2620 /* if bands & channels are done, continue outside */ 2621 if (state->band_start == 0 && state->chan_start == 0) 2622 state->split_start++; 2623 if (state->split) 2624 break; 2625 fallthrough; 2626 case 4: 2627 nl_cmds = nla_nest_start_noflag(msg, 2628 NL80211_ATTR_SUPPORTED_COMMANDS); 2629 if (!nl_cmds) 2630 goto nla_put_failure; 2631 2632 i = nl80211_add_commands_unsplit(rdev, msg); 2633 if (i < 0) 2634 goto nla_put_failure; 2635 if (state->split) { 2636 CMD(crit_proto_start, CRIT_PROTOCOL_START); 2637 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP); 2638 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH) 2639 CMD(channel_switch, CHANNEL_SWITCH); 2640 CMD(set_qos_map, SET_QOS_MAP); 2641 if (rdev->wiphy.features & 2642 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION) 2643 CMD(add_tx_ts, ADD_TX_TS); 2644 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST); 2645 CMD(update_connect_params, UPDATE_CONNECT_PARAMS); 2646 CMD(update_ft_ies, UPDATE_FT_IES); 2647 if (rdev->wiphy.sar_capa) 2648 CMD(set_sar_specs, SET_SAR_SPECS); 2649 } 2650 #undef CMD 2651 2652 nla_nest_end(msg, nl_cmds); 2653 state->split_start++; 2654 if (state->split) 2655 break; 2656 fallthrough; 2657 case 5: 2658 if (rdev->ops->remain_on_channel && 2659 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) && 2660 nla_put_u32(msg, 2661 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION, 2662 rdev->wiphy.max_remain_on_channel_duration)) 2663 goto nla_put_failure; 2664 2665 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) && 2666 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK)) 2667 goto nla_put_failure; 2668 2669 state->split_start++; 2670 if (state->split) 2671 break; 2672 fallthrough; 2673 case 6: 2674 #ifdef CONFIG_PM 2675 if (nl80211_send_wowlan(msg, rdev, state->split)) 2676 goto nla_put_failure; 2677 state->split_start++; 2678 if (state->split) 2679 break; 2680 #else 2681 state->split_start++; 2682 #endif 2683 fallthrough; 2684 case 7: 2685 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES, 2686 rdev->wiphy.software_iftypes)) 2687 goto nla_put_failure; 2688 2689 if (nl80211_put_iface_combinations(&rdev->wiphy, msg, 2690 state->split)) 2691 goto nla_put_failure; 2692 2693 state->split_start++; 2694 if (state->split) 2695 break; 2696 fallthrough; 2697 case 8: 2698 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) && 2699 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME, 2700 rdev->wiphy.ap_sme_capa)) 2701 goto nla_put_failure; 2702 2703 features = rdev->wiphy.features; 2704 /* 2705 * We can only add the per-channel limit information if the 2706 * dump is split, otherwise it makes it too big. Therefore 2707 * only advertise it in that case. 2708 */ 2709 if (state->split) 2710 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS; 2711 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features)) 2712 goto nla_put_failure; 2713 2714 if (rdev->wiphy.ht_capa_mod_mask && 2715 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK, 2716 sizeof(*rdev->wiphy.ht_capa_mod_mask), 2717 rdev->wiphy.ht_capa_mod_mask)) 2718 goto nla_put_failure; 2719 2720 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME && 2721 rdev->wiphy.max_acl_mac_addrs && 2722 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX, 2723 rdev->wiphy.max_acl_mac_addrs)) 2724 goto nla_put_failure; 2725 2726 /* 2727 * Any information below this point is only available to 2728 * applications that can deal with it being split. This 2729 * helps ensure that newly added capabilities don't break 2730 * older tools by overrunning their buffers. 2731 * 2732 * We still increment split_start so that in the split 2733 * case we'll continue with more data in the next round, 2734 * but break unconditionally so unsplit data stops here. 2735 */ 2736 if (state->split) 2737 state->split_start++; 2738 else 2739 state->split_start = 0; 2740 break; 2741 case 9: 2742 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes)) 2743 goto nla_put_failure; 2744 2745 if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS, 2746 rdev->wiphy.max_sched_scan_plans) || 2747 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL, 2748 rdev->wiphy.max_sched_scan_plan_interval) || 2749 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS, 2750 rdev->wiphy.max_sched_scan_plan_iterations)) 2751 goto nla_put_failure; 2752 2753 if (rdev->wiphy.extended_capabilities && 2754 (nla_put(msg, NL80211_ATTR_EXT_CAPA, 2755 rdev->wiphy.extended_capabilities_len, 2756 rdev->wiphy.extended_capabilities) || 2757 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2758 rdev->wiphy.extended_capabilities_len, 2759 rdev->wiphy.extended_capabilities_mask))) 2760 goto nla_put_failure; 2761 2762 if (rdev->wiphy.vht_capa_mod_mask && 2763 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK, 2764 sizeof(*rdev->wiphy.vht_capa_mod_mask), 2765 rdev->wiphy.vht_capa_mod_mask)) 2766 goto nla_put_failure; 2767 2768 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 2769 rdev->wiphy.perm_addr)) 2770 goto nla_put_failure; 2771 2772 if (!is_zero_ether_addr(rdev->wiphy.addr_mask) && 2773 nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN, 2774 rdev->wiphy.addr_mask)) 2775 goto nla_put_failure; 2776 2777 if (rdev->wiphy.n_addresses > 1) { 2778 void *attr; 2779 2780 attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS); 2781 if (!attr) 2782 goto nla_put_failure; 2783 2784 for (i = 0; i < rdev->wiphy.n_addresses; i++) 2785 if (nla_put(msg, i + 1, ETH_ALEN, 2786 rdev->wiphy.addresses[i].addr)) 2787 goto nla_put_failure; 2788 2789 nla_nest_end(msg, attr); 2790 } 2791 2792 state->split_start++; 2793 break; 2794 case 10: 2795 if (nl80211_send_coalesce(msg, rdev)) 2796 goto nla_put_failure; 2797 2798 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) && 2799 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) || 2800 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ))) 2801 goto nla_put_failure; 2802 2803 if (rdev->wiphy.max_ap_assoc_sta && 2804 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA, 2805 rdev->wiphy.max_ap_assoc_sta)) 2806 goto nla_put_failure; 2807 2808 state->split_start++; 2809 break; 2810 case 11: 2811 if (rdev->wiphy.n_vendor_commands) { 2812 const struct nl80211_vendor_cmd_info *info; 2813 struct nlattr *nested; 2814 2815 nested = nla_nest_start_noflag(msg, 2816 NL80211_ATTR_VENDOR_DATA); 2817 if (!nested) 2818 goto nla_put_failure; 2819 2820 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 2821 info = &rdev->wiphy.vendor_commands[i].info; 2822 if (nla_put(msg, i + 1, sizeof(*info), info)) 2823 goto nla_put_failure; 2824 } 2825 nla_nest_end(msg, nested); 2826 } 2827 2828 if (rdev->wiphy.n_vendor_events) { 2829 const struct nl80211_vendor_cmd_info *info; 2830 struct nlattr *nested; 2831 2832 nested = nla_nest_start_noflag(msg, 2833 NL80211_ATTR_VENDOR_EVENTS); 2834 if (!nested) 2835 goto nla_put_failure; 2836 2837 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) { 2838 info = &rdev->wiphy.vendor_events[i]; 2839 if (nla_put(msg, i + 1, sizeof(*info), info)) 2840 goto nla_put_failure; 2841 } 2842 nla_nest_end(msg, nested); 2843 } 2844 state->split_start++; 2845 break; 2846 case 12: 2847 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH && 2848 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS, 2849 rdev->wiphy.max_num_csa_counters)) 2850 goto nla_put_failure; 2851 2852 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 2853 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 2854 goto nla_put_failure; 2855 2856 if (rdev->wiphy.max_sched_scan_reqs && 2857 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS, 2858 rdev->wiphy.max_sched_scan_reqs)) 2859 goto nla_put_failure; 2860 2861 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES, 2862 sizeof(rdev->wiphy.ext_features), 2863 rdev->wiphy.ext_features)) 2864 goto nla_put_failure; 2865 2866 if (rdev->wiphy.bss_select_support) { 2867 struct nlattr *nested; 2868 u32 bss_select_support = rdev->wiphy.bss_select_support; 2869 2870 nested = nla_nest_start_noflag(msg, 2871 NL80211_ATTR_BSS_SELECT); 2872 if (!nested) 2873 goto nla_put_failure; 2874 2875 i = 0; 2876 while (bss_select_support) { 2877 if ((bss_select_support & 1) && 2878 nla_put_flag(msg, i)) 2879 goto nla_put_failure; 2880 i++; 2881 bss_select_support >>= 1; 2882 } 2883 nla_nest_end(msg, nested); 2884 } 2885 2886 state->split_start++; 2887 break; 2888 case 13: 2889 if (rdev->wiphy.num_iftype_ext_capab && 2890 rdev->wiphy.iftype_ext_capab) { 2891 struct nlattr *nested_ext_capab, *nested; 2892 2893 nested = nla_nest_start_noflag(msg, 2894 NL80211_ATTR_IFTYPE_EXT_CAPA); 2895 if (!nested) 2896 goto nla_put_failure; 2897 2898 for (i = state->capa_start; 2899 i < rdev->wiphy.num_iftype_ext_capab; i++) { 2900 const struct wiphy_iftype_ext_capab *capab; 2901 2902 capab = &rdev->wiphy.iftype_ext_capab[i]; 2903 2904 nested_ext_capab = nla_nest_start_noflag(msg, 2905 i); 2906 if (!nested_ext_capab || 2907 nla_put_u32(msg, NL80211_ATTR_IFTYPE, 2908 capab->iftype) || 2909 nla_put(msg, NL80211_ATTR_EXT_CAPA, 2910 capab->extended_capabilities_len, 2911 capab->extended_capabilities) || 2912 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2913 capab->extended_capabilities_len, 2914 capab->extended_capabilities_mask)) 2915 goto nla_put_failure; 2916 2917 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO && 2918 (nla_put_u16(msg, 2919 NL80211_ATTR_EML_CAPABILITY, 2920 capab->eml_capabilities) || 2921 nla_put_u16(msg, 2922 NL80211_ATTR_MLD_CAPA_AND_OPS, 2923 capab->mld_capa_and_ops))) 2924 goto nla_put_failure; 2925 2926 nla_nest_end(msg, nested_ext_capab); 2927 if (state->split) 2928 break; 2929 } 2930 nla_nest_end(msg, nested); 2931 if (i < rdev->wiphy.num_iftype_ext_capab) { 2932 state->capa_start = i + 1; 2933 break; 2934 } 2935 } 2936 2937 if (nla_put_u32(msg, NL80211_ATTR_BANDS, 2938 rdev->wiphy.nan_supported_bands)) 2939 goto nla_put_failure; 2940 2941 if (wiphy_ext_feature_isset(&rdev->wiphy, 2942 NL80211_EXT_FEATURE_TXQS)) { 2943 struct cfg80211_txq_stats txqstats = {}; 2944 int res; 2945 2946 res = rdev_get_txq_stats(rdev, NULL, &txqstats); 2947 if (!res && 2948 !nl80211_put_txq_stats(msg, &txqstats, 2949 NL80211_ATTR_TXQ_STATS)) 2950 goto nla_put_failure; 2951 2952 if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT, 2953 rdev->wiphy.txq_limit)) 2954 goto nla_put_failure; 2955 if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT, 2956 rdev->wiphy.txq_memory_limit)) 2957 goto nla_put_failure; 2958 if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM, 2959 rdev->wiphy.txq_quantum)) 2960 goto nla_put_failure; 2961 } 2962 2963 state->split_start++; 2964 break; 2965 case 14: 2966 if (nl80211_send_pmsr_capa(rdev, msg)) 2967 goto nla_put_failure; 2968 2969 state->split_start++; 2970 break; 2971 case 15: 2972 if (rdev->wiphy.akm_suites && 2973 nla_put(msg, NL80211_ATTR_AKM_SUITES, 2974 sizeof(u32) * rdev->wiphy.n_akm_suites, 2975 rdev->wiphy.akm_suites)) 2976 goto nla_put_failure; 2977 2978 if (nl80211_put_iftype_akm_suites(rdev, msg)) 2979 goto nla_put_failure; 2980 2981 if (nl80211_put_tid_config_support(rdev, msg)) 2982 goto nla_put_failure; 2983 state->split_start++; 2984 break; 2985 case 16: 2986 if (nl80211_put_sar_specs(rdev, msg)) 2987 goto nla_put_failure; 2988 2989 if (nl80211_put_mbssid_support(&rdev->wiphy, msg)) 2990 goto nla_put_failure; 2991 2992 if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES, 2993 rdev->wiphy.max_num_akm_suites)) 2994 goto nla_put_failure; 2995 2996 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO) 2997 nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT); 2998 2999 if (rdev->wiphy.hw_timestamp_max_peers && 3000 nla_put_u16(msg, NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS, 3001 rdev->wiphy.hw_timestamp_max_peers)) 3002 goto nla_put_failure; 3003 3004 /* done */ 3005 state->split_start = 0; 3006 break; 3007 } 3008 finish: 3009 genlmsg_end(msg, hdr); 3010 return 0; 3011 3012 nla_put_failure: 3013 genlmsg_cancel(msg, hdr); 3014 return -EMSGSIZE; 3015 } 3016 3017 static int nl80211_dump_wiphy_parse(struct sk_buff *skb, 3018 struct netlink_callback *cb, 3019 struct nl80211_dump_wiphy_state *state) 3020 { 3021 struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 3022 int ret; 3023 3024 if (!tb) 3025 return -ENOMEM; 3026 3027 ret = nlmsg_parse_deprecated(cb->nlh, 3028 GENL_HDRLEN + nl80211_fam.hdrsize, 3029 tb, nl80211_fam.maxattr, 3030 nl80211_policy, NULL); 3031 /* ignore parse errors for backward compatibility */ 3032 if (ret) { 3033 ret = 0; 3034 goto out; 3035 } 3036 3037 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP]; 3038 if (tb[NL80211_ATTR_WIPHY]) 3039 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]); 3040 if (tb[NL80211_ATTR_WDEV]) 3041 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32; 3042 if (tb[NL80211_ATTR_IFINDEX]) { 3043 struct net_device *netdev; 3044 struct cfg80211_registered_device *rdev; 3045 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]); 3046 3047 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx); 3048 if (!netdev) { 3049 ret = -ENODEV; 3050 goto out; 3051 } 3052 if (netdev->ieee80211_ptr) { 3053 rdev = wiphy_to_rdev( 3054 netdev->ieee80211_ptr->wiphy); 3055 state->filter_wiphy = rdev->wiphy_idx; 3056 } 3057 } 3058 3059 ret = 0; 3060 out: 3061 kfree(tb); 3062 return ret; 3063 } 3064 3065 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb) 3066 { 3067 int idx = 0, ret; 3068 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0]; 3069 struct cfg80211_registered_device *rdev; 3070 3071 rtnl_lock(); 3072 if (!state) { 3073 state = kzalloc(sizeof(*state), GFP_KERNEL); 3074 if (!state) { 3075 rtnl_unlock(); 3076 return -ENOMEM; 3077 } 3078 state->filter_wiphy = -1; 3079 ret = nl80211_dump_wiphy_parse(skb, cb, state); 3080 if (ret) { 3081 kfree(state); 3082 rtnl_unlock(); 3083 return ret; 3084 } 3085 cb->args[0] = (long)state; 3086 } 3087 3088 for_each_rdev(rdev) { 3089 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 3090 continue; 3091 if (++idx <= state->start) 3092 continue; 3093 if (state->filter_wiphy != -1 && 3094 state->filter_wiphy != rdev->wiphy_idx) 3095 continue; 3096 wiphy_lock(&rdev->wiphy); 3097 /* attempt to fit multiple wiphy data chunks into the skb */ 3098 do { 3099 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, 3100 skb, 3101 NETLINK_CB(cb->skb).portid, 3102 cb->nlh->nlmsg_seq, 3103 NLM_F_MULTI, state); 3104 if (ret < 0) { 3105 /* 3106 * If sending the wiphy data didn't fit (ENOBUFS 3107 * or EMSGSIZE returned), this SKB is still 3108 * empty (so it's not too big because another 3109 * wiphy dataset is already in the skb) and 3110 * we've not tried to adjust the dump allocation 3111 * yet ... then adjust the alloc size to be 3112 * bigger, and return 1 but with the empty skb. 3113 * This results in an empty message being RX'ed 3114 * in userspace, but that is ignored. 3115 * 3116 * We can then retry with the larger buffer. 3117 */ 3118 if ((ret == -ENOBUFS || ret == -EMSGSIZE) && 3119 !skb->len && !state->split && 3120 cb->min_dump_alloc < 4096) { 3121 cb->min_dump_alloc = 4096; 3122 state->split_start = 0; 3123 wiphy_unlock(&rdev->wiphy); 3124 rtnl_unlock(); 3125 return 1; 3126 } 3127 idx--; 3128 break; 3129 } 3130 } while (state->split_start > 0); 3131 wiphy_unlock(&rdev->wiphy); 3132 break; 3133 } 3134 rtnl_unlock(); 3135 3136 state->start = idx; 3137 3138 return skb->len; 3139 } 3140 3141 static int nl80211_dump_wiphy_done(struct netlink_callback *cb) 3142 { 3143 kfree((void *)cb->args[0]); 3144 return 0; 3145 } 3146 3147 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info) 3148 { 3149 struct sk_buff *msg; 3150 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3151 struct nl80211_dump_wiphy_state state = {}; 3152 3153 msg = nlmsg_new(4096, GFP_KERNEL); 3154 if (!msg) 3155 return -ENOMEM; 3156 3157 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg, 3158 info->snd_portid, info->snd_seq, 0, 3159 &state) < 0) { 3160 nlmsg_free(msg); 3161 return -ENOBUFS; 3162 } 3163 3164 return genlmsg_reply(msg, info); 3165 } 3166 3167 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = { 3168 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 }, 3169 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 }, 3170 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 }, 3171 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 }, 3172 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 }, 3173 }; 3174 3175 static int parse_txq_params(struct nlattr *tb[], 3176 struct ieee80211_txq_params *txq_params) 3177 { 3178 u8 ac; 3179 3180 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] || 3181 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] || 3182 !tb[NL80211_TXQ_ATTR_AIFS]) 3183 return -EINVAL; 3184 3185 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]); 3186 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]); 3187 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]); 3188 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]); 3189 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]); 3190 3191 if (ac >= NL80211_NUM_ACS) 3192 return -EINVAL; 3193 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS); 3194 return 0; 3195 } 3196 3197 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev) 3198 { 3199 /* 3200 * You can only set the channel explicitly for some interfaces, 3201 * most have their channel managed via their respective 3202 * "establish a connection" command (connect, join, ...) 3203 * 3204 * For AP/GO and mesh mode, the channel can be set with the 3205 * channel userspace API, but is only stored and passed to the 3206 * low-level driver when the AP starts or the mesh is joined. 3207 * This is for backward compatibility, userspace can also give 3208 * the channel in the start-ap or join-mesh commands instead. 3209 * 3210 * Monitors are special as they are normally slaved to 3211 * whatever else is going on, so they have their own special 3212 * operation to set the monitor channel if possible. 3213 */ 3214 return !wdev || 3215 wdev->iftype == NL80211_IFTYPE_AP || 3216 wdev->iftype == NL80211_IFTYPE_MESH_POINT || 3217 wdev->iftype == NL80211_IFTYPE_MONITOR || 3218 wdev->iftype == NL80211_IFTYPE_P2P_GO; 3219 } 3220 3221 static int _nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3222 struct genl_info *info, bool monitor, 3223 struct cfg80211_chan_def *chandef) 3224 { 3225 struct netlink_ext_ack *extack = info->extack; 3226 struct nlattr **attrs = info->attrs; 3227 u32 control_freq; 3228 3229 if (!attrs[NL80211_ATTR_WIPHY_FREQ]) { 3230 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3231 "Frequency is missing"); 3232 return -EINVAL; 3233 } 3234 3235 control_freq = MHZ_TO_KHZ( 3236 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 3237 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 3238 control_freq += 3239 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 3240 3241 memset(chandef, 0, sizeof(*chandef)); 3242 chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq); 3243 chandef->width = NL80211_CHAN_WIDTH_20_NOHT; 3244 chandef->center_freq1 = KHZ_TO_MHZ(control_freq); 3245 chandef->freq1_offset = control_freq % 1000; 3246 chandef->center_freq2 = 0; 3247 3248 if (!chandef->chan) { 3249 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3250 "Unknown channel"); 3251 return -EINVAL; 3252 } 3253 3254 if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) { 3255 enum nl80211_channel_type chantype; 3256 3257 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]); 3258 3259 switch (chantype) { 3260 case NL80211_CHAN_NO_HT: 3261 case NL80211_CHAN_HT20: 3262 case NL80211_CHAN_HT40PLUS: 3263 case NL80211_CHAN_HT40MINUS: 3264 cfg80211_chandef_create(chandef, chandef->chan, 3265 chantype); 3266 /* user input for center_freq is incorrect */ 3267 if (attrs[NL80211_ATTR_CENTER_FREQ1] && 3268 chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) { 3269 NL_SET_ERR_MSG_ATTR(extack, 3270 attrs[NL80211_ATTR_CENTER_FREQ1], 3271 "bad center frequency 1"); 3272 return -EINVAL; 3273 } 3274 /* center_freq2 must be zero */ 3275 if (attrs[NL80211_ATTR_CENTER_FREQ2] && 3276 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) { 3277 NL_SET_ERR_MSG_ATTR(extack, 3278 attrs[NL80211_ATTR_CENTER_FREQ2], 3279 "center frequency 2 can't be used"); 3280 return -EINVAL; 3281 } 3282 break; 3283 default: 3284 NL_SET_ERR_MSG_ATTR(extack, 3285 attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE], 3286 "invalid channel type"); 3287 return -EINVAL; 3288 } 3289 } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) { 3290 chandef->width = 3291 nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]); 3292 if (chandef->chan->band == NL80211_BAND_S1GHZ) { 3293 /* User input error for channel width doesn't match channel */ 3294 if (chandef->width != ieee80211_s1g_channel_width(chandef->chan)) { 3295 NL_SET_ERR_MSG_ATTR(extack, 3296 attrs[NL80211_ATTR_CHANNEL_WIDTH], 3297 "bad channel width"); 3298 return -EINVAL; 3299 } 3300 } 3301 if (attrs[NL80211_ATTR_CENTER_FREQ1]) { 3302 chandef->center_freq1 = 3303 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]); 3304 if (attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET]) 3305 chandef->freq1_offset = nla_get_u32( 3306 attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET]); 3307 else 3308 chandef->freq1_offset = 0; 3309 } 3310 if (attrs[NL80211_ATTR_CENTER_FREQ2]) 3311 chandef->center_freq2 = 3312 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]); 3313 } 3314 3315 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 3316 chandef->edmg.channels = 3317 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 3318 3319 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 3320 chandef->edmg.bw_config = 3321 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 3322 } else { 3323 chandef->edmg.bw_config = 0; 3324 chandef->edmg.channels = 0; 3325 } 3326 3327 if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) { 3328 chandef->punctured = 3329 nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]); 3330 3331 if (chandef->punctured && 3332 !wiphy_ext_feature_isset(&rdev->wiphy, 3333 NL80211_EXT_FEATURE_PUNCT)) { 3334 NL_SET_ERR_MSG(extack, 3335 "driver doesn't support puncturing"); 3336 return -EINVAL; 3337 } 3338 } 3339 3340 if (!cfg80211_chandef_valid(chandef)) { 3341 NL_SET_ERR_MSG(extack, "invalid channel definition"); 3342 return -EINVAL; 3343 } 3344 3345 if (!_cfg80211_chandef_usable(&rdev->wiphy, chandef, 3346 IEEE80211_CHAN_DISABLED, 3347 monitor)) { 3348 NL_SET_ERR_MSG(extack, "(extension) channel is disabled"); 3349 return -EINVAL; 3350 } 3351 3352 if ((chandef->width == NL80211_CHAN_WIDTH_5 || 3353 chandef->width == NL80211_CHAN_WIDTH_10) && 3354 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) { 3355 NL_SET_ERR_MSG(extack, "5/10 MHz not supported"); 3356 return -EINVAL; 3357 } 3358 3359 return 0; 3360 } 3361 3362 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3363 struct genl_info *info, 3364 struct cfg80211_chan_def *chandef) 3365 { 3366 return _nl80211_parse_chandef(rdev, info, false, chandef); 3367 } 3368 3369 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev, 3370 struct net_device *dev, 3371 struct genl_info *info, 3372 int _link_id) 3373 { 3374 struct cfg80211_chan_def chandef; 3375 int result; 3376 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR; 3377 struct wireless_dev *wdev = NULL; 3378 int link_id = _link_id; 3379 3380 if (dev) 3381 wdev = dev->ieee80211_ptr; 3382 if (!nl80211_can_set_dev_channel(wdev)) 3383 return -EOPNOTSUPP; 3384 if (wdev) 3385 iftype = wdev->iftype; 3386 3387 if (link_id < 0) { 3388 if (wdev && wdev->valid_links) 3389 return -EINVAL; 3390 link_id = 0; 3391 } 3392 3393 result = _nl80211_parse_chandef(rdev, info, 3394 iftype == NL80211_IFTYPE_MONITOR, 3395 &chandef); 3396 if (result) 3397 return result; 3398 3399 switch (iftype) { 3400 case NL80211_IFTYPE_AP: 3401 case NL80211_IFTYPE_P2P_GO: 3402 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 3403 iftype)) 3404 return -EINVAL; 3405 if (wdev->links[link_id].ap.beacon_interval) { 3406 struct ieee80211_channel *cur_chan; 3407 3408 if (!dev || !rdev->ops->set_ap_chanwidth || 3409 !(rdev->wiphy.features & 3410 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) 3411 return -EBUSY; 3412 3413 /* Only allow dynamic channel width changes */ 3414 cur_chan = wdev->links[link_id].ap.chandef.chan; 3415 if (chandef.chan != cur_chan) 3416 return -EBUSY; 3417 3418 /* only allow this for regular channel widths */ 3419 switch (wdev->links[link_id].ap.chandef.width) { 3420 case NL80211_CHAN_WIDTH_20_NOHT: 3421 case NL80211_CHAN_WIDTH_20: 3422 case NL80211_CHAN_WIDTH_40: 3423 case NL80211_CHAN_WIDTH_80: 3424 case NL80211_CHAN_WIDTH_80P80: 3425 case NL80211_CHAN_WIDTH_160: 3426 case NL80211_CHAN_WIDTH_320: 3427 break; 3428 default: 3429 return -EINVAL; 3430 } 3431 3432 switch (chandef.width) { 3433 case NL80211_CHAN_WIDTH_20_NOHT: 3434 case NL80211_CHAN_WIDTH_20: 3435 case NL80211_CHAN_WIDTH_40: 3436 case NL80211_CHAN_WIDTH_80: 3437 case NL80211_CHAN_WIDTH_80P80: 3438 case NL80211_CHAN_WIDTH_160: 3439 case NL80211_CHAN_WIDTH_320: 3440 break; 3441 default: 3442 return -EINVAL; 3443 } 3444 3445 result = rdev_set_ap_chanwidth(rdev, dev, link_id, 3446 &chandef); 3447 if (result) 3448 return result; 3449 wdev->links[link_id].ap.chandef = chandef; 3450 } else { 3451 wdev->u.ap.preset_chandef = chandef; 3452 } 3453 return 0; 3454 case NL80211_IFTYPE_MESH_POINT: 3455 return cfg80211_set_mesh_channel(rdev, wdev, &chandef); 3456 case NL80211_IFTYPE_MONITOR: 3457 return cfg80211_set_monitor_channel(rdev, &chandef); 3458 default: 3459 break; 3460 } 3461 3462 return -EINVAL; 3463 } 3464 3465 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info) 3466 { 3467 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3468 int link_id = nl80211_link_id_or_invalid(info->attrs); 3469 struct net_device *netdev = info->user_ptr[1]; 3470 3471 return __nl80211_set_channel(rdev, netdev, info, link_id); 3472 } 3473 3474 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info) 3475 { 3476 struct cfg80211_registered_device *rdev = NULL; 3477 struct net_device *netdev = NULL; 3478 struct wireless_dev *wdev; 3479 int result = 0, rem_txq_params = 0; 3480 struct nlattr *nl_txq_params; 3481 u32 changed; 3482 u8 retry_short = 0, retry_long = 0; 3483 u32 frag_threshold = 0, rts_threshold = 0; 3484 u8 coverage_class = 0; 3485 u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0; 3486 3487 rtnl_lock(); 3488 /* 3489 * Try to find the wiphy and netdev. Normally this 3490 * function shouldn't need the netdev, but this is 3491 * done for backward compatibility -- previously 3492 * setting the channel was done per wiphy, but now 3493 * it is per netdev. Previous userland like hostapd 3494 * also passed a netdev to set_wiphy, so that it is 3495 * possible to let that go to the right netdev! 3496 */ 3497 3498 if (info->attrs[NL80211_ATTR_IFINDEX]) { 3499 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]); 3500 3501 netdev = __dev_get_by_index(genl_info_net(info), ifindex); 3502 if (netdev && netdev->ieee80211_ptr) 3503 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy); 3504 else 3505 netdev = NULL; 3506 } 3507 3508 if (!netdev) { 3509 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info), 3510 info->attrs); 3511 if (IS_ERR(rdev)) { 3512 rtnl_unlock(); 3513 return PTR_ERR(rdev); 3514 } 3515 wdev = NULL; 3516 netdev = NULL; 3517 result = 0; 3518 } else 3519 wdev = netdev->ieee80211_ptr; 3520 3521 wiphy_lock(&rdev->wiphy); 3522 3523 /* 3524 * end workaround code, by now the rdev is available 3525 * and locked, and wdev may or may not be NULL. 3526 */ 3527 3528 if (info->attrs[NL80211_ATTR_WIPHY_NAME]) 3529 result = cfg80211_dev_rename( 3530 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME])); 3531 rtnl_unlock(); 3532 3533 if (result) 3534 goto out; 3535 3536 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) { 3537 struct ieee80211_txq_params txq_params; 3538 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1]; 3539 3540 if (!rdev->ops->set_txq_params) { 3541 result = -EOPNOTSUPP; 3542 goto out; 3543 } 3544 3545 if (!netdev) { 3546 result = -EINVAL; 3547 goto out; 3548 } 3549 3550 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 3551 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 3552 result = -EINVAL; 3553 goto out; 3554 } 3555 3556 if (!netif_running(netdev)) { 3557 result = -ENETDOWN; 3558 goto out; 3559 } 3560 3561 nla_for_each_nested(nl_txq_params, 3562 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS], 3563 rem_txq_params) { 3564 result = nla_parse_nested_deprecated(tb, 3565 NL80211_TXQ_ATTR_MAX, 3566 nl_txq_params, 3567 txq_params_policy, 3568 info->extack); 3569 if (result) 3570 goto out; 3571 result = parse_txq_params(tb, &txq_params); 3572 if (result) 3573 goto out; 3574 3575 txq_params.link_id = 3576 nl80211_link_id_or_invalid(info->attrs); 3577 3578 if (txq_params.link_id >= 0 && 3579 !(netdev->ieee80211_ptr->valid_links & 3580 BIT(txq_params.link_id))) 3581 result = -ENOLINK; 3582 else if (txq_params.link_id >= 0 && 3583 !netdev->ieee80211_ptr->valid_links) 3584 result = -EINVAL; 3585 else 3586 result = rdev_set_txq_params(rdev, netdev, 3587 &txq_params); 3588 if (result) 3589 goto out; 3590 } 3591 } 3592 3593 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 3594 int link_id = nl80211_link_id_or_invalid(info->attrs); 3595 3596 if (wdev) { 3597 result = __nl80211_set_channel( 3598 rdev, 3599 nl80211_can_set_dev_channel(wdev) ? netdev : NULL, 3600 info, link_id); 3601 } else { 3602 result = __nl80211_set_channel(rdev, netdev, info, link_id); 3603 } 3604 3605 if (result) 3606 goto out; 3607 } 3608 3609 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) { 3610 struct wireless_dev *txp_wdev = wdev; 3611 enum nl80211_tx_power_setting type; 3612 int idx, mbm = 0; 3613 3614 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER)) 3615 txp_wdev = NULL; 3616 3617 if (!rdev->ops->set_tx_power) { 3618 result = -EOPNOTSUPP; 3619 goto out; 3620 } 3621 3622 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING; 3623 type = nla_get_u32(info->attrs[idx]); 3624 3625 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] && 3626 (type != NL80211_TX_POWER_AUTOMATIC)) { 3627 result = -EINVAL; 3628 goto out; 3629 } 3630 3631 if (type != NL80211_TX_POWER_AUTOMATIC) { 3632 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL; 3633 mbm = nla_get_u32(info->attrs[idx]); 3634 } 3635 3636 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm); 3637 if (result) 3638 goto out; 3639 } 3640 3641 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] && 3642 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) { 3643 u32 tx_ant, rx_ant; 3644 3645 if ((!rdev->wiphy.available_antennas_tx && 3646 !rdev->wiphy.available_antennas_rx) || 3647 !rdev->ops->set_antenna) { 3648 result = -EOPNOTSUPP; 3649 goto out; 3650 } 3651 3652 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]); 3653 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]); 3654 3655 /* reject antenna configurations which don't match the 3656 * available antenna masks, except for the "all" mask */ 3657 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) || 3658 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) { 3659 result = -EINVAL; 3660 goto out; 3661 } 3662 3663 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx; 3664 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx; 3665 3666 result = rdev_set_antenna(rdev, tx_ant, rx_ant); 3667 if (result) 3668 goto out; 3669 } 3670 3671 changed = 0; 3672 3673 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) { 3674 retry_short = nla_get_u8( 3675 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]); 3676 3677 changed |= WIPHY_PARAM_RETRY_SHORT; 3678 } 3679 3680 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) { 3681 retry_long = nla_get_u8( 3682 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]); 3683 3684 changed |= WIPHY_PARAM_RETRY_LONG; 3685 } 3686 3687 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) { 3688 frag_threshold = nla_get_u32( 3689 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]); 3690 if (frag_threshold < 256) { 3691 result = -EINVAL; 3692 goto out; 3693 } 3694 3695 if (frag_threshold != (u32) -1) { 3696 /* 3697 * Fragments (apart from the last one) are required to 3698 * have even length. Make the fragmentation code 3699 * simpler by stripping LSB should someone try to use 3700 * odd threshold value. 3701 */ 3702 frag_threshold &= ~0x1; 3703 } 3704 changed |= WIPHY_PARAM_FRAG_THRESHOLD; 3705 } 3706 3707 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3708 rts_threshold = nla_get_u32( 3709 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3710 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3711 } 3712 3713 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) { 3714 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3715 result = -EINVAL; 3716 goto out; 3717 } 3718 3719 coverage_class = nla_get_u8( 3720 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]); 3721 changed |= WIPHY_PARAM_COVERAGE_CLASS; 3722 } 3723 3724 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3725 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) { 3726 result = -EOPNOTSUPP; 3727 goto out; 3728 } 3729 3730 changed |= WIPHY_PARAM_DYN_ACK; 3731 } 3732 3733 if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) { 3734 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3735 NL80211_EXT_FEATURE_TXQS)) { 3736 result = -EOPNOTSUPP; 3737 goto out; 3738 } 3739 txq_limit = nla_get_u32( 3740 info->attrs[NL80211_ATTR_TXQ_LIMIT]); 3741 changed |= WIPHY_PARAM_TXQ_LIMIT; 3742 } 3743 3744 if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) { 3745 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3746 NL80211_EXT_FEATURE_TXQS)) { 3747 result = -EOPNOTSUPP; 3748 goto out; 3749 } 3750 txq_memory_limit = nla_get_u32( 3751 info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]); 3752 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT; 3753 } 3754 3755 if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) { 3756 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3757 NL80211_EXT_FEATURE_TXQS)) { 3758 result = -EOPNOTSUPP; 3759 goto out; 3760 } 3761 txq_quantum = nla_get_u32( 3762 info->attrs[NL80211_ATTR_TXQ_QUANTUM]); 3763 changed |= WIPHY_PARAM_TXQ_QUANTUM; 3764 } 3765 3766 if (changed) { 3767 u8 old_retry_short, old_retry_long; 3768 u32 old_frag_threshold, old_rts_threshold; 3769 u8 old_coverage_class; 3770 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum; 3771 3772 if (!rdev->ops->set_wiphy_params) { 3773 result = -EOPNOTSUPP; 3774 goto out; 3775 } 3776 3777 old_retry_short = rdev->wiphy.retry_short; 3778 old_retry_long = rdev->wiphy.retry_long; 3779 old_frag_threshold = rdev->wiphy.frag_threshold; 3780 old_rts_threshold = rdev->wiphy.rts_threshold; 3781 old_coverage_class = rdev->wiphy.coverage_class; 3782 old_txq_limit = rdev->wiphy.txq_limit; 3783 old_txq_memory_limit = rdev->wiphy.txq_memory_limit; 3784 old_txq_quantum = rdev->wiphy.txq_quantum; 3785 3786 if (changed & WIPHY_PARAM_RETRY_SHORT) 3787 rdev->wiphy.retry_short = retry_short; 3788 if (changed & WIPHY_PARAM_RETRY_LONG) 3789 rdev->wiphy.retry_long = retry_long; 3790 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) 3791 rdev->wiphy.frag_threshold = frag_threshold; 3792 if (changed & WIPHY_PARAM_RTS_THRESHOLD) 3793 rdev->wiphy.rts_threshold = rts_threshold; 3794 if (changed & WIPHY_PARAM_COVERAGE_CLASS) 3795 rdev->wiphy.coverage_class = coverage_class; 3796 if (changed & WIPHY_PARAM_TXQ_LIMIT) 3797 rdev->wiphy.txq_limit = txq_limit; 3798 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT) 3799 rdev->wiphy.txq_memory_limit = txq_memory_limit; 3800 if (changed & WIPHY_PARAM_TXQ_QUANTUM) 3801 rdev->wiphy.txq_quantum = txq_quantum; 3802 3803 result = rdev_set_wiphy_params(rdev, changed); 3804 if (result) { 3805 rdev->wiphy.retry_short = old_retry_short; 3806 rdev->wiphy.retry_long = old_retry_long; 3807 rdev->wiphy.frag_threshold = old_frag_threshold; 3808 rdev->wiphy.rts_threshold = old_rts_threshold; 3809 rdev->wiphy.coverage_class = old_coverage_class; 3810 rdev->wiphy.txq_limit = old_txq_limit; 3811 rdev->wiphy.txq_memory_limit = old_txq_memory_limit; 3812 rdev->wiphy.txq_quantum = old_txq_quantum; 3813 goto out; 3814 } 3815 } 3816 3817 result = 0; 3818 3819 out: 3820 wiphy_unlock(&rdev->wiphy); 3821 return result; 3822 } 3823 3824 int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef) 3825 { 3826 if (WARN_ON(!cfg80211_chandef_valid(chandef))) 3827 return -EINVAL; 3828 3829 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 3830 chandef->chan->center_freq)) 3831 return -ENOBUFS; 3832 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 3833 chandef->chan->freq_offset)) 3834 return -ENOBUFS; 3835 switch (chandef->width) { 3836 case NL80211_CHAN_WIDTH_20_NOHT: 3837 case NL80211_CHAN_WIDTH_20: 3838 case NL80211_CHAN_WIDTH_40: 3839 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 3840 cfg80211_get_chandef_type(chandef))) 3841 return -ENOBUFS; 3842 break; 3843 default: 3844 break; 3845 } 3846 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width)) 3847 return -ENOBUFS; 3848 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1)) 3849 return -ENOBUFS; 3850 if (chandef->center_freq2 && 3851 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2)) 3852 return -ENOBUFS; 3853 if (chandef->punctured && 3854 nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, chandef->punctured)) 3855 return -ENOBUFS; 3856 3857 return 0; 3858 } 3859 EXPORT_SYMBOL(nl80211_send_chandef); 3860 3861 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags, 3862 struct cfg80211_registered_device *rdev, 3863 struct wireless_dev *wdev, 3864 enum nl80211_commands cmd) 3865 { 3866 struct net_device *dev = wdev->netdev; 3867 void *hdr; 3868 3869 lockdep_assert_wiphy(&rdev->wiphy); 3870 3871 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE && 3872 cmd != NL80211_CMD_DEL_INTERFACE && 3873 cmd != NL80211_CMD_SET_INTERFACE); 3874 3875 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 3876 if (!hdr) 3877 return -1; 3878 3879 if (dev && 3880 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 3881 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name))) 3882 goto nla_put_failure; 3883 3884 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 3885 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) || 3886 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 3887 NL80211_ATTR_PAD) || 3888 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) || 3889 nla_put_u32(msg, NL80211_ATTR_GENERATION, 3890 rdev->devlist_generation ^ 3891 (cfg80211_rdev_list_generation << 2)) || 3892 nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr)) 3893 goto nla_put_failure; 3894 3895 if (rdev->ops->get_channel && !wdev->valid_links) { 3896 struct cfg80211_chan_def chandef = {}; 3897 int ret; 3898 3899 ret = rdev_get_channel(rdev, wdev, 0, &chandef); 3900 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 3901 goto nla_put_failure; 3902 } 3903 3904 if (rdev->ops->get_tx_power) { 3905 int dbm, ret; 3906 3907 ret = rdev_get_tx_power(rdev, wdev, &dbm); 3908 if (ret == 0 && 3909 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 3910 DBM_TO_MBM(dbm))) 3911 goto nla_put_failure; 3912 } 3913 3914 switch (wdev->iftype) { 3915 case NL80211_IFTYPE_AP: 3916 case NL80211_IFTYPE_P2P_GO: 3917 if (wdev->u.ap.ssid_len && 3918 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 3919 wdev->u.ap.ssid)) 3920 goto nla_put_failure; 3921 break; 3922 case NL80211_IFTYPE_STATION: 3923 case NL80211_IFTYPE_P2P_CLIENT: 3924 if (wdev->u.client.ssid_len && 3925 nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len, 3926 wdev->u.client.ssid)) 3927 goto nla_put_failure; 3928 break; 3929 case NL80211_IFTYPE_ADHOC: 3930 if (wdev->u.ibss.ssid_len && 3931 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len, 3932 wdev->u.ibss.ssid)) 3933 goto nla_put_failure; 3934 break; 3935 default: 3936 /* nothing */ 3937 break; 3938 } 3939 3940 if (rdev->ops->get_txq_stats) { 3941 struct cfg80211_txq_stats txqstats = {}; 3942 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats); 3943 3944 if (ret == 0 && 3945 !nl80211_put_txq_stats(msg, &txqstats, 3946 NL80211_ATTR_TXQ_STATS)) 3947 goto nla_put_failure; 3948 } 3949 3950 if (wdev->valid_links) { 3951 unsigned int link_id; 3952 struct nlattr *links = nla_nest_start(msg, 3953 NL80211_ATTR_MLO_LINKS); 3954 3955 if (!links) 3956 goto nla_put_failure; 3957 3958 for_each_valid_link(wdev, link_id) { 3959 struct nlattr *link = nla_nest_start(msg, link_id + 1); 3960 struct cfg80211_chan_def chandef = {}; 3961 int ret; 3962 3963 if (!link) 3964 goto nla_put_failure; 3965 3966 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 3967 goto nla_put_failure; 3968 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 3969 wdev->links[link_id].addr)) 3970 goto nla_put_failure; 3971 3972 ret = rdev_get_channel(rdev, wdev, link_id, &chandef); 3973 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 3974 goto nla_put_failure; 3975 3976 nla_nest_end(msg, link); 3977 } 3978 3979 nla_nest_end(msg, links); 3980 } 3981 3982 genlmsg_end(msg, hdr); 3983 return 0; 3984 3985 nla_put_failure: 3986 genlmsg_cancel(msg, hdr); 3987 return -EMSGSIZE; 3988 } 3989 3990 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb) 3991 { 3992 int wp_idx = 0; 3993 int if_idx = 0; 3994 int wp_start = cb->args[0]; 3995 int if_start = cb->args[1]; 3996 int filter_wiphy = -1; 3997 struct cfg80211_registered_device *rdev; 3998 struct wireless_dev *wdev; 3999 int ret; 4000 4001 rtnl_lock(); 4002 if (!cb->args[2]) { 4003 struct nl80211_dump_wiphy_state state = { 4004 .filter_wiphy = -1, 4005 }; 4006 4007 ret = nl80211_dump_wiphy_parse(skb, cb, &state); 4008 if (ret) 4009 goto out_unlock; 4010 4011 filter_wiphy = state.filter_wiphy; 4012 4013 /* 4014 * if filtering, set cb->args[2] to +1 since 0 is the default 4015 * value needed to determine that parsing is necessary. 4016 */ 4017 if (filter_wiphy >= 0) 4018 cb->args[2] = filter_wiphy + 1; 4019 else 4020 cb->args[2] = -1; 4021 } else if (cb->args[2] > 0) { 4022 filter_wiphy = cb->args[2] - 1; 4023 } 4024 4025 for_each_rdev(rdev) { 4026 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 4027 continue; 4028 if (wp_idx < wp_start) { 4029 wp_idx++; 4030 continue; 4031 } 4032 4033 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx) 4034 continue; 4035 4036 if_idx = 0; 4037 4038 wiphy_lock(&rdev->wiphy); 4039 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 4040 if (if_idx < if_start) { 4041 if_idx++; 4042 continue; 4043 } 4044 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid, 4045 cb->nlh->nlmsg_seq, NLM_F_MULTI, 4046 rdev, wdev, 4047 NL80211_CMD_NEW_INTERFACE) < 0) { 4048 wiphy_unlock(&rdev->wiphy); 4049 goto out; 4050 } 4051 if_idx++; 4052 } 4053 wiphy_unlock(&rdev->wiphy); 4054 4055 if_start = 0; 4056 wp_idx++; 4057 } 4058 out: 4059 cb->args[0] = wp_idx; 4060 cb->args[1] = if_idx; 4061 4062 ret = skb->len; 4063 out_unlock: 4064 rtnl_unlock(); 4065 4066 return ret; 4067 } 4068 4069 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info) 4070 { 4071 struct sk_buff *msg; 4072 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4073 struct wireless_dev *wdev = info->user_ptr[1]; 4074 4075 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4076 if (!msg) 4077 return -ENOMEM; 4078 4079 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4080 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4081 nlmsg_free(msg); 4082 return -ENOBUFS; 4083 } 4084 4085 return genlmsg_reply(msg, info); 4086 } 4087 4088 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = { 4089 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG }, 4090 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG }, 4091 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG }, 4092 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG }, 4093 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG }, 4094 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG }, 4095 }; 4096 4097 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags) 4098 { 4099 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1]; 4100 int flag; 4101 4102 *mntrflags = 0; 4103 4104 if (!nla) 4105 return -EINVAL; 4106 4107 if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL)) 4108 return -EINVAL; 4109 4110 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++) 4111 if (flags[flag]) 4112 *mntrflags |= (1<<flag); 4113 4114 *mntrflags |= MONITOR_FLAG_CHANGED; 4115 4116 return 0; 4117 } 4118 4119 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev, 4120 enum nl80211_iftype type, 4121 struct genl_info *info, 4122 struct vif_params *params) 4123 { 4124 bool change = false; 4125 int err; 4126 4127 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) { 4128 if (type != NL80211_IFTYPE_MONITOR) 4129 return -EINVAL; 4130 4131 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS], 4132 ¶ms->flags); 4133 if (err) 4134 return err; 4135 4136 change = true; 4137 } 4138 4139 if (params->flags & MONITOR_FLAG_ACTIVE && 4140 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR)) 4141 return -EOPNOTSUPP; 4142 4143 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) { 4144 const u8 *mumimo_groups; 4145 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4146 4147 if (type != NL80211_IFTYPE_MONITOR) 4148 return -EINVAL; 4149 4150 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4151 return -EOPNOTSUPP; 4152 4153 mumimo_groups = 4154 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]); 4155 4156 /* bits 0 and 63 are reserved and must be zero */ 4157 if ((mumimo_groups[0] & BIT(0)) || 4158 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7))) 4159 return -EINVAL; 4160 4161 params->vht_mumimo_groups = mumimo_groups; 4162 change = true; 4163 } 4164 4165 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) { 4166 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4167 4168 if (type != NL80211_IFTYPE_MONITOR) 4169 return -EINVAL; 4170 4171 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4172 return -EOPNOTSUPP; 4173 4174 params->vht_mumimo_follow_addr = 4175 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]); 4176 change = true; 4177 } 4178 4179 return change ? 1 : 0; 4180 } 4181 4182 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev, 4183 struct net_device *netdev, u8 use_4addr, 4184 enum nl80211_iftype iftype) 4185 { 4186 if (!use_4addr) { 4187 if (netdev && netif_is_bridge_port(netdev)) 4188 return -EBUSY; 4189 return 0; 4190 } 4191 4192 switch (iftype) { 4193 case NL80211_IFTYPE_AP_VLAN: 4194 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP) 4195 return 0; 4196 break; 4197 case NL80211_IFTYPE_STATION: 4198 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION) 4199 return 0; 4200 break; 4201 default: 4202 break; 4203 } 4204 4205 return -EOPNOTSUPP; 4206 } 4207 4208 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info) 4209 { 4210 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4211 struct vif_params params; 4212 int err; 4213 enum nl80211_iftype otype, ntype; 4214 struct net_device *dev = info->user_ptr[1]; 4215 bool change = false; 4216 4217 memset(¶ms, 0, sizeof(params)); 4218 4219 otype = ntype = dev->ieee80211_ptr->iftype; 4220 4221 if (info->attrs[NL80211_ATTR_IFTYPE]) { 4222 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4223 if (otype != ntype) 4224 change = true; 4225 } 4226 4227 if (info->attrs[NL80211_ATTR_MESH_ID]) { 4228 struct wireless_dev *wdev = dev->ieee80211_ptr; 4229 4230 if (ntype != NL80211_IFTYPE_MESH_POINT) 4231 return -EINVAL; 4232 if (otype != NL80211_IFTYPE_MESH_POINT) 4233 return -EINVAL; 4234 if (netif_running(dev)) 4235 return -EBUSY; 4236 4237 wdev->u.mesh.id_up_len = 4238 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4239 memcpy(wdev->u.mesh.id, 4240 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4241 wdev->u.mesh.id_up_len); 4242 } 4243 4244 if (info->attrs[NL80211_ATTR_4ADDR]) { 4245 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4246 change = true; 4247 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype); 4248 if (err) 4249 return err; 4250 } else { 4251 params.use_4addr = -1; 4252 } 4253 4254 err = nl80211_parse_mon_options(rdev, ntype, info, ¶ms); 4255 if (err < 0) 4256 return err; 4257 if (err > 0) 4258 change = true; 4259 4260 if (change) 4261 err = cfg80211_change_iface(rdev, dev, ntype, ¶ms); 4262 else 4263 err = 0; 4264 4265 if (!err && params.use_4addr != -1) 4266 dev->ieee80211_ptr->use_4addr = params.use_4addr; 4267 4268 if (change && !err) { 4269 struct wireless_dev *wdev = dev->ieee80211_ptr; 4270 4271 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE); 4272 } 4273 4274 return err; 4275 } 4276 4277 static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4278 { 4279 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4280 struct vif_params params; 4281 struct wireless_dev *wdev; 4282 struct sk_buff *msg; 4283 int err; 4284 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED; 4285 4286 memset(¶ms, 0, sizeof(params)); 4287 4288 if (!info->attrs[NL80211_ATTR_IFNAME]) 4289 return -EINVAL; 4290 4291 if (info->attrs[NL80211_ATTR_IFTYPE]) 4292 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4293 4294 if (!rdev->ops->add_virtual_intf) 4295 return -EOPNOTSUPP; 4296 4297 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN || 4298 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) && 4299 info->attrs[NL80211_ATTR_MAC]) { 4300 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC], 4301 ETH_ALEN); 4302 if (!is_valid_ether_addr(params.macaddr)) 4303 return -EADDRNOTAVAIL; 4304 } 4305 4306 if (info->attrs[NL80211_ATTR_4ADDR]) { 4307 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4308 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type); 4309 if (err) 4310 return err; 4311 } 4312 4313 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0)) 4314 return -EOPNOTSUPP; 4315 4316 err = nl80211_parse_mon_options(rdev, type, info, ¶ms); 4317 if (err < 0) 4318 return err; 4319 4320 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4321 if (!msg) 4322 return -ENOMEM; 4323 4324 wdev = rdev_add_virtual_intf(rdev, 4325 nla_data(info->attrs[NL80211_ATTR_IFNAME]), 4326 NET_NAME_USER, type, ¶ms); 4327 if (WARN_ON(!wdev)) { 4328 nlmsg_free(msg); 4329 return -EPROTO; 4330 } else if (IS_ERR(wdev)) { 4331 nlmsg_free(msg); 4332 return PTR_ERR(wdev); 4333 } 4334 4335 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 4336 wdev->owner_nlportid = info->snd_portid; 4337 4338 switch (type) { 4339 case NL80211_IFTYPE_MESH_POINT: 4340 if (!info->attrs[NL80211_ATTR_MESH_ID]) 4341 break; 4342 wdev->u.mesh.id_up_len = 4343 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4344 memcpy(wdev->u.mesh.id, 4345 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4346 wdev->u.mesh.id_up_len); 4347 break; 4348 case NL80211_IFTYPE_NAN: 4349 case NL80211_IFTYPE_P2P_DEVICE: 4350 /* 4351 * P2P Device and NAN do not have a netdev, so don't go 4352 * through the netdev notifier and must be added here 4353 */ 4354 cfg80211_init_wdev(wdev); 4355 cfg80211_register_wdev(rdev, wdev); 4356 break; 4357 default: 4358 break; 4359 } 4360 4361 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4362 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4363 nlmsg_free(msg); 4364 return -ENOBUFS; 4365 } 4366 4367 return genlmsg_reply(msg, info); 4368 } 4369 4370 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4371 { 4372 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4373 int ret; 4374 4375 /* to avoid failing a new interface creation due to pending removal */ 4376 cfg80211_destroy_ifaces(rdev); 4377 4378 wiphy_lock(&rdev->wiphy); 4379 ret = _nl80211_new_interface(skb, info); 4380 wiphy_unlock(&rdev->wiphy); 4381 4382 return ret; 4383 } 4384 4385 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info) 4386 { 4387 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4388 struct wireless_dev *wdev = info->user_ptr[1]; 4389 4390 if (!rdev->ops->del_virtual_intf) 4391 return -EOPNOTSUPP; 4392 4393 /* 4394 * We hold RTNL, so this is safe, without RTNL opencount cannot 4395 * reach 0, and thus the rdev cannot be deleted. 4396 * 4397 * We need to do it for the dev_close(), since that will call 4398 * the netdev notifiers, and we need to acquire the mutex there 4399 * but don't know if we get there from here or from some other 4400 * place (e.g. "ip link set ... down"). 4401 */ 4402 mutex_unlock(&rdev->wiphy.mtx); 4403 4404 /* 4405 * If we remove a wireless device without a netdev then clear 4406 * user_ptr[1] so that nl80211_post_doit won't dereference it 4407 * to check if it needs to do dev_put(). Otherwise it crashes 4408 * since the wdev has been freed, unlike with a netdev where 4409 * we need the dev_put() for the netdev to really be freed. 4410 */ 4411 if (!wdev->netdev) 4412 info->user_ptr[1] = NULL; 4413 else 4414 dev_close(wdev->netdev); 4415 4416 mutex_lock(&rdev->wiphy.mtx); 4417 4418 return cfg80211_remove_virtual_intf(rdev, wdev); 4419 } 4420 4421 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info) 4422 { 4423 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4424 struct net_device *dev = info->user_ptr[1]; 4425 u16 noack_map; 4426 4427 if (!info->attrs[NL80211_ATTR_NOACK_MAP]) 4428 return -EINVAL; 4429 4430 if (!rdev->ops->set_noack_map) 4431 return -EOPNOTSUPP; 4432 4433 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]); 4434 4435 return rdev_set_noack_map(rdev, dev, noack_map); 4436 } 4437 4438 static int nl80211_validate_key_link_id(struct genl_info *info, 4439 struct wireless_dev *wdev, 4440 int link_id, bool pairwise) 4441 { 4442 if (pairwise) { 4443 if (link_id != -1) { 4444 GENL_SET_ERR_MSG(info, 4445 "link ID not allowed for pairwise key"); 4446 return -EINVAL; 4447 } 4448 4449 return 0; 4450 } 4451 4452 if (wdev->valid_links) { 4453 if (link_id == -1) { 4454 GENL_SET_ERR_MSG(info, 4455 "link ID must for MLO group key"); 4456 return -EINVAL; 4457 } 4458 if (!(wdev->valid_links & BIT(link_id))) { 4459 GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key"); 4460 return -EINVAL; 4461 } 4462 } else if (link_id != -1) { 4463 GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key"); 4464 return -EINVAL; 4465 } 4466 4467 return 0; 4468 } 4469 4470 struct get_key_cookie { 4471 struct sk_buff *msg; 4472 int error; 4473 int idx; 4474 }; 4475 4476 static void get_key_callback(void *c, struct key_params *params) 4477 { 4478 struct nlattr *key; 4479 struct get_key_cookie *cookie = c; 4480 4481 if ((params->key && 4482 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA, 4483 params->key_len, params->key)) || 4484 (params->seq && 4485 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ, 4486 params->seq_len, params->seq)) || 4487 (params->cipher && 4488 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER, 4489 params->cipher))) 4490 goto nla_put_failure; 4491 4492 key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY); 4493 if (!key) 4494 goto nla_put_failure; 4495 4496 if ((params->key && 4497 nla_put(cookie->msg, NL80211_KEY_DATA, 4498 params->key_len, params->key)) || 4499 (params->seq && 4500 nla_put(cookie->msg, NL80211_KEY_SEQ, 4501 params->seq_len, params->seq)) || 4502 (params->cipher && 4503 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER, 4504 params->cipher))) 4505 goto nla_put_failure; 4506 4507 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx)) 4508 goto nla_put_failure; 4509 4510 nla_nest_end(cookie->msg, key); 4511 4512 return; 4513 nla_put_failure: 4514 cookie->error = 1; 4515 } 4516 4517 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info) 4518 { 4519 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4520 int err; 4521 struct net_device *dev = info->user_ptr[1]; 4522 u8 key_idx = 0; 4523 const u8 *mac_addr = NULL; 4524 bool pairwise; 4525 struct get_key_cookie cookie = { 4526 .error = 0, 4527 }; 4528 void *hdr; 4529 struct sk_buff *msg; 4530 bool bigtk_support = false; 4531 int link_id = nl80211_link_id_or_invalid(info->attrs); 4532 struct wireless_dev *wdev = dev->ieee80211_ptr; 4533 4534 if (wiphy_ext_feature_isset(&rdev->wiphy, 4535 NL80211_EXT_FEATURE_BEACON_PROTECTION)) 4536 bigtk_support = true; 4537 4538 if ((wdev->iftype == NL80211_IFTYPE_STATION || 4539 wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) && 4540 wiphy_ext_feature_isset(&rdev->wiphy, 4541 NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT)) 4542 bigtk_support = true; 4543 4544 if (info->attrs[NL80211_ATTR_KEY_IDX]) { 4545 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 4546 4547 if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) { 4548 GENL_SET_ERR_MSG(info, "BIGTK not supported"); 4549 return -EINVAL; 4550 } 4551 } 4552 4553 if (info->attrs[NL80211_ATTR_MAC]) 4554 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4555 4556 pairwise = !!mac_addr; 4557 if (info->attrs[NL80211_ATTR_KEY_TYPE]) { 4558 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 4559 4560 if (kt != NL80211_KEYTYPE_GROUP && 4561 kt != NL80211_KEYTYPE_PAIRWISE) 4562 return -EINVAL; 4563 pairwise = kt == NL80211_KEYTYPE_PAIRWISE; 4564 } 4565 4566 if (!rdev->ops->get_key) 4567 return -EOPNOTSUPP; 4568 4569 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4570 return -ENOENT; 4571 4572 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4573 if (!msg) 4574 return -ENOMEM; 4575 4576 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 4577 NL80211_CMD_NEW_KEY); 4578 if (!hdr) 4579 goto nla_put_failure; 4580 4581 cookie.msg = msg; 4582 cookie.idx = key_idx; 4583 4584 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4585 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx)) 4586 goto nla_put_failure; 4587 if (mac_addr && 4588 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr)) 4589 goto nla_put_failure; 4590 4591 err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise); 4592 if (err) 4593 goto free_msg; 4594 4595 err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr, 4596 &cookie, get_key_callback); 4597 4598 if (err) 4599 goto free_msg; 4600 4601 if (cookie.error) 4602 goto nla_put_failure; 4603 4604 genlmsg_end(msg, hdr); 4605 return genlmsg_reply(msg, info); 4606 4607 nla_put_failure: 4608 err = -ENOBUFS; 4609 free_msg: 4610 nlmsg_free(msg); 4611 return err; 4612 } 4613 4614 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info) 4615 { 4616 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4617 struct key_parse key; 4618 int err; 4619 struct net_device *dev = info->user_ptr[1]; 4620 int link_id = nl80211_link_id_or_invalid(info->attrs); 4621 struct wireless_dev *wdev = dev->ieee80211_ptr; 4622 4623 err = nl80211_parse_key(info, &key); 4624 if (err) 4625 return err; 4626 4627 if (key.idx < 0) 4628 return -EINVAL; 4629 4630 /* Only support setting default key and 4631 * Extended Key ID action NL80211_KEY_SET_TX. 4632 */ 4633 if (!key.def && !key.defmgmt && !key.defbeacon && 4634 !(key.p.mode == NL80211_KEY_SET_TX)) 4635 return -EINVAL; 4636 4637 if (key.def) { 4638 if (!rdev->ops->set_default_key) 4639 return -EOPNOTSUPP; 4640 4641 err = nl80211_key_allowed(wdev); 4642 if (err) 4643 return err; 4644 4645 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4646 if (err) 4647 return err; 4648 4649 err = rdev_set_default_key(rdev, dev, link_id, key.idx, 4650 key.def_uni, key.def_multi); 4651 4652 if (err) 4653 return err; 4654 4655 #ifdef CONFIG_CFG80211_WEXT 4656 wdev->wext.default_key = key.idx; 4657 #endif 4658 return 0; 4659 } else if (key.defmgmt) { 4660 if (key.def_uni || !key.def_multi) 4661 return -EINVAL; 4662 4663 if (!rdev->ops->set_default_mgmt_key) 4664 return -EOPNOTSUPP; 4665 4666 err = nl80211_key_allowed(wdev); 4667 if (err) 4668 return err; 4669 4670 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4671 if (err) 4672 return err; 4673 4674 err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx); 4675 if (err) 4676 return err; 4677 4678 #ifdef CONFIG_CFG80211_WEXT 4679 wdev->wext.default_mgmt_key = key.idx; 4680 #endif 4681 return 0; 4682 } else if (key.defbeacon) { 4683 if (key.def_uni || !key.def_multi) 4684 return -EINVAL; 4685 4686 if (!rdev->ops->set_default_beacon_key) 4687 return -EOPNOTSUPP; 4688 4689 err = nl80211_key_allowed(wdev); 4690 if (err) 4691 return err; 4692 4693 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4694 if (err) 4695 return err; 4696 4697 return rdev_set_default_beacon_key(rdev, dev, link_id, key.idx); 4698 } else if (key.p.mode == NL80211_KEY_SET_TX && 4699 wiphy_ext_feature_isset(&rdev->wiphy, 4700 NL80211_EXT_FEATURE_EXT_KEY_ID)) { 4701 u8 *mac_addr = NULL; 4702 4703 if (info->attrs[NL80211_ATTR_MAC]) 4704 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4705 4706 if (!mac_addr || key.idx < 0 || key.idx > 1) 4707 return -EINVAL; 4708 4709 err = nl80211_validate_key_link_id(info, wdev, link_id, true); 4710 if (err) 4711 return err; 4712 4713 return rdev_add_key(rdev, dev, link_id, key.idx, 4714 NL80211_KEYTYPE_PAIRWISE, 4715 mac_addr, &key.p); 4716 } 4717 4718 return -EINVAL; 4719 } 4720 4721 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info) 4722 { 4723 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4724 int err; 4725 struct net_device *dev = info->user_ptr[1]; 4726 struct key_parse key; 4727 const u8 *mac_addr = NULL; 4728 int link_id = nl80211_link_id_or_invalid(info->attrs); 4729 struct wireless_dev *wdev = dev->ieee80211_ptr; 4730 4731 err = nl80211_parse_key(info, &key); 4732 if (err) 4733 return err; 4734 4735 if (!key.p.key) { 4736 GENL_SET_ERR_MSG(info, "no key"); 4737 return -EINVAL; 4738 } 4739 4740 if (info->attrs[NL80211_ATTR_MAC]) 4741 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4742 4743 if (key.type == -1) { 4744 if (mac_addr) 4745 key.type = NL80211_KEYTYPE_PAIRWISE; 4746 else 4747 key.type = NL80211_KEYTYPE_GROUP; 4748 } 4749 4750 /* for now */ 4751 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4752 key.type != NL80211_KEYTYPE_GROUP) { 4753 GENL_SET_ERR_MSG(info, "key type not pairwise or group"); 4754 return -EINVAL; 4755 } 4756 4757 if (key.type == NL80211_KEYTYPE_GROUP && 4758 info->attrs[NL80211_ATTR_VLAN_ID]) 4759 key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 4760 4761 if (!rdev->ops->add_key) 4762 return -EOPNOTSUPP; 4763 4764 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, 4765 key.type == NL80211_KEYTYPE_PAIRWISE, 4766 mac_addr)) { 4767 GENL_SET_ERR_MSG(info, "key setting validation failed"); 4768 return -EINVAL; 4769 } 4770 4771 err = nl80211_key_allowed(wdev); 4772 if (err) 4773 GENL_SET_ERR_MSG(info, "key not allowed"); 4774 4775 if (!err) 4776 err = nl80211_validate_key_link_id(info, wdev, link_id, 4777 key.type == NL80211_KEYTYPE_PAIRWISE); 4778 4779 if (!err) { 4780 err = rdev_add_key(rdev, dev, link_id, key.idx, 4781 key.type == NL80211_KEYTYPE_PAIRWISE, 4782 mac_addr, &key.p); 4783 if (err) 4784 GENL_SET_ERR_MSG(info, "key addition failed"); 4785 } 4786 4787 return err; 4788 } 4789 4790 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info) 4791 { 4792 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4793 int err; 4794 struct net_device *dev = info->user_ptr[1]; 4795 u8 *mac_addr = NULL; 4796 struct key_parse key; 4797 int link_id = nl80211_link_id_or_invalid(info->attrs); 4798 struct wireless_dev *wdev = dev->ieee80211_ptr; 4799 4800 err = nl80211_parse_key(info, &key); 4801 if (err) 4802 return err; 4803 4804 if (info->attrs[NL80211_ATTR_MAC]) 4805 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4806 4807 if (key.type == -1) { 4808 if (mac_addr) 4809 key.type = NL80211_KEYTYPE_PAIRWISE; 4810 else 4811 key.type = NL80211_KEYTYPE_GROUP; 4812 } 4813 4814 /* for now */ 4815 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4816 key.type != NL80211_KEYTYPE_GROUP) 4817 return -EINVAL; 4818 4819 if (!cfg80211_valid_key_idx(rdev, key.idx, 4820 key.type == NL80211_KEYTYPE_PAIRWISE)) 4821 return -EINVAL; 4822 4823 if (!rdev->ops->del_key) 4824 return -EOPNOTSUPP; 4825 4826 err = nl80211_key_allowed(wdev); 4827 4828 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr && 4829 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4830 err = -ENOENT; 4831 4832 if (!err) 4833 err = nl80211_validate_key_link_id(info, wdev, link_id, 4834 key.type == NL80211_KEYTYPE_PAIRWISE); 4835 4836 if (!err) 4837 err = rdev_del_key(rdev, dev, link_id, key.idx, 4838 key.type == NL80211_KEYTYPE_PAIRWISE, 4839 mac_addr); 4840 4841 #ifdef CONFIG_CFG80211_WEXT 4842 if (!err) { 4843 if (key.idx == wdev->wext.default_key) 4844 wdev->wext.default_key = -1; 4845 else if (key.idx == wdev->wext.default_mgmt_key) 4846 wdev->wext.default_mgmt_key = -1; 4847 } 4848 #endif 4849 4850 return err; 4851 } 4852 4853 /* This function returns an error or the number of nested attributes */ 4854 static int validate_acl_mac_addrs(struct nlattr *nl_attr) 4855 { 4856 struct nlattr *attr; 4857 int n_entries = 0, tmp; 4858 4859 nla_for_each_nested(attr, nl_attr, tmp) { 4860 if (nla_len(attr) != ETH_ALEN) 4861 return -EINVAL; 4862 4863 n_entries++; 4864 } 4865 4866 return n_entries; 4867 } 4868 4869 /* 4870 * This function parses ACL information and allocates memory for ACL data. 4871 * On successful return, the calling function is responsible to free the 4872 * ACL buffer returned by this function. 4873 */ 4874 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy, 4875 struct genl_info *info) 4876 { 4877 enum nl80211_acl_policy acl_policy; 4878 struct nlattr *attr; 4879 struct cfg80211_acl_data *acl; 4880 int i = 0, n_entries, tmp; 4881 4882 if (!wiphy->max_acl_mac_addrs) 4883 return ERR_PTR(-EOPNOTSUPP); 4884 4885 if (!info->attrs[NL80211_ATTR_ACL_POLICY]) 4886 return ERR_PTR(-EINVAL); 4887 4888 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]); 4889 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED && 4890 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED) 4891 return ERR_PTR(-EINVAL); 4892 4893 if (!info->attrs[NL80211_ATTR_MAC_ADDRS]) 4894 return ERR_PTR(-EINVAL); 4895 4896 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]); 4897 if (n_entries < 0) 4898 return ERR_PTR(n_entries); 4899 4900 if (n_entries > wiphy->max_acl_mac_addrs) 4901 return ERR_PTR(-EOPNOTSUPP); 4902 4903 acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL); 4904 if (!acl) 4905 return ERR_PTR(-ENOMEM); 4906 acl->n_acl_entries = n_entries; 4907 4908 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) { 4909 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN); 4910 i++; 4911 } 4912 acl->acl_policy = acl_policy; 4913 4914 return acl; 4915 } 4916 4917 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info) 4918 { 4919 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4920 struct net_device *dev = info->user_ptr[1]; 4921 struct cfg80211_acl_data *acl; 4922 int err; 4923 4924 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 4925 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4926 return -EOPNOTSUPP; 4927 4928 if (!dev->ieee80211_ptr->links[0].ap.beacon_interval) 4929 return -EINVAL; 4930 4931 acl = parse_acl_data(&rdev->wiphy, info); 4932 if (IS_ERR(acl)) 4933 return PTR_ERR(acl); 4934 4935 err = rdev_set_mac_acl(rdev, dev, acl); 4936 4937 kfree(acl); 4938 4939 return err; 4940 } 4941 4942 static u32 rateset_to_mask(struct ieee80211_supported_band *sband, 4943 u8 *rates, u8 rates_len) 4944 { 4945 u8 i; 4946 u32 mask = 0; 4947 4948 for (i = 0; i < rates_len; i++) { 4949 int rate = (rates[i] & 0x7f) * 5; 4950 int ridx; 4951 4952 for (ridx = 0; ridx < sband->n_bitrates; ridx++) { 4953 struct ieee80211_rate *srate = 4954 &sband->bitrates[ridx]; 4955 if (rate == srate->bitrate) { 4956 mask |= 1 << ridx; 4957 break; 4958 } 4959 } 4960 if (ridx == sband->n_bitrates) 4961 return 0; /* rate not found */ 4962 } 4963 4964 return mask; 4965 } 4966 4967 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband, 4968 u8 *rates, u8 rates_len, 4969 u8 mcs[IEEE80211_HT_MCS_MASK_LEN]) 4970 { 4971 u8 i; 4972 4973 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN); 4974 4975 for (i = 0; i < rates_len; i++) { 4976 int ridx, rbit; 4977 4978 ridx = rates[i] / 8; 4979 rbit = BIT(rates[i] % 8); 4980 4981 /* check validity */ 4982 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN)) 4983 return false; 4984 4985 /* check availability */ 4986 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN); 4987 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit) 4988 mcs[ridx] |= rbit; 4989 else 4990 return false; 4991 } 4992 4993 return true; 4994 } 4995 4996 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map) 4997 { 4998 u16 mcs_mask = 0; 4999 5000 switch (vht_mcs_map) { 5001 case IEEE80211_VHT_MCS_NOT_SUPPORTED: 5002 break; 5003 case IEEE80211_VHT_MCS_SUPPORT_0_7: 5004 mcs_mask = 0x00FF; 5005 break; 5006 case IEEE80211_VHT_MCS_SUPPORT_0_8: 5007 mcs_mask = 0x01FF; 5008 break; 5009 case IEEE80211_VHT_MCS_SUPPORT_0_9: 5010 mcs_mask = 0x03FF; 5011 break; 5012 default: 5013 break; 5014 } 5015 5016 return mcs_mask; 5017 } 5018 5019 static void vht_build_mcs_mask(u16 vht_mcs_map, 5020 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX]) 5021 { 5022 u8 nss; 5023 5024 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) { 5025 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03); 5026 vht_mcs_map >>= 2; 5027 } 5028 } 5029 5030 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband, 5031 struct nl80211_txrate_vht *txrate, 5032 u16 mcs[NL80211_VHT_NSS_MAX]) 5033 { 5034 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5035 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {}; 5036 u8 i; 5037 5038 if (!sband->vht_cap.vht_supported) 5039 return false; 5040 5041 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX); 5042 5043 /* Build vht_mcs_mask from VHT capabilities */ 5044 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5045 5046 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5047 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5048 mcs[i] = txrate->mcs[i]; 5049 else 5050 return false; 5051 } 5052 5053 return true; 5054 } 5055 5056 static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map) 5057 { 5058 switch (he_mcs_map) { 5059 case IEEE80211_HE_MCS_NOT_SUPPORTED: 5060 return 0; 5061 case IEEE80211_HE_MCS_SUPPORT_0_7: 5062 return 0x00FF; 5063 case IEEE80211_HE_MCS_SUPPORT_0_9: 5064 return 0x03FF; 5065 case IEEE80211_HE_MCS_SUPPORT_0_11: 5066 return 0xFFF; 5067 default: 5068 break; 5069 } 5070 return 0; 5071 } 5072 5073 static void he_build_mcs_mask(u16 he_mcs_map, 5074 u16 he_mcs_mask[NL80211_HE_NSS_MAX]) 5075 { 5076 u8 nss; 5077 5078 for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) { 5079 he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03); 5080 he_mcs_map >>= 2; 5081 } 5082 } 5083 5084 static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id, 5085 const struct ieee80211_sta_he_cap *he_cap) 5086 { 5087 struct net_device *dev = info->user_ptr[1]; 5088 struct wireless_dev *wdev = dev->ieee80211_ptr; 5089 struct cfg80211_chan_def *chandef; 5090 __le16 tx_mcs; 5091 5092 chandef = wdev_chandef(wdev, link_id); 5093 if (!chandef) { 5094 /* 5095 * This is probably broken, but we never maintained 5096 * a chandef in these cases, so it always was. 5097 */ 5098 return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80); 5099 } 5100 5101 switch (chandef->width) { 5102 case NL80211_CHAN_WIDTH_80P80: 5103 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80; 5104 break; 5105 case NL80211_CHAN_WIDTH_160: 5106 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160; 5107 break; 5108 default: 5109 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80; 5110 break; 5111 } 5112 5113 return le16_to_cpu(tx_mcs); 5114 } 5115 5116 static bool he_set_mcs_mask(struct genl_info *info, 5117 struct wireless_dev *wdev, 5118 struct ieee80211_supported_band *sband, 5119 struct nl80211_txrate_he *txrate, 5120 u16 mcs[NL80211_HE_NSS_MAX], 5121 unsigned int link_id) 5122 { 5123 const struct ieee80211_sta_he_cap *he_cap; 5124 u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {}; 5125 u16 tx_mcs_map = 0; 5126 u8 i; 5127 5128 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5129 if (!he_cap) 5130 return false; 5131 5132 memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX); 5133 5134 tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5135 5136 /* Build he_mcs_mask from HE capabilities */ 5137 he_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5138 5139 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5140 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5141 mcs[i] = txrate->mcs[i]; 5142 else 5143 return false; 5144 } 5145 5146 return true; 5147 } 5148 5149 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info, 5150 struct nlattr *attrs[], 5151 enum nl80211_attrs attr, 5152 struct cfg80211_bitrate_mask *mask, 5153 struct net_device *dev, 5154 bool default_all_enabled, 5155 unsigned int link_id) 5156 { 5157 struct nlattr *tb[NL80211_TXRATE_MAX + 1]; 5158 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5159 struct wireless_dev *wdev = dev->ieee80211_ptr; 5160 int rem, i; 5161 struct nlattr *tx_rates; 5162 struct ieee80211_supported_band *sband; 5163 u16 vht_tx_mcs_map, he_tx_mcs_map; 5164 5165 memset(mask, 0, sizeof(*mask)); 5166 /* Default to all rates enabled */ 5167 for (i = 0; i < NUM_NL80211_BANDS; i++) { 5168 const struct ieee80211_sta_he_cap *he_cap; 5169 5170 if (!default_all_enabled) 5171 break; 5172 5173 sband = rdev->wiphy.bands[i]; 5174 5175 if (!sband) 5176 continue; 5177 5178 mask->control[i].legacy = (1 << sband->n_bitrates) - 1; 5179 memcpy(mask->control[i].ht_mcs, 5180 sband->ht_cap.mcs.rx_mask, 5181 sizeof(mask->control[i].ht_mcs)); 5182 5183 if (sband->vht_cap.vht_supported) { 5184 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5185 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs); 5186 } 5187 5188 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5189 if (!he_cap) 5190 continue; 5191 5192 he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5193 he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs); 5194 5195 mask->control[i].he_gi = 0xFF; 5196 mask->control[i].he_ltf = 0xFF; 5197 } 5198 5199 /* if no rates are given set it back to the defaults */ 5200 if (!attrs[attr]) 5201 goto out; 5202 5203 /* The nested attribute uses enum nl80211_band as the index. This maps 5204 * directly to the enum nl80211_band values used in cfg80211. 5205 */ 5206 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8); 5207 nla_for_each_nested(tx_rates, attrs[attr], rem) { 5208 enum nl80211_band band = nla_type(tx_rates); 5209 int err; 5210 5211 if (band < 0 || band >= NUM_NL80211_BANDS) 5212 return -EINVAL; 5213 sband = rdev->wiphy.bands[band]; 5214 if (sband == NULL) 5215 return -EINVAL; 5216 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX, 5217 tx_rates, 5218 nl80211_txattr_policy, 5219 info->extack); 5220 if (err) 5221 return err; 5222 if (tb[NL80211_TXRATE_LEGACY]) { 5223 mask->control[band].legacy = rateset_to_mask( 5224 sband, 5225 nla_data(tb[NL80211_TXRATE_LEGACY]), 5226 nla_len(tb[NL80211_TXRATE_LEGACY])); 5227 if ((mask->control[band].legacy == 0) && 5228 nla_len(tb[NL80211_TXRATE_LEGACY])) 5229 return -EINVAL; 5230 } 5231 if (tb[NL80211_TXRATE_HT]) { 5232 if (!ht_rateset_to_mask( 5233 sband, 5234 nla_data(tb[NL80211_TXRATE_HT]), 5235 nla_len(tb[NL80211_TXRATE_HT]), 5236 mask->control[band].ht_mcs)) 5237 return -EINVAL; 5238 } 5239 5240 if (tb[NL80211_TXRATE_VHT]) { 5241 if (!vht_set_mcs_mask( 5242 sband, 5243 nla_data(tb[NL80211_TXRATE_VHT]), 5244 mask->control[band].vht_mcs)) 5245 return -EINVAL; 5246 } 5247 5248 if (tb[NL80211_TXRATE_GI]) { 5249 mask->control[band].gi = 5250 nla_get_u8(tb[NL80211_TXRATE_GI]); 5251 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI) 5252 return -EINVAL; 5253 } 5254 if (tb[NL80211_TXRATE_HE] && 5255 !he_set_mcs_mask(info, wdev, sband, 5256 nla_data(tb[NL80211_TXRATE_HE]), 5257 mask->control[band].he_mcs, 5258 link_id)) 5259 return -EINVAL; 5260 5261 if (tb[NL80211_TXRATE_HE_GI]) 5262 mask->control[band].he_gi = 5263 nla_get_u8(tb[NL80211_TXRATE_HE_GI]); 5264 if (tb[NL80211_TXRATE_HE_LTF]) 5265 mask->control[band].he_ltf = 5266 nla_get_u8(tb[NL80211_TXRATE_HE_LTF]); 5267 5268 if (mask->control[band].legacy == 0) { 5269 /* don't allow empty legacy rates if HT, VHT or HE 5270 * are not even supported. 5271 */ 5272 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported || 5273 rdev->wiphy.bands[band]->vht_cap.vht_supported || 5274 ieee80211_get_he_iftype_cap(sband, wdev->iftype))) 5275 return -EINVAL; 5276 5277 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) 5278 if (mask->control[band].ht_mcs[i]) 5279 goto out; 5280 5281 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) 5282 if (mask->control[band].vht_mcs[i]) 5283 goto out; 5284 5285 for (i = 0; i < NL80211_HE_NSS_MAX; i++) 5286 if (mask->control[band].he_mcs[i]) 5287 goto out; 5288 5289 /* legacy and mcs rates may not be both empty */ 5290 return -EINVAL; 5291 } 5292 } 5293 5294 out: 5295 return 0; 5296 } 5297 5298 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev, 5299 enum nl80211_band band, 5300 struct cfg80211_bitrate_mask *beacon_rate) 5301 { 5302 u32 count_ht, count_vht, count_he, i; 5303 u32 rate = beacon_rate->control[band].legacy; 5304 5305 /* Allow only one rate */ 5306 if (hweight32(rate) > 1) 5307 return -EINVAL; 5308 5309 count_ht = 0; 5310 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) { 5311 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) { 5312 return -EINVAL; 5313 } else if (beacon_rate->control[band].ht_mcs[i]) { 5314 count_ht++; 5315 if (count_ht > 1) 5316 return -EINVAL; 5317 } 5318 if (count_ht && rate) 5319 return -EINVAL; 5320 } 5321 5322 count_vht = 0; 5323 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5324 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) { 5325 return -EINVAL; 5326 } else if (beacon_rate->control[band].vht_mcs[i]) { 5327 count_vht++; 5328 if (count_vht > 1) 5329 return -EINVAL; 5330 } 5331 if (count_vht && rate) 5332 return -EINVAL; 5333 } 5334 5335 count_he = 0; 5336 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5337 if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) { 5338 return -EINVAL; 5339 } else if (beacon_rate->control[band].he_mcs[i]) { 5340 count_he++; 5341 if (count_he > 1) 5342 return -EINVAL; 5343 } 5344 if (count_he && rate) 5345 return -EINVAL; 5346 } 5347 5348 if ((count_ht && count_vht && count_he) || 5349 (!rate && !count_ht && !count_vht && !count_he)) 5350 return -EINVAL; 5351 5352 if (rate && 5353 !wiphy_ext_feature_isset(&rdev->wiphy, 5354 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) 5355 return -EINVAL; 5356 if (count_ht && 5357 !wiphy_ext_feature_isset(&rdev->wiphy, 5358 NL80211_EXT_FEATURE_BEACON_RATE_HT)) 5359 return -EINVAL; 5360 if (count_vht && 5361 !wiphy_ext_feature_isset(&rdev->wiphy, 5362 NL80211_EXT_FEATURE_BEACON_RATE_VHT)) 5363 return -EINVAL; 5364 if (count_he && 5365 !wiphy_ext_feature_isset(&rdev->wiphy, 5366 NL80211_EXT_FEATURE_BEACON_RATE_HE)) 5367 return -EINVAL; 5368 5369 return 0; 5370 } 5371 5372 static int nl80211_parse_mbssid_config(struct wiphy *wiphy, 5373 struct net_device *dev, 5374 struct nlattr *attrs, 5375 struct cfg80211_mbssid_config *config, 5376 u8 num_elems) 5377 { 5378 struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1]; 5379 5380 if (!wiphy->mbssid_max_interfaces) 5381 return -EOPNOTSUPP; 5382 5383 if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL, 5384 NULL) || 5385 !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]) 5386 return -EINVAL; 5387 5388 config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]); 5389 if (config->ema) { 5390 if (!wiphy->ema_max_profile_periodicity) 5391 return -EOPNOTSUPP; 5392 5393 if (num_elems > wiphy->ema_max_profile_periodicity) 5394 return -EINVAL; 5395 } 5396 5397 config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]); 5398 if (config->index >= wiphy->mbssid_max_interfaces || 5399 (!config->index && !num_elems)) 5400 return -EINVAL; 5401 5402 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) { 5403 u32 tx_ifindex = 5404 nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]); 5405 5406 if ((!config->index && tx_ifindex != dev->ifindex) || 5407 (config->index && tx_ifindex == dev->ifindex)) 5408 return -EINVAL; 5409 5410 if (tx_ifindex != dev->ifindex) { 5411 struct net_device *tx_netdev = 5412 dev_get_by_index(wiphy_net(wiphy), tx_ifindex); 5413 5414 if (!tx_netdev || !tx_netdev->ieee80211_ptr || 5415 tx_netdev->ieee80211_ptr->wiphy != wiphy || 5416 tx_netdev->ieee80211_ptr->iftype != 5417 NL80211_IFTYPE_AP) { 5418 dev_put(tx_netdev); 5419 return -EINVAL; 5420 } 5421 5422 config->tx_wdev = tx_netdev->ieee80211_ptr; 5423 } else { 5424 config->tx_wdev = dev->ieee80211_ptr; 5425 } 5426 } else if (!config->index) { 5427 config->tx_wdev = dev->ieee80211_ptr; 5428 } else { 5429 return -EINVAL; 5430 } 5431 5432 return 0; 5433 } 5434 5435 static struct cfg80211_mbssid_elems * 5436 nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs) 5437 { 5438 struct nlattr *nl_elems; 5439 struct cfg80211_mbssid_elems *elems; 5440 int rem_elems; 5441 u8 i = 0, num_elems = 0; 5442 5443 if (!wiphy->mbssid_max_interfaces) 5444 return ERR_PTR(-EINVAL); 5445 5446 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5447 if (num_elems >= 255) 5448 return ERR_PTR(-EINVAL); 5449 num_elems++; 5450 } 5451 5452 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5453 if (!elems) 5454 return ERR_PTR(-ENOMEM); 5455 elems->cnt = num_elems; 5456 5457 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5458 elems->elem[i].data = nla_data(nl_elems); 5459 elems->elem[i].len = nla_len(nl_elems); 5460 i++; 5461 } 5462 return elems; 5463 } 5464 5465 static struct cfg80211_rnr_elems * 5466 nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs, 5467 struct netlink_ext_ack *extack) 5468 { 5469 struct nlattr *nl_elems; 5470 struct cfg80211_rnr_elems *elems; 5471 int rem_elems; 5472 u8 i = 0, num_elems = 0; 5473 5474 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5475 int ret; 5476 5477 ret = validate_ie_attr(nl_elems, extack); 5478 if (ret) 5479 return ERR_PTR(ret); 5480 5481 num_elems++; 5482 } 5483 5484 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5485 if (!elems) 5486 return ERR_PTR(-ENOMEM); 5487 elems->cnt = num_elems; 5488 5489 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5490 elems->elem[i].data = nla_data(nl_elems); 5491 elems->elem[i].len = nla_len(nl_elems); 5492 i++; 5493 } 5494 return elems; 5495 } 5496 5497 static int nl80211_parse_he_bss_color(struct nlattr *attrs, 5498 struct cfg80211_he_bss_color *he_bss_color) 5499 { 5500 struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1]; 5501 int err; 5502 5503 err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs, 5504 he_bss_color_policy, NULL); 5505 if (err) 5506 return err; 5507 5508 if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]) 5509 return -EINVAL; 5510 5511 he_bss_color->color = 5512 nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]); 5513 he_bss_color->enabled = 5514 !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]); 5515 he_bss_color->partial = 5516 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]); 5517 5518 return 0; 5519 } 5520 5521 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev, 5522 struct nlattr *attrs[], 5523 struct cfg80211_beacon_data *bcn, 5524 struct netlink_ext_ack *extack) 5525 { 5526 bool haveinfo = false; 5527 int err; 5528 5529 memset(bcn, 0, sizeof(*bcn)); 5530 5531 bcn->link_id = nl80211_link_id(attrs); 5532 5533 if (attrs[NL80211_ATTR_BEACON_HEAD]) { 5534 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]); 5535 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]); 5536 if (!bcn->head_len) 5537 return -EINVAL; 5538 haveinfo = true; 5539 } 5540 5541 if (attrs[NL80211_ATTR_BEACON_TAIL]) { 5542 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]); 5543 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]); 5544 haveinfo = true; 5545 } 5546 5547 if (!haveinfo) 5548 return -EINVAL; 5549 5550 if (attrs[NL80211_ATTR_IE]) { 5551 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]); 5552 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]); 5553 } 5554 5555 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) { 5556 bcn->proberesp_ies = 5557 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5558 bcn->proberesp_ies_len = 5559 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5560 } 5561 5562 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) { 5563 bcn->assocresp_ies = 5564 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5565 bcn->assocresp_ies_len = 5566 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5567 } 5568 5569 if (attrs[NL80211_ATTR_PROBE_RESP]) { 5570 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]); 5571 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]); 5572 } 5573 5574 if (attrs[NL80211_ATTR_FTM_RESPONDER]) { 5575 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1]; 5576 5577 err = nla_parse_nested_deprecated(tb, 5578 NL80211_FTM_RESP_ATTR_MAX, 5579 attrs[NL80211_ATTR_FTM_RESPONDER], 5580 NULL, NULL); 5581 if (err) 5582 return err; 5583 5584 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] && 5585 wiphy_ext_feature_isset(&rdev->wiphy, 5586 NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER)) 5587 bcn->ftm_responder = 1; 5588 else 5589 return -EOPNOTSUPP; 5590 5591 if (tb[NL80211_FTM_RESP_ATTR_LCI]) { 5592 bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]); 5593 bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]); 5594 } 5595 5596 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) { 5597 bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5598 bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5599 } 5600 } else { 5601 bcn->ftm_responder = -1; 5602 } 5603 5604 if (attrs[NL80211_ATTR_HE_BSS_COLOR]) { 5605 err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR], 5606 &bcn->he_bss_color); 5607 if (err) 5608 return err; 5609 bcn->he_bss_color_valid = true; 5610 } 5611 5612 if (attrs[NL80211_ATTR_MBSSID_ELEMS]) { 5613 struct cfg80211_mbssid_elems *mbssid = 5614 nl80211_parse_mbssid_elems(&rdev->wiphy, 5615 attrs[NL80211_ATTR_MBSSID_ELEMS]); 5616 5617 if (IS_ERR(mbssid)) 5618 return PTR_ERR(mbssid); 5619 5620 bcn->mbssid_ies = mbssid; 5621 5622 if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) { 5623 struct cfg80211_rnr_elems *rnr = 5624 nl80211_parse_rnr_elems(&rdev->wiphy, 5625 attrs[NL80211_ATTR_EMA_RNR_ELEMS], 5626 extack); 5627 5628 if (IS_ERR(rnr)) 5629 return PTR_ERR(rnr); 5630 5631 if (rnr && rnr->cnt < bcn->mbssid_ies->cnt) 5632 return -EINVAL; 5633 5634 bcn->rnr_ies = rnr; 5635 } 5636 } 5637 5638 return 0; 5639 } 5640 5641 static int nl80211_parse_he_obss_pd(struct nlattr *attrs, 5642 struct ieee80211_he_obss_pd *he_obss_pd) 5643 { 5644 struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1]; 5645 int err; 5646 5647 err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs, 5648 he_obss_pd_policy, NULL); 5649 if (err) 5650 return err; 5651 5652 if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]) 5653 return -EINVAL; 5654 5655 he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]); 5656 5657 if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]) 5658 he_obss_pd->min_offset = 5659 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]); 5660 if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]) 5661 he_obss_pd->max_offset = 5662 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]); 5663 if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]) 5664 he_obss_pd->non_srg_max_offset = 5665 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]); 5666 5667 if (he_obss_pd->min_offset > he_obss_pd->max_offset) 5668 return -EINVAL; 5669 5670 if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]) 5671 memcpy(he_obss_pd->bss_color_bitmap, 5672 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]), 5673 sizeof(he_obss_pd->bss_color_bitmap)); 5674 5675 if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]) 5676 memcpy(he_obss_pd->partial_bssid_bitmap, 5677 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]), 5678 sizeof(he_obss_pd->partial_bssid_bitmap)); 5679 5680 he_obss_pd->enable = true; 5681 5682 return 0; 5683 } 5684 5685 static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev, 5686 struct nlattr *attrs, 5687 struct cfg80211_fils_discovery *fd) 5688 { 5689 struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1]; 5690 int ret; 5691 5692 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5693 NL80211_EXT_FEATURE_FILS_DISCOVERY)) 5694 return -EINVAL; 5695 5696 ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs, 5697 NULL, NULL); 5698 if (ret) 5699 return ret; 5700 5701 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] && 5702 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] && 5703 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) { 5704 fd->update = true; 5705 return 0; 5706 } 5707 5708 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] || 5709 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] || 5710 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) 5711 return -EINVAL; 5712 5713 fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5714 fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5715 fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]); 5716 fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]); 5717 fd->update = true; 5718 return 0; 5719 } 5720 5721 static int 5722 nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev, 5723 struct nlattr *attrs, 5724 struct cfg80211_unsol_bcast_probe_resp *presp) 5725 { 5726 struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1]; 5727 int ret; 5728 5729 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5730 NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP)) 5731 return -EINVAL; 5732 5733 ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX, 5734 attrs, NULL, NULL); 5735 if (ret) 5736 return ret; 5737 5738 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] && 5739 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) { 5740 presp->update = true; 5741 return 0; 5742 } 5743 5744 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] || 5745 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) 5746 return -EINVAL; 5747 5748 presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5749 presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5750 presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]); 5751 presp->update = true; 5752 return 0; 5753 } 5754 5755 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params, 5756 const struct element *rates) 5757 { 5758 int i; 5759 5760 if (!rates) 5761 return; 5762 5763 for (i = 0; i < rates->datalen; i++) { 5764 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY) 5765 params->ht_required = true; 5766 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY) 5767 params->vht_required = true; 5768 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY) 5769 params->he_required = true; 5770 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E) 5771 params->sae_h2e_required = true; 5772 } 5773 } 5774 5775 /* 5776 * Since the nl80211 API didn't include, from the beginning, attributes about 5777 * HT/VHT requirements/capabilities, we parse them out of the IEs for the 5778 * benefit of drivers that rebuild IEs in the firmware. 5779 */ 5780 static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params) 5781 { 5782 const struct cfg80211_beacon_data *bcn = ¶ms->beacon; 5783 size_t ies_len = bcn->tail_len; 5784 const u8 *ies = bcn->tail; 5785 const struct element *rates; 5786 const struct element *cap; 5787 5788 rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len); 5789 nl80211_check_ap_rate_selectors(params, rates); 5790 5791 rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len); 5792 nl80211_check_ap_rate_selectors(params, rates); 5793 5794 cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len); 5795 if (cap && cap->datalen >= sizeof(*params->ht_cap)) 5796 params->ht_cap = (void *)cap->data; 5797 cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len); 5798 if (cap && cap->datalen >= sizeof(*params->vht_cap)) 5799 params->vht_cap = (void *)cap->data; 5800 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len); 5801 if (cap && cap->datalen >= sizeof(*params->he_cap) + 1) 5802 params->he_cap = (void *)(cap->data + 1); 5803 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len); 5804 if (cap && cap->datalen >= sizeof(*params->he_oper) + 1) 5805 params->he_oper = (void *)(cap->data + 1); 5806 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len); 5807 if (cap) { 5808 if (!cap->datalen) 5809 return -EINVAL; 5810 params->eht_cap = (void *)(cap->data + 1); 5811 if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap, 5812 (const u8 *)params->eht_cap, 5813 cap->datalen - 1, true)) 5814 return -EINVAL; 5815 } 5816 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len); 5817 if (cap) { 5818 if (!cap->datalen) 5819 return -EINVAL; 5820 params->eht_oper = (void *)(cap->data + 1); 5821 if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper, 5822 cap->datalen - 1)) 5823 return -EINVAL; 5824 } 5825 return 0; 5826 } 5827 5828 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev, 5829 struct cfg80211_ap_settings *params) 5830 { 5831 struct wireless_dev *wdev; 5832 5833 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 5834 if (wdev->iftype != NL80211_IFTYPE_AP && 5835 wdev->iftype != NL80211_IFTYPE_P2P_GO) 5836 continue; 5837 5838 if (!wdev->u.ap.preset_chandef.chan) 5839 continue; 5840 5841 params->chandef = wdev->u.ap.preset_chandef; 5842 return true; 5843 } 5844 5845 return false; 5846 } 5847 5848 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev, 5849 enum nl80211_auth_type auth_type, 5850 enum nl80211_commands cmd) 5851 { 5852 if (auth_type > NL80211_AUTHTYPE_MAX) 5853 return false; 5854 5855 switch (cmd) { 5856 case NL80211_CMD_AUTHENTICATE: 5857 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 5858 auth_type == NL80211_AUTHTYPE_SAE) 5859 return false; 5860 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5861 NL80211_EXT_FEATURE_FILS_STA) && 5862 (auth_type == NL80211_AUTHTYPE_FILS_SK || 5863 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5864 auth_type == NL80211_AUTHTYPE_FILS_PK)) 5865 return false; 5866 return true; 5867 case NL80211_CMD_CONNECT: 5868 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 5869 !wiphy_ext_feature_isset(&rdev->wiphy, 5870 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 5871 auth_type == NL80211_AUTHTYPE_SAE) 5872 return false; 5873 5874 /* FILS with SK PFS or PK not supported yet */ 5875 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5876 auth_type == NL80211_AUTHTYPE_FILS_PK) 5877 return false; 5878 if (!wiphy_ext_feature_isset( 5879 &rdev->wiphy, 5880 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 5881 auth_type == NL80211_AUTHTYPE_FILS_SK) 5882 return false; 5883 return true; 5884 case NL80211_CMD_START_AP: 5885 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5886 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) && 5887 auth_type == NL80211_AUTHTYPE_SAE) 5888 return false; 5889 /* FILS not supported yet */ 5890 if (auth_type == NL80211_AUTHTYPE_FILS_SK || 5891 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5892 auth_type == NL80211_AUTHTYPE_FILS_PK) 5893 return false; 5894 return true; 5895 default: 5896 return false; 5897 } 5898 } 5899 5900 static void nl80211_send_ap_started(struct wireless_dev *wdev, 5901 unsigned int link_id) 5902 { 5903 struct wiphy *wiphy = wdev->wiphy; 5904 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 5905 struct sk_buff *msg; 5906 void *hdr; 5907 5908 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 5909 if (!msg) 5910 return; 5911 5912 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP); 5913 if (!hdr) 5914 goto out; 5915 5916 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 5917 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 5918 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 5919 NL80211_ATTR_PAD) || 5920 (wdev->u.ap.ssid_len && 5921 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 5922 wdev->u.ap.ssid)) || 5923 (wdev->valid_links && 5924 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 5925 goto out; 5926 5927 genlmsg_end(msg, hdr); 5928 5929 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 5930 NL80211_MCGRP_MLME, GFP_KERNEL); 5931 return; 5932 out: 5933 nlmsg_free(msg); 5934 } 5935 5936 static int nl80211_validate_ap_phy_operation(struct cfg80211_ap_settings *params) 5937 { 5938 struct ieee80211_channel *channel = params->chandef.chan; 5939 5940 if ((params->he_cap || params->he_oper) && 5941 (channel->flags & IEEE80211_CHAN_NO_HE)) 5942 return -EOPNOTSUPP; 5943 5944 if ((params->eht_cap || params->eht_oper) && 5945 (channel->flags & IEEE80211_CHAN_NO_EHT)) 5946 return -EOPNOTSUPP; 5947 5948 return 0; 5949 } 5950 5951 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info) 5952 { 5953 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5954 unsigned int link_id = nl80211_link_id(info->attrs); 5955 struct net_device *dev = info->user_ptr[1]; 5956 struct wireless_dev *wdev = dev->ieee80211_ptr; 5957 struct cfg80211_ap_settings *params; 5958 int err; 5959 5960 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 5961 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 5962 return -EOPNOTSUPP; 5963 5964 if (!rdev->ops->start_ap) 5965 return -EOPNOTSUPP; 5966 5967 if (wdev->links[link_id].ap.beacon_interval) 5968 return -EALREADY; 5969 5970 /* these are required for START_AP */ 5971 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] || 5972 !info->attrs[NL80211_ATTR_DTIM_PERIOD] || 5973 !info->attrs[NL80211_ATTR_BEACON_HEAD]) 5974 return -EINVAL; 5975 5976 params = kzalloc(sizeof(*params), GFP_KERNEL); 5977 if (!params) 5978 return -ENOMEM; 5979 5980 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 5981 info->extack); 5982 if (err) 5983 goto out; 5984 5985 params->beacon_interval = 5986 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 5987 params->dtim_period = 5988 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 5989 5990 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype, 5991 params->beacon_interval); 5992 if (err) 5993 goto out; 5994 5995 /* 5996 * In theory, some of these attributes should be required here 5997 * but since they were not used when the command was originally 5998 * added, keep them optional for old user space programs to let 5999 * them continue to work with drivers that do not need the 6000 * additional information -- drivers must check! 6001 */ 6002 if (info->attrs[NL80211_ATTR_SSID]) { 6003 params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 6004 params->ssid_len = 6005 nla_len(info->attrs[NL80211_ATTR_SSID]); 6006 if (params->ssid_len == 0) { 6007 err = -EINVAL; 6008 goto out; 6009 } 6010 6011 if (wdev->u.ap.ssid_len && 6012 (wdev->u.ap.ssid_len != params->ssid_len || 6013 memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) { 6014 /* require identical SSID for MLO */ 6015 err = -EINVAL; 6016 goto out; 6017 } 6018 } else if (wdev->valid_links) { 6019 /* require SSID for MLO */ 6020 err = -EINVAL; 6021 goto out; 6022 } 6023 6024 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) 6025 params->hidden_ssid = nla_get_u32( 6026 info->attrs[NL80211_ATTR_HIDDEN_SSID]); 6027 6028 params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 6029 6030 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 6031 params->auth_type = nla_get_u32( 6032 info->attrs[NL80211_ATTR_AUTH_TYPE]); 6033 if (!nl80211_valid_auth_type(rdev, params->auth_type, 6034 NL80211_CMD_START_AP)) { 6035 err = -EINVAL; 6036 goto out; 6037 } 6038 } else 6039 params->auth_type = NL80211_AUTHTYPE_AUTOMATIC; 6040 6041 err = nl80211_crypto_settings(rdev, info, ¶ms->crypto, 6042 NL80211_MAX_NR_CIPHER_SUITES); 6043 if (err) 6044 goto out; 6045 6046 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) { 6047 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) { 6048 err = -EOPNOTSUPP; 6049 goto out; 6050 } 6051 params->inactivity_timeout = nla_get_u16( 6052 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]); 6053 } 6054 6055 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 6056 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6057 err = -EINVAL; 6058 goto out; 6059 } 6060 params->p2p_ctwindow = 6061 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 6062 if (params->p2p_ctwindow != 0 && 6063 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) { 6064 err = -EINVAL; 6065 goto out; 6066 } 6067 } 6068 6069 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 6070 u8 tmp; 6071 6072 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6073 err = -EINVAL; 6074 goto out; 6075 } 6076 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 6077 params->p2p_opp_ps = tmp; 6078 if (params->p2p_opp_ps != 0 && 6079 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) { 6080 err = -EINVAL; 6081 goto out; 6082 } 6083 } 6084 6085 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 6086 err = nl80211_parse_chandef(rdev, info, ¶ms->chandef); 6087 if (err) 6088 goto out; 6089 } else if (wdev->valid_links) { 6090 /* with MLD need to specify the channel configuration */ 6091 err = -EINVAL; 6092 goto out; 6093 } else if (wdev->u.ap.preset_chandef.chan) { 6094 params->chandef = wdev->u.ap.preset_chandef; 6095 } else if (!nl80211_get_ap_channel(rdev, params)) { 6096 err = -EINVAL; 6097 goto out; 6098 } 6099 6100 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms->chandef, 6101 wdev->iftype)) { 6102 err = -EINVAL; 6103 goto out; 6104 } 6105 6106 if (info->attrs[NL80211_ATTR_TX_RATES]) { 6107 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 6108 NL80211_ATTR_TX_RATES, 6109 ¶ms->beacon_rate, 6110 dev, false, link_id); 6111 if (err) 6112 goto out; 6113 6114 err = validate_beacon_tx_rate(rdev, params->chandef.chan->band, 6115 ¶ms->beacon_rate); 6116 if (err) 6117 goto out; 6118 } 6119 6120 if (info->attrs[NL80211_ATTR_SMPS_MODE]) { 6121 params->smps_mode = 6122 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]); 6123 switch (params->smps_mode) { 6124 case NL80211_SMPS_OFF: 6125 break; 6126 case NL80211_SMPS_STATIC: 6127 if (!(rdev->wiphy.features & 6128 NL80211_FEATURE_STATIC_SMPS)) { 6129 err = -EINVAL; 6130 goto out; 6131 } 6132 break; 6133 case NL80211_SMPS_DYNAMIC: 6134 if (!(rdev->wiphy.features & 6135 NL80211_FEATURE_DYNAMIC_SMPS)) { 6136 err = -EINVAL; 6137 goto out; 6138 } 6139 break; 6140 default: 6141 err = -EINVAL; 6142 goto out; 6143 } 6144 } else { 6145 params->smps_mode = NL80211_SMPS_OFF; 6146 } 6147 6148 params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 6149 if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 6150 err = -EOPNOTSUPP; 6151 goto out; 6152 } 6153 6154 if (info->attrs[NL80211_ATTR_ACL_POLICY]) { 6155 params->acl = parse_acl_data(&rdev->wiphy, info); 6156 if (IS_ERR(params->acl)) { 6157 err = PTR_ERR(params->acl); 6158 params->acl = NULL; 6159 goto out; 6160 } 6161 } 6162 6163 params->twt_responder = 6164 nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]); 6165 6166 if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) { 6167 err = nl80211_parse_he_obss_pd( 6168 info->attrs[NL80211_ATTR_HE_OBSS_PD], 6169 ¶ms->he_obss_pd); 6170 if (err) 6171 goto out; 6172 } 6173 6174 if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) { 6175 err = nl80211_parse_fils_discovery(rdev, 6176 info->attrs[NL80211_ATTR_FILS_DISCOVERY], 6177 ¶ms->fils_discovery); 6178 if (err) 6179 goto out; 6180 } 6181 6182 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 6183 err = nl80211_parse_unsol_bcast_probe_resp( 6184 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 6185 ¶ms->unsol_bcast_probe_resp); 6186 if (err) 6187 goto out; 6188 } 6189 6190 if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) { 6191 err = nl80211_parse_mbssid_config(&rdev->wiphy, dev, 6192 info->attrs[NL80211_ATTR_MBSSID_CONFIG], 6193 ¶ms->mbssid_config, 6194 params->beacon.mbssid_ies ? 6195 params->beacon.mbssid_ies->cnt : 6196 0); 6197 if (err) 6198 goto out; 6199 } 6200 6201 if (!params->mbssid_config.ema && params->beacon.rnr_ies) { 6202 err = -EINVAL; 6203 goto out; 6204 } 6205 6206 err = nl80211_calculate_ap_params(params); 6207 if (err) 6208 goto out; 6209 6210 err = nl80211_validate_ap_phy_operation(params); 6211 if (err) 6212 goto out; 6213 6214 if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]) 6215 params->flags = nla_get_u32( 6216 info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]); 6217 else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT]) 6218 params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT; 6219 6220 if (wdev->conn_owner_nlportid && 6221 info->attrs[NL80211_ATTR_SOCKET_OWNER] && 6222 wdev->conn_owner_nlportid != info->snd_portid) { 6223 err = -EINVAL; 6224 goto out; 6225 } 6226 6227 /* FIXME: validate MLO/link-id against driver capabilities */ 6228 6229 err = rdev_start_ap(rdev, dev, params); 6230 if (!err) { 6231 wdev->links[link_id].ap.beacon_interval = params->beacon_interval; 6232 wdev->links[link_id].ap.chandef = params->chandef; 6233 wdev->u.ap.ssid_len = params->ssid_len; 6234 memcpy(wdev->u.ap.ssid, params->ssid, 6235 params->ssid_len); 6236 6237 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 6238 wdev->conn_owner_nlportid = info->snd_portid; 6239 6240 nl80211_send_ap_started(wdev, link_id); 6241 } 6242 out: 6243 kfree(params->acl); 6244 kfree(params->beacon.mbssid_ies); 6245 if (params->mbssid_config.tx_wdev && 6246 params->mbssid_config.tx_wdev->netdev && 6247 params->mbssid_config.tx_wdev->netdev != dev) 6248 dev_put(params->mbssid_config.tx_wdev->netdev); 6249 kfree(params->beacon.rnr_ies); 6250 kfree(params); 6251 6252 return err; 6253 } 6254 6255 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info) 6256 { 6257 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6258 unsigned int link_id = nl80211_link_id(info->attrs); 6259 struct net_device *dev = info->user_ptr[1]; 6260 struct wireless_dev *wdev = dev->ieee80211_ptr; 6261 struct cfg80211_ap_update *params; 6262 struct nlattr *attr; 6263 int err; 6264 6265 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6266 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6267 return -EOPNOTSUPP; 6268 6269 if (!rdev->ops->change_beacon) 6270 return -EOPNOTSUPP; 6271 6272 if (!wdev->links[link_id].ap.beacon_interval) 6273 return -EINVAL; 6274 6275 params = kzalloc(sizeof(*params), GFP_KERNEL); 6276 if (!params) 6277 return -ENOMEM; 6278 6279 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6280 info->extack); 6281 if (err) 6282 goto out; 6283 6284 attr = info->attrs[NL80211_ATTR_FILS_DISCOVERY]; 6285 if (attr) { 6286 err = nl80211_parse_fils_discovery(rdev, attr, 6287 ¶ms->fils_discovery); 6288 if (err) 6289 goto out; 6290 } 6291 6292 attr = info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]; 6293 if (attr) { 6294 err = nl80211_parse_unsol_bcast_probe_resp(rdev, attr, 6295 ¶ms->unsol_bcast_probe_resp); 6296 if (err) 6297 goto out; 6298 } 6299 6300 err = rdev_change_beacon(rdev, dev, params); 6301 6302 out: 6303 kfree(params->beacon.mbssid_ies); 6304 kfree(params->beacon.rnr_ies); 6305 kfree(params); 6306 return err; 6307 } 6308 6309 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info) 6310 { 6311 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6312 unsigned int link_id = nl80211_link_id(info->attrs); 6313 struct net_device *dev = info->user_ptr[1]; 6314 6315 return cfg80211_stop_ap(rdev, dev, link_id, false); 6316 } 6317 6318 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = { 6319 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG }, 6320 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG }, 6321 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG }, 6322 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG }, 6323 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG }, 6324 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG }, 6325 }; 6326 6327 static int parse_station_flags(struct genl_info *info, 6328 enum nl80211_iftype iftype, 6329 struct station_parameters *params) 6330 { 6331 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1]; 6332 struct nlattr *nla; 6333 int flag; 6334 6335 /* 6336 * Try parsing the new attribute first so userspace 6337 * can specify both for older kernels. 6338 */ 6339 nla = info->attrs[NL80211_ATTR_STA_FLAGS2]; 6340 if (nla) { 6341 struct nl80211_sta_flag_update *sta_flags; 6342 6343 sta_flags = nla_data(nla); 6344 params->sta_flags_mask = sta_flags->mask; 6345 params->sta_flags_set = sta_flags->set; 6346 params->sta_flags_set &= params->sta_flags_mask; 6347 if ((params->sta_flags_mask | 6348 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID)) 6349 return -EINVAL; 6350 return 0; 6351 } 6352 6353 /* if present, parse the old attribute */ 6354 6355 nla = info->attrs[NL80211_ATTR_STA_FLAGS]; 6356 if (!nla) 6357 return 0; 6358 6359 if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack)) 6360 return -EINVAL; 6361 6362 /* 6363 * Only allow certain flags for interface types so that 6364 * other attributes are silently ignored. Remember that 6365 * this is backward compatibility code with old userspace 6366 * and shouldn't be hit in other cases anyway. 6367 */ 6368 switch (iftype) { 6369 case NL80211_IFTYPE_AP: 6370 case NL80211_IFTYPE_AP_VLAN: 6371 case NL80211_IFTYPE_P2P_GO: 6372 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6373 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6374 BIT(NL80211_STA_FLAG_WME) | 6375 BIT(NL80211_STA_FLAG_MFP); 6376 break; 6377 case NL80211_IFTYPE_P2P_CLIENT: 6378 case NL80211_IFTYPE_STATION: 6379 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6380 BIT(NL80211_STA_FLAG_TDLS_PEER); 6381 break; 6382 case NL80211_IFTYPE_MESH_POINT: 6383 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6384 BIT(NL80211_STA_FLAG_MFP) | 6385 BIT(NL80211_STA_FLAG_AUTHORIZED); 6386 break; 6387 default: 6388 return -EINVAL; 6389 } 6390 6391 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) { 6392 if (flags[flag]) { 6393 params->sta_flags_set |= (1<<flag); 6394 6395 /* no longer support new API additions in old API */ 6396 if (flag > NL80211_STA_FLAG_MAX_OLD_API) 6397 return -EINVAL; 6398 } 6399 } 6400 6401 return 0; 6402 } 6403 6404 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr) 6405 { 6406 struct nlattr *rate; 6407 u32 bitrate; 6408 u16 bitrate_compat; 6409 enum nl80211_rate_info rate_flg; 6410 6411 rate = nla_nest_start_noflag(msg, attr); 6412 if (!rate) 6413 return false; 6414 6415 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */ 6416 bitrate = cfg80211_calculate_bitrate(info); 6417 /* report 16-bit bitrate only if we can */ 6418 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0; 6419 if (bitrate > 0 && 6420 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate)) 6421 return false; 6422 if (bitrate_compat > 0 && 6423 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat)) 6424 return false; 6425 6426 switch (info->bw) { 6427 case RATE_INFO_BW_1: 6428 rate_flg = NL80211_RATE_INFO_1_MHZ_WIDTH; 6429 break; 6430 case RATE_INFO_BW_2: 6431 rate_flg = NL80211_RATE_INFO_2_MHZ_WIDTH; 6432 break; 6433 case RATE_INFO_BW_4: 6434 rate_flg = NL80211_RATE_INFO_4_MHZ_WIDTH; 6435 break; 6436 case RATE_INFO_BW_5: 6437 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH; 6438 break; 6439 case RATE_INFO_BW_8: 6440 rate_flg = NL80211_RATE_INFO_8_MHZ_WIDTH; 6441 break; 6442 case RATE_INFO_BW_10: 6443 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH; 6444 break; 6445 case RATE_INFO_BW_16: 6446 rate_flg = NL80211_RATE_INFO_16_MHZ_WIDTH; 6447 break; 6448 default: 6449 WARN_ON(1); 6450 fallthrough; 6451 case RATE_INFO_BW_20: 6452 rate_flg = 0; 6453 break; 6454 case RATE_INFO_BW_40: 6455 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH; 6456 break; 6457 case RATE_INFO_BW_80: 6458 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH; 6459 break; 6460 case RATE_INFO_BW_160: 6461 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH; 6462 break; 6463 case RATE_INFO_BW_HE_RU: 6464 rate_flg = 0; 6465 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS)); 6466 break; 6467 case RATE_INFO_BW_320: 6468 rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH; 6469 break; 6470 case RATE_INFO_BW_EHT_RU: 6471 rate_flg = 0; 6472 WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS)); 6473 break; 6474 } 6475 6476 if (rate_flg && nla_put_flag(msg, rate_flg)) 6477 return false; 6478 6479 if (info->flags & RATE_INFO_FLAGS_MCS) { 6480 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs)) 6481 return false; 6482 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6483 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6484 return false; 6485 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) { 6486 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs)) 6487 return false; 6488 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss)) 6489 return false; 6490 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6491 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6492 return false; 6493 } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) { 6494 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs)) 6495 return false; 6496 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss)) 6497 return false; 6498 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi)) 6499 return false; 6500 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm)) 6501 return false; 6502 if (info->bw == RATE_INFO_BW_HE_RU && 6503 nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC, 6504 info->he_ru_alloc)) 6505 return false; 6506 } else if (info->flags & RATE_INFO_FLAGS_S1G_MCS) { 6507 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_MCS, info->mcs)) 6508 return false; 6509 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_NSS, info->nss)) 6510 return false; 6511 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6512 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6513 return false; 6514 } else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) { 6515 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs)) 6516 return false; 6517 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss)) 6518 return false; 6519 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi)) 6520 return false; 6521 if (info->bw == RATE_INFO_BW_EHT_RU && 6522 nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC, 6523 info->eht_ru_alloc)) 6524 return false; 6525 } 6526 6527 nla_nest_end(msg, rate); 6528 return true; 6529 } 6530 6531 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal, 6532 int id) 6533 { 6534 void *attr; 6535 int i = 0; 6536 6537 if (!mask) 6538 return true; 6539 6540 attr = nla_nest_start_noflag(msg, id); 6541 if (!attr) 6542 return false; 6543 6544 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { 6545 if (!(mask & BIT(i))) 6546 continue; 6547 6548 if (nla_put_u8(msg, i, signal[i])) 6549 return false; 6550 } 6551 6552 nla_nest_end(msg, attr); 6553 6554 return true; 6555 } 6556 6557 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid, 6558 u32 seq, int flags, 6559 struct cfg80211_registered_device *rdev, 6560 struct net_device *dev, 6561 const u8 *mac_addr, struct station_info *sinfo) 6562 { 6563 void *hdr; 6564 struct nlattr *sinfoattr, *bss_param; 6565 6566 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 6567 if (!hdr) { 6568 cfg80211_sinfo_release_content(sinfo); 6569 return -1; 6570 } 6571 6572 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 6573 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 6574 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation)) 6575 goto nla_put_failure; 6576 6577 sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 6578 if (!sinfoattr) 6579 goto nla_put_failure; 6580 6581 #define PUT_SINFO(attr, memb, type) do { \ 6582 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 6583 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6584 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 6585 sinfo->memb)) \ 6586 goto nla_put_failure; \ 6587 } while (0) 6588 #define PUT_SINFO_U64(attr, memb) do { \ 6589 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6590 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 6591 sinfo->memb, NL80211_STA_INFO_PAD)) \ 6592 goto nla_put_failure; \ 6593 } while (0) 6594 6595 PUT_SINFO(CONNECTED_TIME, connected_time, u32); 6596 PUT_SINFO(INACTIVE_TIME, inactive_time, u32); 6597 PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at); 6598 6599 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 6600 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 6601 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 6602 (u32)sinfo->rx_bytes)) 6603 goto nla_put_failure; 6604 6605 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 6606 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 6607 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 6608 (u32)sinfo->tx_bytes)) 6609 goto nla_put_failure; 6610 6611 PUT_SINFO_U64(RX_BYTES64, rx_bytes); 6612 PUT_SINFO_U64(TX_BYTES64, tx_bytes); 6613 PUT_SINFO(LLID, llid, u16); 6614 PUT_SINFO(PLID, plid, u16); 6615 PUT_SINFO(PLINK_STATE, plink_state, u8); 6616 PUT_SINFO_U64(RX_DURATION, rx_duration); 6617 PUT_SINFO_U64(TX_DURATION, tx_duration); 6618 6619 if (wiphy_ext_feature_isset(&rdev->wiphy, 6620 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 6621 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 6622 6623 switch (rdev->wiphy.signal_type) { 6624 case CFG80211_SIGNAL_TYPE_MBM: 6625 PUT_SINFO(SIGNAL, signal, u8); 6626 PUT_SINFO(SIGNAL_AVG, signal_avg, u8); 6627 break; 6628 default: 6629 break; 6630 } 6631 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 6632 if (!nl80211_put_signal(msg, sinfo->chains, 6633 sinfo->chain_signal, 6634 NL80211_STA_INFO_CHAIN_SIGNAL)) 6635 goto nla_put_failure; 6636 } 6637 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 6638 if (!nl80211_put_signal(msg, sinfo->chains, 6639 sinfo->chain_signal_avg, 6640 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 6641 goto nla_put_failure; 6642 } 6643 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 6644 if (!nl80211_put_sta_rate(msg, &sinfo->txrate, 6645 NL80211_STA_INFO_TX_BITRATE)) 6646 goto nla_put_failure; 6647 } 6648 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 6649 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate, 6650 NL80211_STA_INFO_RX_BITRATE)) 6651 goto nla_put_failure; 6652 } 6653 6654 PUT_SINFO(RX_PACKETS, rx_packets, u32); 6655 PUT_SINFO(TX_PACKETS, tx_packets, u32); 6656 PUT_SINFO(TX_RETRIES, tx_retries, u32); 6657 PUT_SINFO(TX_FAILED, tx_failed, u32); 6658 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 6659 PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32); 6660 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32); 6661 PUT_SINFO(LOCAL_PM, local_pm, u32); 6662 PUT_SINFO(PEER_PM, peer_pm, u32); 6663 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32); 6664 PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8); 6665 PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8); 6666 6667 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 6668 bss_param = nla_nest_start_noflag(msg, 6669 NL80211_STA_INFO_BSS_PARAM); 6670 if (!bss_param) 6671 goto nla_put_failure; 6672 6673 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) && 6674 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 6675 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 6676 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 6677 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 6678 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 6679 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 6680 sinfo->bss_param.dtim_period) || 6681 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 6682 sinfo->bss_param.beacon_interval)) 6683 goto nla_put_failure; 6684 6685 nla_nest_end(msg, bss_param); 6686 } 6687 if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) && 6688 nla_put(msg, NL80211_STA_INFO_STA_FLAGS, 6689 sizeof(struct nl80211_sta_flag_update), 6690 &sinfo->sta_flags)) 6691 goto nla_put_failure; 6692 6693 PUT_SINFO_U64(T_OFFSET, t_offset); 6694 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 6695 PUT_SINFO_U64(BEACON_RX, rx_beacon); 6696 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 6697 PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32); 6698 PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 6699 if (wiphy_ext_feature_isset(&rdev->wiphy, 6700 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 6701 PUT_SINFO(ACK_SIGNAL, ack_signal, u8); 6702 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 6703 } 6704 6705 #undef PUT_SINFO 6706 #undef PUT_SINFO_U64 6707 6708 if (sinfo->pertid) { 6709 struct nlattr *tidsattr; 6710 int tid; 6711 6712 tidsattr = nla_nest_start_noflag(msg, 6713 NL80211_STA_INFO_TID_STATS); 6714 if (!tidsattr) 6715 goto nla_put_failure; 6716 6717 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 6718 struct cfg80211_tid_stats *tidstats; 6719 struct nlattr *tidattr; 6720 6721 tidstats = &sinfo->pertid[tid]; 6722 6723 if (!tidstats->filled) 6724 continue; 6725 6726 tidattr = nla_nest_start_noflag(msg, tid + 1); 6727 if (!tidattr) 6728 goto nla_put_failure; 6729 6730 #define PUT_TIDVAL_U64(attr, memb) do { \ 6731 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 6732 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 6733 tidstats->memb, NL80211_TID_STATS_PAD)) \ 6734 goto nla_put_failure; \ 6735 } while (0) 6736 6737 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 6738 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 6739 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 6740 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 6741 6742 #undef PUT_TIDVAL_U64 6743 if ((tidstats->filled & 6744 BIT(NL80211_TID_STATS_TXQ_STATS)) && 6745 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 6746 NL80211_TID_STATS_TXQ_STATS)) 6747 goto nla_put_failure; 6748 6749 nla_nest_end(msg, tidattr); 6750 } 6751 6752 nla_nest_end(msg, tidsattr); 6753 } 6754 6755 nla_nest_end(msg, sinfoattr); 6756 6757 if (sinfo->assoc_req_ies_len && 6758 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len, 6759 sinfo->assoc_req_ies)) 6760 goto nla_put_failure; 6761 6762 if (sinfo->assoc_resp_ies_len && 6763 nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len, 6764 sinfo->assoc_resp_ies)) 6765 goto nla_put_failure; 6766 6767 if (sinfo->mlo_params_valid) { 6768 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 6769 sinfo->assoc_link_id)) 6770 goto nla_put_failure; 6771 6772 if (!is_zero_ether_addr(sinfo->mld_addr) && 6773 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 6774 sinfo->mld_addr)) 6775 goto nla_put_failure; 6776 } 6777 6778 cfg80211_sinfo_release_content(sinfo); 6779 genlmsg_end(msg, hdr); 6780 return 0; 6781 6782 nla_put_failure: 6783 cfg80211_sinfo_release_content(sinfo); 6784 genlmsg_cancel(msg, hdr); 6785 return -EMSGSIZE; 6786 } 6787 6788 static int nl80211_dump_station(struct sk_buff *skb, 6789 struct netlink_callback *cb) 6790 { 6791 struct station_info sinfo; 6792 struct cfg80211_registered_device *rdev; 6793 struct wireless_dev *wdev; 6794 u8 mac_addr[ETH_ALEN]; 6795 int sta_idx = cb->args[2]; 6796 int err; 6797 6798 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 6799 if (err) 6800 return err; 6801 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 6802 __acquire(&rdev->wiphy.mtx); 6803 6804 if (!wdev->netdev) { 6805 err = -EINVAL; 6806 goto out_err; 6807 } 6808 6809 if (!rdev->ops->dump_station) { 6810 err = -EOPNOTSUPP; 6811 goto out_err; 6812 } 6813 6814 while (1) { 6815 memset(&sinfo, 0, sizeof(sinfo)); 6816 err = rdev_dump_station(rdev, wdev->netdev, sta_idx, 6817 mac_addr, &sinfo); 6818 if (err == -ENOENT) 6819 break; 6820 if (err) 6821 goto out_err; 6822 6823 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION, 6824 NETLINK_CB(cb->skb).portid, 6825 cb->nlh->nlmsg_seq, NLM_F_MULTI, 6826 rdev, wdev->netdev, mac_addr, 6827 &sinfo) < 0) 6828 goto out; 6829 6830 sta_idx++; 6831 } 6832 6833 out: 6834 cb->args[2] = sta_idx; 6835 err = skb->len; 6836 out_err: 6837 wiphy_unlock(&rdev->wiphy); 6838 6839 return err; 6840 } 6841 6842 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info) 6843 { 6844 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6845 struct net_device *dev = info->user_ptr[1]; 6846 struct station_info sinfo; 6847 struct sk_buff *msg; 6848 u8 *mac_addr = NULL; 6849 int err; 6850 6851 memset(&sinfo, 0, sizeof(sinfo)); 6852 6853 if (!info->attrs[NL80211_ATTR_MAC]) 6854 return -EINVAL; 6855 6856 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 6857 6858 if (!rdev->ops->get_station) 6859 return -EOPNOTSUPP; 6860 6861 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 6862 if (err) 6863 return err; 6864 6865 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6866 if (!msg) { 6867 cfg80211_sinfo_release_content(&sinfo); 6868 return -ENOMEM; 6869 } 6870 6871 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 6872 info->snd_portid, info->snd_seq, 0, 6873 rdev, dev, mac_addr, &sinfo) < 0) { 6874 nlmsg_free(msg); 6875 return -ENOBUFS; 6876 } 6877 6878 return genlmsg_reply(msg, info); 6879 } 6880 6881 int cfg80211_check_station_change(struct wiphy *wiphy, 6882 struct station_parameters *params, 6883 enum cfg80211_station_type statype) 6884 { 6885 if (params->listen_interval != -1 && 6886 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6887 return -EINVAL; 6888 6889 if (params->support_p2p_ps != -1 && 6890 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6891 return -EINVAL; 6892 6893 if (params->aid && 6894 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && 6895 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6896 return -EINVAL; 6897 6898 /* When you run into this, adjust the code below for the new flag */ 6899 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 6900 6901 switch (statype) { 6902 case CFG80211_STA_MESH_PEER_KERNEL: 6903 case CFG80211_STA_MESH_PEER_USER: 6904 /* 6905 * No ignoring the TDLS flag here -- the userspace mesh 6906 * code doesn't have the bug of including TDLS in the 6907 * mask everywhere. 6908 */ 6909 if (params->sta_flags_mask & 6910 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6911 BIT(NL80211_STA_FLAG_MFP) | 6912 BIT(NL80211_STA_FLAG_AUTHORIZED))) 6913 return -EINVAL; 6914 break; 6915 case CFG80211_STA_TDLS_PEER_SETUP: 6916 case CFG80211_STA_TDLS_PEER_ACTIVE: 6917 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 6918 return -EINVAL; 6919 /* ignore since it can't change */ 6920 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 6921 break; 6922 default: 6923 /* disallow mesh-specific things */ 6924 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) 6925 return -EINVAL; 6926 if (params->local_pm) 6927 return -EINVAL; 6928 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 6929 return -EINVAL; 6930 } 6931 6932 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 6933 statype != CFG80211_STA_TDLS_PEER_ACTIVE) { 6934 /* TDLS can't be set, ... */ 6935 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) 6936 return -EINVAL; 6937 /* 6938 * ... but don't bother the driver with it. This works around 6939 * a hostapd/wpa_supplicant issue -- it always includes the 6940 * TLDS_PEER flag in the mask even for AP mode. 6941 */ 6942 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 6943 } 6944 6945 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 6946 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 6947 /* reject other things that can't change */ 6948 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) 6949 return -EINVAL; 6950 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) 6951 return -EINVAL; 6952 if (params->link_sta_params.supported_rates) 6953 return -EINVAL; 6954 if (params->ext_capab || params->link_sta_params.ht_capa || 6955 params->link_sta_params.vht_capa || 6956 params->link_sta_params.he_capa || 6957 params->link_sta_params.eht_capa) 6958 return -EINVAL; 6959 if (params->sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 6960 return -EINVAL; 6961 } 6962 6963 if (statype != CFG80211_STA_AP_CLIENT && 6964 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 6965 if (params->vlan) 6966 return -EINVAL; 6967 } 6968 6969 switch (statype) { 6970 case CFG80211_STA_AP_MLME_CLIENT: 6971 /* Use this only for authorizing/unauthorizing a station */ 6972 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 6973 return -EOPNOTSUPP; 6974 break; 6975 case CFG80211_STA_AP_CLIENT: 6976 case CFG80211_STA_AP_CLIENT_UNASSOC: 6977 /* accept only the listed bits */ 6978 if (params->sta_flags_mask & 6979 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 6980 BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6981 BIT(NL80211_STA_FLAG_ASSOCIATED) | 6982 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6983 BIT(NL80211_STA_FLAG_WME) | 6984 BIT(NL80211_STA_FLAG_MFP) | 6985 BIT(NL80211_STA_FLAG_SPP_AMSDU))) 6986 return -EINVAL; 6987 6988 /* but authenticated/associated only if driver handles it */ 6989 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 6990 params->sta_flags_mask & 6991 (BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6992 BIT(NL80211_STA_FLAG_ASSOCIATED))) 6993 return -EINVAL; 6994 break; 6995 case CFG80211_STA_IBSS: 6996 case CFG80211_STA_AP_STA: 6997 /* reject any changes other than AUTHORIZED */ 6998 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED)) 6999 return -EINVAL; 7000 break; 7001 case CFG80211_STA_TDLS_PEER_SETUP: 7002 /* reject any changes other than AUTHORIZED or WME */ 7003 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 7004 BIT(NL80211_STA_FLAG_WME))) 7005 return -EINVAL; 7006 /* force (at least) rates when authorizing */ 7007 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) && 7008 !params->link_sta_params.supported_rates) 7009 return -EINVAL; 7010 break; 7011 case CFG80211_STA_TDLS_PEER_ACTIVE: 7012 /* reject any changes */ 7013 return -EINVAL; 7014 case CFG80211_STA_MESH_PEER_KERNEL: 7015 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 7016 return -EINVAL; 7017 break; 7018 case CFG80211_STA_MESH_PEER_USER: 7019 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION && 7020 params->plink_action != NL80211_PLINK_ACTION_BLOCK) 7021 return -EINVAL; 7022 break; 7023 } 7024 7025 /* 7026 * Older kernel versions ignored this attribute entirely, so don't 7027 * reject attempts to update it but mark it as unused instead so the 7028 * driver won't look at the data. 7029 */ 7030 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 7031 statype != CFG80211_STA_TDLS_PEER_SETUP) 7032 params->link_sta_params.opmode_notif_used = false; 7033 7034 return 0; 7035 } 7036 EXPORT_SYMBOL(cfg80211_check_station_change); 7037 7038 /* 7039 * Get vlan interface making sure it is running and on the right wiphy. 7040 */ 7041 static struct net_device *get_vlan(struct genl_info *info, 7042 struct cfg80211_registered_device *rdev) 7043 { 7044 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN]; 7045 struct net_device *v; 7046 int ret; 7047 7048 if (!vlanattr) 7049 return NULL; 7050 7051 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr)); 7052 if (!v) 7053 return ERR_PTR(-ENODEV); 7054 7055 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) { 7056 ret = -EINVAL; 7057 goto error; 7058 } 7059 7060 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 7061 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 7062 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 7063 ret = -EINVAL; 7064 goto error; 7065 } 7066 7067 if (!netif_running(v)) { 7068 ret = -ENETDOWN; 7069 goto error; 7070 } 7071 7072 return v; 7073 error: 7074 dev_put(v); 7075 return ERR_PTR(ret); 7076 } 7077 7078 static int nl80211_parse_sta_wme(struct genl_info *info, 7079 struct station_parameters *params) 7080 { 7081 struct nlattr *tb[NL80211_STA_WME_MAX + 1]; 7082 struct nlattr *nla; 7083 int err; 7084 7085 /* parse WME attributes if present */ 7086 if (!info->attrs[NL80211_ATTR_STA_WME]) 7087 return 0; 7088 7089 nla = info->attrs[NL80211_ATTR_STA_WME]; 7090 err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla, 7091 nl80211_sta_wme_policy, 7092 info->extack); 7093 if (err) 7094 return err; 7095 7096 if (tb[NL80211_STA_WME_UAPSD_QUEUES]) 7097 params->uapsd_queues = nla_get_u8( 7098 tb[NL80211_STA_WME_UAPSD_QUEUES]); 7099 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) 7100 return -EINVAL; 7101 7102 if (tb[NL80211_STA_WME_MAX_SP]) 7103 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]); 7104 7105 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) 7106 return -EINVAL; 7107 7108 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD; 7109 7110 return 0; 7111 } 7112 7113 static int nl80211_parse_sta_channel_info(struct genl_info *info, 7114 struct station_parameters *params) 7115 { 7116 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) { 7117 params->supported_channels = 7118 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7119 params->supported_channels_len = 7120 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7121 /* 7122 * Need to include at least one (first channel, number of 7123 * channels) tuple for each subband (checked in policy), 7124 * and must have proper tuples for the rest of the data as well. 7125 */ 7126 if (params->supported_channels_len % 2) 7127 return -EINVAL; 7128 } 7129 7130 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) { 7131 params->supported_oper_classes = 7132 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7133 params->supported_oper_classes_len = 7134 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7135 } 7136 return 0; 7137 } 7138 7139 static int nl80211_set_station_tdls(struct genl_info *info, 7140 struct station_parameters *params) 7141 { 7142 int err; 7143 /* Dummy STA entry gets updated once the peer capabilities are known */ 7144 if (info->attrs[NL80211_ATTR_PEER_AID]) 7145 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7146 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7147 params->link_sta_params.ht_capa = 7148 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7149 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7150 params->link_sta_params.vht_capa = 7151 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7152 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7153 params->link_sta_params.he_capa = 7154 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7155 params->link_sta_params.he_capa_len = 7156 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7157 7158 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7159 params->link_sta_params.eht_capa = 7160 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7161 params->link_sta_params.eht_capa_len = 7162 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7163 7164 if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa, 7165 (const u8 *)params->link_sta_params.eht_capa, 7166 params->link_sta_params.eht_capa_len, 7167 false)) 7168 return -EINVAL; 7169 } 7170 } 7171 7172 err = nl80211_parse_sta_channel_info(info, params); 7173 if (err) 7174 return err; 7175 7176 return nl80211_parse_sta_wme(info, params); 7177 } 7178 7179 static int nl80211_parse_sta_txpower_setting(struct genl_info *info, 7180 struct sta_txpwr *txpwr, 7181 bool *txpwr_set) 7182 { 7183 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7184 int idx; 7185 7186 if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) { 7187 if (!rdev->ops->set_tx_power || 7188 !wiphy_ext_feature_isset(&rdev->wiphy, 7189 NL80211_EXT_FEATURE_STA_TX_PWR)) 7190 return -EOPNOTSUPP; 7191 7192 idx = NL80211_ATTR_STA_TX_POWER_SETTING; 7193 txpwr->type = nla_get_u8(info->attrs[idx]); 7194 7195 if (txpwr->type == NL80211_TX_POWER_LIMITED) { 7196 idx = NL80211_ATTR_STA_TX_POWER; 7197 7198 if (info->attrs[idx]) 7199 txpwr->power = nla_get_s16(info->attrs[idx]); 7200 else 7201 return -EINVAL; 7202 } 7203 7204 *txpwr_set = true; 7205 } else { 7206 *txpwr_set = false; 7207 } 7208 7209 return 0; 7210 } 7211 7212 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info) 7213 { 7214 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7215 struct net_device *dev = info->user_ptr[1]; 7216 struct station_parameters params; 7217 u8 *mac_addr; 7218 int err; 7219 7220 memset(¶ms, 0, sizeof(params)); 7221 7222 if (!rdev->ops->change_station) 7223 return -EOPNOTSUPP; 7224 7225 /* 7226 * AID and listen_interval properties can be set only for unassociated 7227 * station. Include these parameters here and will check them in 7228 * cfg80211_check_station_change(). 7229 */ 7230 if (info->attrs[NL80211_ATTR_STA_AID]) 7231 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7232 7233 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7234 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7235 7236 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7237 params.listen_interval = 7238 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7239 else 7240 params.listen_interval = -1; 7241 7242 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) 7243 params.support_p2p_ps = 7244 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7245 else 7246 params.support_p2p_ps = -1; 7247 7248 if (!info->attrs[NL80211_ATTR_MAC]) 7249 return -EINVAL; 7250 7251 params.link_sta_params.link_id = 7252 nl80211_link_id_or_invalid(info->attrs); 7253 7254 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7255 /* If MLD_ADDR attribute is set then this is an MLD station 7256 * and the MLD_ADDR attribute holds the MLD address and the 7257 * MAC attribute holds for the LINK address. 7258 * In that case, the link_id is also expected to be valid. 7259 */ 7260 if (params.link_sta_params.link_id < 0) 7261 return -EINVAL; 7262 7263 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7264 params.link_sta_params.mld_mac = mac_addr; 7265 params.link_sta_params.link_mac = 7266 nla_data(info->attrs[NL80211_ATTR_MAC]); 7267 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7268 return -EINVAL; 7269 } else { 7270 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7271 } 7272 7273 7274 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 7275 params.link_sta_params.supported_rates = 7276 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7277 params.link_sta_params.supported_rates_len = 7278 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7279 } 7280 7281 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7282 params.capability = 7283 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7284 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7285 } 7286 7287 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7288 params.ext_capab = 7289 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7290 params.ext_capab_len = 7291 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7292 } 7293 7294 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7295 return -EINVAL; 7296 7297 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7298 params.plink_action = 7299 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7300 7301 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) { 7302 params.plink_state = 7303 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]); 7304 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) 7305 params.peer_aid = nla_get_u16( 7306 info->attrs[NL80211_ATTR_MESH_PEER_AID]); 7307 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE; 7308 } 7309 7310 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) 7311 params.local_pm = nla_get_u32( 7312 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]); 7313 7314 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7315 params.link_sta_params.opmode_notif_used = true; 7316 params.link_sta_params.opmode_notif = 7317 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7318 } 7319 7320 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7321 params.link_sta_params.he_6ghz_capa = 7322 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7323 7324 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7325 params.airtime_weight = 7326 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7327 7328 if (params.airtime_weight && 7329 !wiphy_ext_feature_isset(&rdev->wiphy, 7330 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7331 return -EOPNOTSUPP; 7332 7333 err = nl80211_parse_sta_txpower_setting(info, 7334 ¶ms.link_sta_params.txpwr, 7335 ¶ms.link_sta_params.txpwr_set); 7336 if (err) 7337 return err; 7338 7339 /* Include parameters for TDLS peer (will check later) */ 7340 err = nl80211_set_station_tdls(info, ¶ms); 7341 if (err) 7342 return err; 7343 7344 params.vlan = get_vlan(info, rdev); 7345 if (IS_ERR(params.vlan)) 7346 return PTR_ERR(params.vlan); 7347 7348 switch (dev->ieee80211_ptr->iftype) { 7349 case NL80211_IFTYPE_AP: 7350 case NL80211_IFTYPE_AP_VLAN: 7351 case NL80211_IFTYPE_P2P_GO: 7352 case NL80211_IFTYPE_P2P_CLIENT: 7353 case NL80211_IFTYPE_STATION: 7354 case NL80211_IFTYPE_ADHOC: 7355 case NL80211_IFTYPE_MESH_POINT: 7356 break; 7357 default: 7358 err = -EOPNOTSUPP; 7359 goto out_put_vlan; 7360 } 7361 7362 /* driver will call cfg80211_check_station_change() */ 7363 err = rdev_change_station(rdev, dev, mac_addr, ¶ms); 7364 7365 out_put_vlan: 7366 dev_put(params.vlan); 7367 7368 return err; 7369 } 7370 7371 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info) 7372 { 7373 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7374 int err; 7375 struct net_device *dev = info->user_ptr[1]; 7376 struct wireless_dev *wdev = dev->ieee80211_ptr; 7377 struct station_parameters params; 7378 u8 *mac_addr = NULL; 7379 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7380 BIT(NL80211_STA_FLAG_ASSOCIATED); 7381 7382 memset(¶ms, 0, sizeof(params)); 7383 7384 if (!rdev->ops->add_station) 7385 return -EOPNOTSUPP; 7386 7387 if (!info->attrs[NL80211_ATTR_MAC]) 7388 return -EINVAL; 7389 7390 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7391 return -EINVAL; 7392 7393 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 7394 return -EINVAL; 7395 7396 if (!info->attrs[NL80211_ATTR_STA_AID] && 7397 !info->attrs[NL80211_ATTR_PEER_AID]) 7398 return -EINVAL; 7399 7400 params.link_sta_params.link_id = 7401 nl80211_link_id_or_invalid(info->attrs); 7402 7403 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7404 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7405 params.link_sta_params.mld_mac = mac_addr; 7406 params.link_sta_params.link_mac = 7407 nla_data(info->attrs[NL80211_ATTR_MAC]); 7408 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7409 return -EINVAL; 7410 } else { 7411 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7412 } 7413 7414 params.link_sta_params.supported_rates = 7415 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7416 params.link_sta_params.supported_rates_len = 7417 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7418 params.listen_interval = 7419 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7420 7421 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7422 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7423 7424 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) { 7425 params.support_p2p_ps = 7426 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7427 } else { 7428 /* 7429 * if not specified, assume it's supported for P2P GO interface, 7430 * and is NOT supported for AP interface 7431 */ 7432 params.support_p2p_ps = 7433 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO; 7434 } 7435 7436 if (info->attrs[NL80211_ATTR_PEER_AID]) 7437 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7438 else 7439 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7440 7441 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7442 params.capability = 7443 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7444 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7445 } 7446 7447 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7448 params.ext_capab = 7449 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7450 params.ext_capab_len = 7451 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7452 } 7453 7454 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7455 params.link_sta_params.ht_capa = 7456 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7457 7458 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7459 params.link_sta_params.vht_capa = 7460 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7461 7462 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7463 params.link_sta_params.he_capa = 7464 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7465 params.link_sta_params.he_capa_len = 7466 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7467 7468 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7469 params.link_sta_params.eht_capa = 7470 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7471 params.link_sta_params.eht_capa_len = 7472 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7473 7474 if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa, 7475 (const u8 *)params.link_sta_params.eht_capa, 7476 params.link_sta_params.eht_capa_len, 7477 false)) 7478 return -EINVAL; 7479 } 7480 } 7481 7482 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7483 params.link_sta_params.he_6ghz_capa = 7484 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7485 7486 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7487 params.link_sta_params.opmode_notif_used = true; 7488 params.link_sta_params.opmode_notif = 7489 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7490 } 7491 7492 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7493 params.plink_action = 7494 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7495 7496 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7497 params.airtime_weight = 7498 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7499 7500 if (params.airtime_weight && 7501 !wiphy_ext_feature_isset(&rdev->wiphy, 7502 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7503 return -EOPNOTSUPP; 7504 7505 err = nl80211_parse_sta_txpower_setting(info, 7506 ¶ms.link_sta_params.txpwr, 7507 ¶ms.link_sta_params.txpwr_set); 7508 if (err) 7509 return err; 7510 7511 err = nl80211_parse_sta_channel_info(info, ¶ms); 7512 if (err) 7513 return err; 7514 7515 err = nl80211_parse_sta_wme(info, ¶ms); 7516 if (err) 7517 return err; 7518 7519 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7520 return -EINVAL; 7521 7522 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT 7523 * as userspace might just pass through the capabilities from the IEs 7524 * directly, rather than enforcing this restriction and returning an 7525 * error in this case. 7526 */ 7527 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) { 7528 params.link_sta_params.ht_capa = NULL; 7529 params.link_sta_params.vht_capa = NULL; 7530 7531 /* HE and EHT require WME */ 7532 if (params.link_sta_params.he_capa_len || 7533 params.link_sta_params.he_6ghz_capa || 7534 params.link_sta_params.eht_capa_len) 7535 return -EINVAL; 7536 } 7537 7538 /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */ 7539 if (params.link_sta_params.he_6ghz_capa && 7540 (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa)) 7541 return -EINVAL; 7542 7543 /* When you run into this, adjust the code below for the new flag */ 7544 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 7545 7546 switch (dev->ieee80211_ptr->iftype) { 7547 case NL80211_IFTYPE_AP: 7548 case NL80211_IFTYPE_AP_VLAN: 7549 case NL80211_IFTYPE_P2P_GO: 7550 /* ignore WME attributes if iface/sta is not capable */ 7551 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) || 7552 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) 7553 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7554 7555 /* TDLS peers cannot be added */ 7556 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7557 info->attrs[NL80211_ATTR_PEER_AID]) 7558 return -EINVAL; 7559 /* but don't bother the driver with it */ 7560 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7561 7562 /* allow authenticated/associated only if driver handles it */ 7563 if (!(rdev->wiphy.features & 7564 NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 7565 params.sta_flags_mask & auth_assoc) 7566 return -EINVAL; 7567 7568 if (!wiphy_ext_feature_isset(&rdev->wiphy, 7569 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT) && 7570 params.sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 7571 return -EINVAL; 7572 7573 /* Older userspace, or userspace wanting to be compatible with 7574 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth 7575 * and assoc flags in the mask, but assumes the station will be 7576 * added as associated anyway since this was the required driver 7577 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was 7578 * introduced. 7579 * In order to not bother drivers with this quirk in the API 7580 * set the flags in both the mask and set for new stations in 7581 * this case. 7582 */ 7583 if (!(params.sta_flags_mask & auth_assoc)) { 7584 params.sta_flags_mask |= auth_assoc; 7585 params.sta_flags_set |= auth_assoc; 7586 } 7587 7588 /* must be last in here for error handling */ 7589 params.vlan = get_vlan(info, rdev); 7590 if (IS_ERR(params.vlan)) 7591 return PTR_ERR(params.vlan); 7592 break; 7593 case NL80211_IFTYPE_MESH_POINT: 7594 /* ignore uAPSD data */ 7595 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7596 7597 /* associated is disallowed */ 7598 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) 7599 return -EINVAL; 7600 /* TDLS peers cannot be added */ 7601 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7602 info->attrs[NL80211_ATTR_PEER_AID]) 7603 return -EINVAL; 7604 break; 7605 case NL80211_IFTYPE_STATION: 7606 case NL80211_IFTYPE_P2P_CLIENT: 7607 /* ignore uAPSD data */ 7608 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7609 7610 /* these are disallowed */ 7611 if (params.sta_flags_mask & 7612 (BIT(NL80211_STA_FLAG_ASSOCIATED) | 7613 BIT(NL80211_STA_FLAG_AUTHENTICATED))) 7614 return -EINVAL; 7615 /* Only TDLS peers can be added */ 7616 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 7617 return -EINVAL; 7618 /* Can only add if TDLS ... */ 7619 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS)) 7620 return -EOPNOTSUPP; 7621 /* ... with external setup is supported */ 7622 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP)) 7623 return -EOPNOTSUPP; 7624 /* 7625 * Older wpa_supplicant versions always mark the TDLS peer 7626 * as authorized, but it shouldn't yet be. 7627 */ 7628 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED); 7629 break; 7630 default: 7631 return -EOPNOTSUPP; 7632 } 7633 7634 /* be aware of params.vlan when changing code here */ 7635 7636 if (wdev->valid_links) { 7637 if (params.link_sta_params.link_id < 0) { 7638 err = -EINVAL; 7639 goto out; 7640 } 7641 if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) { 7642 err = -ENOLINK; 7643 goto out; 7644 } 7645 } else { 7646 if (params.link_sta_params.link_id >= 0) { 7647 err = -EINVAL; 7648 goto out; 7649 } 7650 } 7651 err = rdev_add_station(rdev, dev, mac_addr, ¶ms); 7652 out: 7653 dev_put(params.vlan); 7654 return err; 7655 } 7656 7657 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info) 7658 { 7659 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7660 struct net_device *dev = info->user_ptr[1]; 7661 struct wireless_dev *wdev = dev->ieee80211_ptr; 7662 struct station_del_parameters params; 7663 int link_id = nl80211_link_id_or_invalid(info->attrs); 7664 7665 memset(¶ms, 0, sizeof(params)); 7666 7667 if (info->attrs[NL80211_ATTR_MAC]) 7668 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 7669 7670 switch (wdev->iftype) { 7671 case NL80211_IFTYPE_AP: 7672 case NL80211_IFTYPE_AP_VLAN: 7673 case NL80211_IFTYPE_MESH_POINT: 7674 case NL80211_IFTYPE_P2P_GO: 7675 /* always accept these */ 7676 break; 7677 case NL80211_IFTYPE_ADHOC: 7678 /* conditionally accept */ 7679 if (wiphy_ext_feature_isset(&rdev->wiphy, 7680 NL80211_EXT_FEATURE_DEL_IBSS_STA)) 7681 break; 7682 return -EINVAL; 7683 default: 7684 return -EINVAL; 7685 } 7686 7687 if (!rdev->ops->del_station) 7688 return -EOPNOTSUPP; 7689 7690 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) { 7691 params.subtype = 7692 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]); 7693 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 && 7694 params.subtype != IEEE80211_STYPE_DEAUTH >> 4) 7695 return -EINVAL; 7696 } else { 7697 /* Default to Deauthentication frame */ 7698 params.subtype = IEEE80211_STYPE_DEAUTH >> 4; 7699 } 7700 7701 if (info->attrs[NL80211_ATTR_REASON_CODE]) { 7702 params.reason_code = 7703 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 7704 if (params.reason_code == 0) 7705 return -EINVAL; /* 0 is reserved */ 7706 } else { 7707 /* Default to reason code 2 */ 7708 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID; 7709 } 7710 7711 /* Link ID not expected in case of non-ML operation */ 7712 if (!wdev->valid_links && link_id != -1) 7713 return -EINVAL; 7714 7715 /* If given, a valid link ID should be passed during MLO */ 7716 if (wdev->valid_links && link_id >= 0 && 7717 !(wdev->valid_links & BIT(link_id))) 7718 return -EINVAL; 7719 7720 params.link_id = link_id; 7721 7722 return rdev_del_station(rdev, dev, ¶ms); 7723 } 7724 7725 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq, 7726 int flags, struct net_device *dev, 7727 u8 *dst, u8 *next_hop, 7728 struct mpath_info *pinfo) 7729 { 7730 void *hdr; 7731 struct nlattr *pinfoattr; 7732 7733 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH); 7734 if (!hdr) 7735 return -1; 7736 7737 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 7738 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) || 7739 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) || 7740 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation)) 7741 goto nla_put_failure; 7742 7743 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO); 7744 if (!pinfoattr) 7745 goto nla_put_failure; 7746 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) && 7747 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN, 7748 pinfo->frame_qlen)) 7749 goto nla_put_failure; 7750 if (((pinfo->filled & MPATH_INFO_SN) && 7751 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) || 7752 ((pinfo->filled & MPATH_INFO_METRIC) && 7753 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC, 7754 pinfo->metric)) || 7755 ((pinfo->filled & MPATH_INFO_EXPTIME) && 7756 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME, 7757 pinfo->exptime)) || 7758 ((pinfo->filled & MPATH_INFO_FLAGS) && 7759 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS, 7760 pinfo->flags)) || 7761 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) && 7762 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT, 7763 pinfo->discovery_timeout)) || 7764 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) && 7765 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES, 7766 pinfo->discovery_retries)) || 7767 ((pinfo->filled & MPATH_INFO_HOP_COUNT) && 7768 nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT, 7769 pinfo->hop_count)) || 7770 ((pinfo->filled & MPATH_INFO_PATH_CHANGE) && 7771 nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE, 7772 pinfo->path_change_count))) 7773 goto nla_put_failure; 7774 7775 nla_nest_end(msg, pinfoattr); 7776 7777 genlmsg_end(msg, hdr); 7778 return 0; 7779 7780 nla_put_failure: 7781 genlmsg_cancel(msg, hdr); 7782 return -EMSGSIZE; 7783 } 7784 7785 static int nl80211_dump_mpath(struct sk_buff *skb, 7786 struct netlink_callback *cb) 7787 { 7788 struct mpath_info pinfo; 7789 struct cfg80211_registered_device *rdev; 7790 struct wireless_dev *wdev; 7791 u8 dst[ETH_ALEN]; 7792 u8 next_hop[ETH_ALEN]; 7793 int path_idx = cb->args[2]; 7794 int err; 7795 7796 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7797 if (err) 7798 return err; 7799 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7800 __acquire(&rdev->wiphy.mtx); 7801 7802 if (!rdev->ops->dump_mpath) { 7803 err = -EOPNOTSUPP; 7804 goto out_err; 7805 } 7806 7807 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 7808 err = -EOPNOTSUPP; 7809 goto out_err; 7810 } 7811 7812 while (1) { 7813 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst, 7814 next_hop, &pinfo); 7815 if (err == -ENOENT) 7816 break; 7817 if (err) 7818 goto out_err; 7819 7820 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 7821 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7822 wdev->netdev, dst, next_hop, 7823 &pinfo) < 0) 7824 goto out; 7825 7826 path_idx++; 7827 } 7828 7829 out: 7830 cb->args[2] = path_idx; 7831 err = skb->len; 7832 out_err: 7833 wiphy_unlock(&rdev->wiphy); 7834 return err; 7835 } 7836 7837 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info) 7838 { 7839 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7840 int err; 7841 struct net_device *dev = info->user_ptr[1]; 7842 struct mpath_info pinfo; 7843 struct sk_buff *msg; 7844 u8 *dst = NULL; 7845 u8 next_hop[ETH_ALEN]; 7846 7847 memset(&pinfo, 0, sizeof(pinfo)); 7848 7849 if (!info->attrs[NL80211_ATTR_MAC]) 7850 return -EINVAL; 7851 7852 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7853 7854 if (!rdev->ops->get_mpath) 7855 return -EOPNOTSUPP; 7856 7857 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7858 return -EOPNOTSUPP; 7859 7860 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo); 7861 if (err) 7862 return err; 7863 7864 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7865 if (!msg) 7866 return -ENOMEM; 7867 7868 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 7869 dev, dst, next_hop, &pinfo) < 0) { 7870 nlmsg_free(msg); 7871 return -ENOBUFS; 7872 } 7873 7874 return genlmsg_reply(msg, info); 7875 } 7876 7877 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info) 7878 { 7879 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7880 struct net_device *dev = info->user_ptr[1]; 7881 u8 *dst = NULL; 7882 u8 *next_hop = NULL; 7883 7884 if (!info->attrs[NL80211_ATTR_MAC]) 7885 return -EINVAL; 7886 7887 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 7888 return -EINVAL; 7889 7890 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7891 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 7892 7893 if (!rdev->ops->change_mpath) 7894 return -EOPNOTSUPP; 7895 7896 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7897 return -EOPNOTSUPP; 7898 7899 return rdev_change_mpath(rdev, dev, dst, next_hop); 7900 } 7901 7902 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info) 7903 { 7904 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7905 struct net_device *dev = info->user_ptr[1]; 7906 u8 *dst = NULL; 7907 u8 *next_hop = NULL; 7908 7909 if (!info->attrs[NL80211_ATTR_MAC]) 7910 return -EINVAL; 7911 7912 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 7913 return -EINVAL; 7914 7915 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7916 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 7917 7918 if (!rdev->ops->add_mpath) 7919 return -EOPNOTSUPP; 7920 7921 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7922 return -EOPNOTSUPP; 7923 7924 return rdev_add_mpath(rdev, dev, dst, next_hop); 7925 } 7926 7927 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info) 7928 { 7929 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7930 struct net_device *dev = info->user_ptr[1]; 7931 u8 *dst = NULL; 7932 7933 if (info->attrs[NL80211_ATTR_MAC]) 7934 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7935 7936 if (!rdev->ops->del_mpath) 7937 return -EOPNOTSUPP; 7938 7939 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7940 return -EOPNOTSUPP; 7941 7942 return rdev_del_mpath(rdev, dev, dst); 7943 } 7944 7945 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info) 7946 { 7947 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7948 int err; 7949 struct net_device *dev = info->user_ptr[1]; 7950 struct mpath_info pinfo; 7951 struct sk_buff *msg; 7952 u8 *dst = NULL; 7953 u8 mpp[ETH_ALEN]; 7954 7955 memset(&pinfo, 0, sizeof(pinfo)); 7956 7957 if (!info->attrs[NL80211_ATTR_MAC]) 7958 return -EINVAL; 7959 7960 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7961 7962 if (!rdev->ops->get_mpp) 7963 return -EOPNOTSUPP; 7964 7965 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7966 return -EOPNOTSUPP; 7967 7968 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo); 7969 if (err) 7970 return err; 7971 7972 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7973 if (!msg) 7974 return -ENOMEM; 7975 7976 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 7977 dev, dst, mpp, &pinfo) < 0) { 7978 nlmsg_free(msg); 7979 return -ENOBUFS; 7980 } 7981 7982 return genlmsg_reply(msg, info); 7983 } 7984 7985 static int nl80211_dump_mpp(struct sk_buff *skb, 7986 struct netlink_callback *cb) 7987 { 7988 struct mpath_info pinfo; 7989 struct cfg80211_registered_device *rdev; 7990 struct wireless_dev *wdev; 7991 u8 dst[ETH_ALEN]; 7992 u8 mpp[ETH_ALEN]; 7993 int path_idx = cb->args[2]; 7994 int err; 7995 7996 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7997 if (err) 7998 return err; 7999 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 8000 __acquire(&rdev->wiphy.mtx); 8001 8002 if (!rdev->ops->dump_mpp) { 8003 err = -EOPNOTSUPP; 8004 goto out_err; 8005 } 8006 8007 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 8008 err = -EOPNOTSUPP; 8009 goto out_err; 8010 } 8011 8012 while (1) { 8013 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst, 8014 mpp, &pinfo); 8015 if (err == -ENOENT) 8016 break; 8017 if (err) 8018 goto out_err; 8019 8020 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 8021 cb->nlh->nlmsg_seq, NLM_F_MULTI, 8022 wdev->netdev, dst, mpp, 8023 &pinfo) < 0) 8024 goto out; 8025 8026 path_idx++; 8027 } 8028 8029 out: 8030 cb->args[2] = path_idx; 8031 err = skb->len; 8032 out_err: 8033 wiphy_unlock(&rdev->wiphy); 8034 return err; 8035 } 8036 8037 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info) 8038 { 8039 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8040 struct net_device *dev = info->user_ptr[1]; 8041 struct bss_parameters params; 8042 8043 memset(¶ms, 0, sizeof(params)); 8044 params.link_id = nl80211_link_id_or_invalid(info->attrs); 8045 /* default to not changing parameters */ 8046 params.use_cts_prot = -1; 8047 params.use_short_preamble = -1; 8048 params.use_short_slot_time = -1; 8049 params.ap_isolate = -1; 8050 params.ht_opmode = -1; 8051 params.p2p_ctwindow = -1; 8052 params.p2p_opp_ps = -1; 8053 8054 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT]) 8055 params.use_cts_prot = 8056 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]); 8057 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]) 8058 params.use_short_preamble = 8059 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]); 8060 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]) 8061 params.use_short_slot_time = 8062 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]); 8063 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 8064 params.basic_rates = 8065 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 8066 params.basic_rates_len = 8067 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 8068 } 8069 if (info->attrs[NL80211_ATTR_AP_ISOLATE]) 8070 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]); 8071 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE]) 8072 params.ht_opmode = 8073 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]); 8074 8075 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 8076 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8077 return -EINVAL; 8078 params.p2p_ctwindow = 8079 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 8080 if (params.p2p_ctwindow != 0 && 8081 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) 8082 return -EINVAL; 8083 } 8084 8085 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 8086 u8 tmp; 8087 8088 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8089 return -EINVAL; 8090 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 8091 params.p2p_opp_ps = tmp; 8092 if (params.p2p_opp_ps && 8093 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) 8094 return -EINVAL; 8095 } 8096 8097 if (!rdev->ops->change_bss) 8098 return -EOPNOTSUPP; 8099 8100 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 8101 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8102 return -EOPNOTSUPP; 8103 8104 return rdev_change_bss(rdev, dev, ¶ms); 8105 } 8106 8107 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info) 8108 { 8109 char *data = NULL; 8110 bool is_indoor; 8111 enum nl80211_user_reg_hint_type user_reg_hint_type; 8112 u32 owner_nlportid; 8113 8114 /* 8115 * You should only get this when cfg80211 hasn't yet initialized 8116 * completely when built-in to the kernel right between the time 8117 * window between nl80211_init() and regulatory_init(), if that is 8118 * even possible. 8119 */ 8120 if (unlikely(!rcu_access_pointer(cfg80211_regdomain))) 8121 return -EINPROGRESS; 8122 8123 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]) 8124 user_reg_hint_type = 8125 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]); 8126 else 8127 user_reg_hint_type = NL80211_USER_REG_HINT_USER; 8128 8129 switch (user_reg_hint_type) { 8130 case NL80211_USER_REG_HINT_USER: 8131 case NL80211_USER_REG_HINT_CELL_BASE: 8132 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8133 return -EINVAL; 8134 8135 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8136 return regulatory_hint_user(data, user_reg_hint_type); 8137 case NL80211_USER_REG_HINT_INDOOR: 8138 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 8139 owner_nlportid = info->snd_portid; 8140 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR]; 8141 } else { 8142 owner_nlportid = 0; 8143 is_indoor = true; 8144 } 8145 8146 regulatory_hint_indoor(is_indoor, owner_nlportid); 8147 return 0; 8148 default: 8149 return -EINVAL; 8150 } 8151 } 8152 8153 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info) 8154 { 8155 return reg_reload_regdb(); 8156 } 8157 8158 static int nl80211_get_mesh_config(struct sk_buff *skb, 8159 struct genl_info *info) 8160 { 8161 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8162 struct net_device *dev = info->user_ptr[1]; 8163 struct wireless_dev *wdev = dev->ieee80211_ptr; 8164 struct mesh_config cur_params; 8165 int err = 0; 8166 void *hdr; 8167 struct nlattr *pinfoattr; 8168 struct sk_buff *msg; 8169 8170 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8171 return -EOPNOTSUPP; 8172 8173 if (!rdev->ops->get_mesh_config) 8174 return -EOPNOTSUPP; 8175 8176 /* If not connected, get default parameters */ 8177 if (!wdev->u.mesh.id_len) 8178 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params)); 8179 else 8180 err = rdev_get_mesh_config(rdev, dev, &cur_params); 8181 8182 if (err) 8183 return err; 8184 8185 /* Draw up a netlink message to send back */ 8186 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8187 if (!msg) 8188 return -ENOMEM; 8189 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8190 NL80211_CMD_GET_MESH_CONFIG); 8191 if (!hdr) 8192 goto out; 8193 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG); 8194 if (!pinfoattr) 8195 goto nla_put_failure; 8196 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 8197 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT, 8198 cur_params.dot11MeshRetryTimeout) || 8199 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT, 8200 cur_params.dot11MeshConfirmTimeout) || 8201 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT, 8202 cur_params.dot11MeshHoldingTimeout) || 8203 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS, 8204 cur_params.dot11MeshMaxPeerLinks) || 8205 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES, 8206 cur_params.dot11MeshMaxRetries) || 8207 nla_put_u8(msg, NL80211_MESHCONF_TTL, 8208 cur_params.dot11MeshTTL) || 8209 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL, 8210 cur_params.element_ttl) || 8211 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8212 cur_params.auto_open_plinks) || 8213 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8214 cur_params.dot11MeshNbrOffsetMaxNeighbor) || 8215 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8216 cur_params.dot11MeshHWMPmaxPREQretries) || 8217 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME, 8218 cur_params.path_refresh_time) || 8219 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8220 cur_params.min_discovery_timeout) || 8221 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8222 cur_params.dot11MeshHWMPactivePathTimeout) || 8223 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8224 cur_params.dot11MeshHWMPpreqMinInterval) || 8225 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8226 cur_params.dot11MeshHWMPperrMinInterval) || 8227 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8228 cur_params.dot11MeshHWMPnetDiameterTraversalTime) || 8229 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE, 8230 cur_params.dot11MeshHWMPRootMode) || 8231 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8232 cur_params.dot11MeshHWMPRannInterval) || 8233 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8234 cur_params.dot11MeshGateAnnouncementProtocol) || 8235 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING, 8236 cur_params.dot11MeshForwarding) || 8237 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD, 8238 cur_params.rssi_threshold) || 8239 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE, 8240 cur_params.ht_opmode) || 8241 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8242 cur_params.dot11MeshHWMPactivePathToRootTimeout) || 8243 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8244 cur_params.dot11MeshHWMProotInterval) || 8245 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8246 cur_params.dot11MeshHWMPconfirmationInterval) || 8247 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE, 8248 cur_params.power_mode) || 8249 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW, 8250 cur_params.dot11MeshAwakeWindowDuration) || 8251 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT, 8252 cur_params.plink_timeout) || 8253 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE, 8254 cur_params.dot11MeshConnectedToMeshGate) || 8255 nla_put_u8(msg, NL80211_MESHCONF_NOLEARN, 8256 cur_params.dot11MeshNolearn) || 8257 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS, 8258 cur_params.dot11MeshConnectedToAuthServer)) 8259 goto nla_put_failure; 8260 nla_nest_end(msg, pinfoattr); 8261 genlmsg_end(msg, hdr); 8262 return genlmsg_reply(msg, info); 8263 8264 nla_put_failure: 8265 out: 8266 nlmsg_free(msg); 8267 return -ENOBUFS; 8268 } 8269 8270 static const struct nla_policy 8271 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = { 8272 [NL80211_MESHCONF_RETRY_TIMEOUT] = 8273 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8274 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = 8275 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8276 [NL80211_MESHCONF_HOLDING_TIMEOUT] = 8277 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8278 [NL80211_MESHCONF_MAX_PEER_LINKS] = 8279 NLA_POLICY_RANGE(NLA_U16, 0, 255), 8280 [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16), 8281 [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8282 [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8283 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1), 8284 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = 8285 NLA_POLICY_RANGE(NLA_U32, 1, 255), 8286 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 }, 8287 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 }, 8288 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1), 8289 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 }, 8290 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = 8291 NLA_POLICY_MIN(NLA_U16, 1), 8292 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = 8293 NLA_POLICY_MIN(NLA_U16, 1), 8294 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = 8295 NLA_POLICY_MIN(NLA_U16, 1), 8296 [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4), 8297 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = 8298 NLA_POLICY_MIN(NLA_U16, 1), 8299 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1), 8300 [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1), 8301 [NL80211_MESHCONF_RSSI_THRESHOLD] = 8302 NLA_POLICY_RANGE(NLA_S32, -255, 0), 8303 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 }, 8304 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 }, 8305 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = 8306 NLA_POLICY_MIN(NLA_U16, 1), 8307 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = 8308 NLA_POLICY_MIN(NLA_U16, 1), 8309 [NL80211_MESHCONF_POWER_MODE] = 8310 NLA_POLICY_RANGE(NLA_U32, 8311 NL80211_MESH_POWER_ACTIVE, 8312 NL80211_MESH_POWER_MAX), 8313 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 }, 8314 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 }, 8315 [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8316 [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8317 [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8318 }; 8319 8320 static const struct nla_policy 8321 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = { 8322 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 }, 8323 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 }, 8324 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 }, 8325 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG }, 8326 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 }, 8327 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG }, 8328 [NL80211_MESH_SETUP_IE] = 8329 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 8330 IEEE80211_MAX_DATA_LEN), 8331 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG }, 8332 }; 8333 8334 static int nl80211_parse_mesh_config(struct genl_info *info, 8335 struct mesh_config *cfg, 8336 u32 *mask_out) 8337 { 8338 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1]; 8339 u32 mask = 0; 8340 u16 ht_opmode; 8341 8342 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \ 8343 do { \ 8344 if (tb[attr]) { \ 8345 cfg->param = fn(tb[attr]); \ 8346 mask |= BIT((attr) - 1); \ 8347 } \ 8348 } while (0) 8349 8350 if (!info->attrs[NL80211_ATTR_MESH_CONFIG]) 8351 return -EINVAL; 8352 if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack)) 8353 return -EINVAL; 8354 8355 /* This makes sure that there aren't more than 32 mesh config 8356 * parameters (otherwise our bitfield scheme would not work.) */ 8357 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32); 8358 8359 /* Fill in the params struct */ 8360 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask, 8361 NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16); 8362 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask, 8363 NL80211_MESHCONF_CONFIRM_TIMEOUT, 8364 nla_get_u16); 8365 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask, 8366 NL80211_MESHCONF_HOLDING_TIMEOUT, 8367 nla_get_u16); 8368 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask, 8369 NL80211_MESHCONF_MAX_PEER_LINKS, 8370 nla_get_u16); 8371 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask, 8372 NL80211_MESHCONF_MAX_RETRIES, nla_get_u8); 8373 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask, 8374 NL80211_MESHCONF_TTL, nla_get_u8); 8375 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask, 8376 NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8); 8377 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask, 8378 NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8379 nla_get_u8); 8380 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, 8381 mask, 8382 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8383 nla_get_u32); 8384 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask, 8385 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8386 nla_get_u8); 8387 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask, 8388 NL80211_MESHCONF_PATH_REFRESH_TIME, 8389 nla_get_u32); 8390 if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) && 8391 (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535)) 8392 return -EINVAL; 8393 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask, 8394 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8395 nla_get_u16); 8396 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, 8397 mask, 8398 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8399 nla_get_u32); 8400 if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) && 8401 (cfg->dot11MeshHWMPactivePathTimeout < 1 || 8402 cfg->dot11MeshHWMPactivePathTimeout > 65535)) 8403 return -EINVAL; 8404 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask, 8405 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8406 nla_get_u16); 8407 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask, 8408 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8409 nla_get_u16); 8410 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8411 dot11MeshHWMPnetDiameterTraversalTime, mask, 8412 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8413 nla_get_u16); 8414 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask, 8415 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8); 8416 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask, 8417 NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8418 nla_get_u16); 8419 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol, 8420 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8421 nla_get_u8); 8422 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask, 8423 NL80211_MESHCONF_FORWARDING, nla_get_u8); 8424 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask, 8425 NL80211_MESHCONF_RSSI_THRESHOLD, 8426 nla_get_s32); 8427 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask, 8428 NL80211_MESHCONF_CONNECTED_TO_GATE, 8429 nla_get_u8); 8430 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask, 8431 NL80211_MESHCONF_CONNECTED_TO_AS, 8432 nla_get_u8); 8433 /* 8434 * Check HT operation mode based on 8435 * IEEE 802.11-2016 9.4.2.57 HT Operation element. 8436 */ 8437 if (tb[NL80211_MESHCONF_HT_OPMODE]) { 8438 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]); 8439 8440 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION | 8441 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT | 8442 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)) 8443 return -EINVAL; 8444 8445 /* NON_HT_STA bit is reserved, but some programs set it */ 8446 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT; 8447 8448 cfg->ht_opmode = ht_opmode; 8449 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1)); 8450 } 8451 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8452 dot11MeshHWMPactivePathToRootTimeout, mask, 8453 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8454 nla_get_u32); 8455 if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) && 8456 (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 || 8457 cfg->dot11MeshHWMPactivePathToRootTimeout > 65535)) 8458 return -EINVAL; 8459 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask, 8460 NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8461 nla_get_u16); 8462 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval, 8463 mask, 8464 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8465 nla_get_u16); 8466 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask, 8467 NL80211_MESHCONF_POWER_MODE, nla_get_u32); 8468 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask, 8469 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16); 8470 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask, 8471 NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32); 8472 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask, 8473 NL80211_MESHCONF_NOLEARN, nla_get_u8); 8474 if (mask_out) 8475 *mask_out = mask; 8476 8477 return 0; 8478 8479 #undef FILL_IN_MESH_PARAM_IF_SET 8480 } 8481 8482 static int nl80211_parse_mesh_setup(struct genl_info *info, 8483 struct mesh_setup *setup) 8484 { 8485 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8486 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1]; 8487 8488 if (!info->attrs[NL80211_ATTR_MESH_SETUP]) 8489 return -EINVAL; 8490 if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack)) 8491 return -EINVAL; 8492 8493 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC]) 8494 setup->sync_method = 8495 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ? 8496 IEEE80211_SYNC_METHOD_VENDOR : 8497 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET; 8498 8499 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL]) 8500 setup->path_sel_proto = 8501 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ? 8502 IEEE80211_PATH_PROTOCOL_VENDOR : 8503 IEEE80211_PATH_PROTOCOL_HWMP; 8504 8505 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC]) 8506 setup->path_metric = 8507 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ? 8508 IEEE80211_PATH_METRIC_VENDOR : 8509 IEEE80211_PATH_METRIC_AIRTIME; 8510 8511 if (tb[NL80211_MESH_SETUP_IE]) { 8512 struct nlattr *ieattr = 8513 tb[NL80211_MESH_SETUP_IE]; 8514 setup->ie = nla_data(ieattr); 8515 setup->ie_len = nla_len(ieattr); 8516 } 8517 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] && 8518 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM)) 8519 return -EINVAL; 8520 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]); 8521 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]); 8522 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]); 8523 if (setup->is_secure) 8524 setup->user_mpm = true; 8525 8526 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) { 8527 if (!setup->user_mpm) 8528 return -EINVAL; 8529 setup->auth_id = 8530 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]); 8531 } 8532 8533 return 0; 8534 } 8535 8536 static int nl80211_update_mesh_config(struct sk_buff *skb, 8537 struct genl_info *info) 8538 { 8539 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8540 struct net_device *dev = info->user_ptr[1]; 8541 struct wireless_dev *wdev = dev->ieee80211_ptr; 8542 struct mesh_config cfg = {}; 8543 u32 mask; 8544 int err; 8545 8546 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8547 return -EOPNOTSUPP; 8548 8549 if (!rdev->ops->update_mesh_config) 8550 return -EOPNOTSUPP; 8551 8552 err = nl80211_parse_mesh_config(info, &cfg, &mask); 8553 if (err) 8554 return err; 8555 8556 if (!wdev->u.mesh.id_len) 8557 err = -ENOLINK; 8558 8559 if (!err) 8560 err = rdev_update_mesh_config(rdev, dev, mask, &cfg); 8561 8562 return err; 8563 } 8564 8565 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom, 8566 struct sk_buff *msg) 8567 { 8568 struct nlattr *nl_reg_rules; 8569 unsigned int i; 8570 8571 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) || 8572 (regdom->dfs_region && 8573 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region))) 8574 goto nla_put_failure; 8575 8576 nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES); 8577 if (!nl_reg_rules) 8578 goto nla_put_failure; 8579 8580 for (i = 0; i < regdom->n_reg_rules; i++) { 8581 struct nlattr *nl_reg_rule; 8582 const struct ieee80211_reg_rule *reg_rule; 8583 const struct ieee80211_freq_range *freq_range; 8584 const struct ieee80211_power_rule *power_rule; 8585 unsigned int max_bandwidth_khz; 8586 8587 reg_rule = ®dom->reg_rules[i]; 8588 freq_range = ®_rule->freq_range; 8589 power_rule = ®_rule->power_rule; 8590 8591 nl_reg_rule = nla_nest_start_noflag(msg, i); 8592 if (!nl_reg_rule) 8593 goto nla_put_failure; 8594 8595 max_bandwidth_khz = freq_range->max_bandwidth_khz; 8596 if (!max_bandwidth_khz) 8597 max_bandwidth_khz = reg_get_max_bandwidth(regdom, 8598 reg_rule); 8599 8600 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS, 8601 reg_rule->flags) || 8602 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START, 8603 freq_range->start_freq_khz) || 8604 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END, 8605 freq_range->end_freq_khz) || 8606 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW, 8607 max_bandwidth_khz) || 8608 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN, 8609 power_rule->max_antenna_gain) || 8610 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP, 8611 power_rule->max_eirp) || 8612 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME, 8613 reg_rule->dfs_cac_ms)) 8614 goto nla_put_failure; 8615 8616 if ((reg_rule->flags & NL80211_RRF_PSD) && 8617 nla_put_s8(msg, NL80211_ATTR_POWER_RULE_PSD, 8618 reg_rule->psd)) 8619 goto nla_put_failure; 8620 8621 nla_nest_end(msg, nl_reg_rule); 8622 } 8623 8624 nla_nest_end(msg, nl_reg_rules); 8625 return 0; 8626 8627 nla_put_failure: 8628 return -EMSGSIZE; 8629 } 8630 8631 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info) 8632 { 8633 const struct ieee80211_regdomain *regdom = NULL; 8634 struct cfg80211_registered_device *rdev; 8635 struct wiphy *wiphy = NULL; 8636 struct sk_buff *msg; 8637 int err = -EMSGSIZE; 8638 void *hdr; 8639 8640 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8641 if (!msg) 8642 return -ENOBUFS; 8643 8644 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8645 NL80211_CMD_GET_REG); 8646 if (!hdr) 8647 goto put_failure; 8648 8649 rtnl_lock(); 8650 8651 if (info->attrs[NL80211_ATTR_WIPHY]) { 8652 bool self_managed; 8653 8654 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 8655 if (IS_ERR(rdev)) { 8656 err = PTR_ERR(rdev); 8657 goto nla_put_failure; 8658 } 8659 8660 wiphy = &rdev->wiphy; 8661 self_managed = wiphy->regulatory_flags & 8662 REGULATORY_WIPHY_SELF_MANAGED; 8663 8664 rcu_read_lock(); 8665 8666 regdom = get_wiphy_regdom(wiphy); 8667 8668 /* a self-managed-reg device must have a private regdom */ 8669 if (WARN_ON(!regdom && self_managed)) { 8670 err = -EINVAL; 8671 goto nla_put_failure_rcu; 8672 } 8673 8674 if (regdom && 8675 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8676 goto nla_put_failure_rcu; 8677 } else { 8678 rcu_read_lock(); 8679 } 8680 8681 if (!wiphy && reg_last_request_cell_base() && 8682 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8683 NL80211_USER_REG_HINT_CELL_BASE)) 8684 goto nla_put_failure_rcu; 8685 8686 if (!regdom) 8687 regdom = rcu_dereference(cfg80211_regdomain); 8688 8689 if (nl80211_put_regdom(regdom, msg)) 8690 goto nla_put_failure_rcu; 8691 8692 rcu_read_unlock(); 8693 8694 genlmsg_end(msg, hdr); 8695 rtnl_unlock(); 8696 return genlmsg_reply(msg, info); 8697 8698 nla_put_failure_rcu: 8699 rcu_read_unlock(); 8700 nla_put_failure: 8701 rtnl_unlock(); 8702 put_failure: 8703 nlmsg_free(msg); 8704 return err; 8705 } 8706 8707 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb, 8708 u32 seq, int flags, struct wiphy *wiphy, 8709 const struct ieee80211_regdomain *regdom) 8710 { 8711 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 8712 NL80211_CMD_GET_REG); 8713 8714 if (!hdr) 8715 return -1; 8716 8717 genl_dump_check_consistent(cb, hdr); 8718 8719 if (nl80211_put_regdom(regdom, msg)) 8720 goto nla_put_failure; 8721 8722 if (!wiphy && reg_last_request_cell_base() && 8723 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8724 NL80211_USER_REG_HINT_CELL_BASE)) 8725 goto nla_put_failure; 8726 8727 if (wiphy && 8728 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8729 goto nla_put_failure; 8730 8731 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 8732 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 8733 goto nla_put_failure; 8734 8735 genlmsg_end(msg, hdr); 8736 return 0; 8737 8738 nla_put_failure: 8739 genlmsg_cancel(msg, hdr); 8740 return -EMSGSIZE; 8741 } 8742 8743 static int nl80211_get_reg_dump(struct sk_buff *skb, 8744 struct netlink_callback *cb) 8745 { 8746 const struct ieee80211_regdomain *regdom = NULL; 8747 struct cfg80211_registered_device *rdev; 8748 int err, reg_idx, start = cb->args[2]; 8749 8750 rcu_read_lock(); 8751 8752 if (cfg80211_regdomain && start == 0) { 8753 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8754 NLM_F_MULTI, NULL, 8755 rcu_dereference(cfg80211_regdomain)); 8756 if (err < 0) 8757 goto out_err; 8758 } 8759 8760 /* the global regdom is idx 0 */ 8761 reg_idx = 1; 8762 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 8763 regdom = get_wiphy_regdom(&rdev->wiphy); 8764 if (!regdom) 8765 continue; 8766 8767 if (++reg_idx <= start) 8768 continue; 8769 8770 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8771 NLM_F_MULTI, &rdev->wiphy, regdom); 8772 if (err < 0) { 8773 reg_idx--; 8774 break; 8775 } 8776 } 8777 8778 cb->args[2] = reg_idx; 8779 err = skb->len; 8780 out_err: 8781 rcu_read_unlock(); 8782 return err; 8783 } 8784 8785 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 8786 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = { 8787 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 }, 8788 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 }, 8789 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 }, 8790 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 }, 8791 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 }, 8792 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 }, 8793 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 }, 8794 }; 8795 8796 static int parse_reg_rule(struct nlattr *tb[], 8797 struct ieee80211_reg_rule *reg_rule) 8798 { 8799 struct ieee80211_freq_range *freq_range = ®_rule->freq_range; 8800 struct ieee80211_power_rule *power_rule = ®_rule->power_rule; 8801 8802 if (!tb[NL80211_ATTR_REG_RULE_FLAGS]) 8803 return -EINVAL; 8804 if (!tb[NL80211_ATTR_FREQ_RANGE_START]) 8805 return -EINVAL; 8806 if (!tb[NL80211_ATTR_FREQ_RANGE_END]) 8807 return -EINVAL; 8808 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]) 8809 return -EINVAL; 8810 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]) 8811 return -EINVAL; 8812 8813 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]); 8814 8815 freq_range->start_freq_khz = 8816 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]); 8817 freq_range->end_freq_khz = 8818 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]); 8819 freq_range->max_bandwidth_khz = 8820 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]); 8821 8822 power_rule->max_eirp = 8823 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]); 8824 8825 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]) 8826 power_rule->max_antenna_gain = 8827 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]); 8828 8829 if (tb[NL80211_ATTR_DFS_CAC_TIME]) 8830 reg_rule->dfs_cac_ms = 8831 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]); 8832 8833 return 0; 8834 } 8835 8836 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info) 8837 { 8838 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1]; 8839 struct nlattr *nl_reg_rule; 8840 char *alpha2; 8841 int rem_reg_rules, r; 8842 u32 num_rules = 0, rule_idx = 0; 8843 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET; 8844 struct ieee80211_regdomain *rd; 8845 8846 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8847 return -EINVAL; 8848 8849 if (!info->attrs[NL80211_ATTR_REG_RULES]) 8850 return -EINVAL; 8851 8852 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8853 8854 if (info->attrs[NL80211_ATTR_DFS_REGION]) 8855 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]); 8856 8857 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 8858 rem_reg_rules) { 8859 num_rules++; 8860 if (num_rules > NL80211_MAX_SUPP_REG_RULES) 8861 return -EINVAL; 8862 } 8863 8864 rtnl_lock(); 8865 if (!reg_is_valid_request(alpha2)) { 8866 r = -EINVAL; 8867 goto out; 8868 } 8869 8870 rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL); 8871 if (!rd) { 8872 r = -ENOMEM; 8873 goto out; 8874 } 8875 8876 rd->n_reg_rules = num_rules; 8877 rd->alpha2[0] = alpha2[0]; 8878 rd->alpha2[1] = alpha2[1]; 8879 8880 /* 8881 * Disable DFS master mode if the DFS region was 8882 * not supported or known on this kernel. 8883 */ 8884 if (reg_supported_dfs_region(dfs_region)) 8885 rd->dfs_region = dfs_region; 8886 8887 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 8888 rem_reg_rules) { 8889 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX, 8890 nl_reg_rule, reg_rule_policy, 8891 info->extack); 8892 if (r) 8893 goto bad_reg; 8894 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]); 8895 if (r) 8896 goto bad_reg; 8897 8898 rule_idx++; 8899 8900 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) { 8901 r = -EINVAL; 8902 goto bad_reg; 8903 } 8904 } 8905 8906 r = set_regdom(rd, REGD_SOURCE_CRDA); 8907 /* set_regdom takes ownership of rd */ 8908 rd = NULL; 8909 bad_reg: 8910 kfree(rd); 8911 out: 8912 rtnl_unlock(); 8913 return r; 8914 } 8915 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */ 8916 8917 static int validate_scan_freqs(struct nlattr *freqs) 8918 { 8919 struct nlattr *attr1, *attr2; 8920 int n_channels = 0, tmp1, tmp2; 8921 8922 nla_for_each_nested(attr1, freqs, tmp1) 8923 if (nla_len(attr1) != sizeof(u32)) 8924 return 0; 8925 8926 nla_for_each_nested(attr1, freqs, tmp1) { 8927 n_channels++; 8928 /* 8929 * Some hardware has a limited channel list for 8930 * scanning, and it is pretty much nonsensical 8931 * to scan for a channel twice, so disallow that 8932 * and don't require drivers to check that the 8933 * channel list they get isn't longer than what 8934 * they can scan, as long as they can scan all 8935 * the channels they registered at once. 8936 */ 8937 nla_for_each_nested(attr2, freqs, tmp2) 8938 if (attr1 != attr2 && 8939 nla_get_u32(attr1) == nla_get_u32(attr2)) 8940 return 0; 8941 } 8942 8943 return n_channels; 8944 } 8945 8946 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b) 8947 { 8948 return b < NUM_NL80211_BANDS && wiphy->bands[b]; 8949 } 8950 8951 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy, 8952 struct cfg80211_bss_selection *bss_select) 8953 { 8954 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1]; 8955 struct nlattr *nest; 8956 int err; 8957 bool found = false; 8958 int i; 8959 8960 /* only process one nested attribute */ 8961 nest = nla_data(nla); 8962 if (!nla_ok(nest, nla_len(nest))) 8963 return -EINVAL; 8964 8965 err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX, 8966 nest, nl80211_bss_select_policy, 8967 NULL); 8968 if (err) 8969 return err; 8970 8971 /* only one attribute may be given */ 8972 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) { 8973 if (attr[i]) { 8974 if (found) 8975 return -EINVAL; 8976 found = true; 8977 } 8978 } 8979 8980 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID; 8981 8982 if (attr[NL80211_BSS_SELECT_ATTR_RSSI]) 8983 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI; 8984 8985 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) { 8986 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF; 8987 bss_select->param.band_pref = 8988 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]); 8989 if (!is_band_valid(wiphy, bss_select->param.band_pref)) 8990 return -EINVAL; 8991 } 8992 8993 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) { 8994 struct nl80211_bss_select_rssi_adjust *adj_param; 8995 8996 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]); 8997 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST; 8998 bss_select->param.adjust.band = adj_param->band; 8999 bss_select->param.adjust.delta = adj_param->delta; 9000 if (!is_band_valid(wiphy, bss_select->param.adjust.band)) 9001 return -EINVAL; 9002 } 9003 9004 /* user-space did not provide behaviour attribute */ 9005 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID) 9006 return -EINVAL; 9007 9008 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour))) 9009 return -EINVAL; 9010 9011 return 0; 9012 } 9013 9014 int nl80211_parse_random_mac(struct nlattr **attrs, 9015 u8 *mac_addr, u8 *mac_addr_mask) 9016 { 9017 int i; 9018 9019 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) { 9020 eth_zero_addr(mac_addr); 9021 eth_zero_addr(mac_addr_mask); 9022 mac_addr[0] = 0x2; 9023 mac_addr_mask[0] = 0x3; 9024 9025 return 0; 9026 } 9027 9028 /* need both or none */ 9029 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK]) 9030 return -EINVAL; 9031 9032 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN); 9033 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN); 9034 9035 /* don't allow or configure an mcast address */ 9036 if (!is_multicast_ether_addr(mac_addr_mask) || 9037 is_multicast_ether_addr(mac_addr)) 9038 return -EINVAL; 9039 9040 /* 9041 * allow users to pass a MAC address that has bits set outside 9042 * of the mask, but don't bother drivers with having to deal 9043 * with such bits 9044 */ 9045 for (i = 0; i < ETH_ALEN; i++) 9046 mac_addr[i] &= mac_addr_mask[i]; 9047 9048 return 0; 9049 } 9050 9051 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev, 9052 struct ieee80211_channel *chan) 9053 { 9054 unsigned int link_id; 9055 bool all_ok = true; 9056 9057 lockdep_assert_wiphy(wdev->wiphy); 9058 9059 if (!cfg80211_beaconing_iface_active(wdev)) 9060 return true; 9061 9062 /* 9063 * FIXME: check if we have a free HW resource/link for chan 9064 * 9065 * This, as well as the FIXME below, requires knowing the link 9066 * capabilities of the hardware. 9067 */ 9068 9069 /* we cannot leave radar channels */ 9070 for_each_valid_link(wdev, link_id) { 9071 struct cfg80211_chan_def *chandef; 9072 9073 chandef = wdev_chandef(wdev, link_id); 9074 if (!chandef || !chandef->chan) 9075 continue; 9076 9077 /* 9078 * FIXME: don't require all_ok, but rather check only the 9079 * correct HW resource/link onto which 'chan' falls, 9080 * as only that link leaves the channel for doing 9081 * the off-channel operation. 9082 */ 9083 9084 if (chandef->chan->flags & IEEE80211_CHAN_RADAR) 9085 all_ok = false; 9086 } 9087 9088 if (all_ok) 9089 return true; 9090 9091 return regulatory_pre_cac_allowed(wdev->wiphy); 9092 } 9093 9094 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag, 9095 enum nl80211_ext_feature_index feat) 9096 { 9097 if (!(flags & flag)) 9098 return true; 9099 if (wiphy_ext_feature_isset(wiphy, feat)) 9100 return true; 9101 return false; 9102 } 9103 9104 static int 9105 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev, 9106 void *request, struct nlattr **attrs, 9107 bool is_sched_scan) 9108 { 9109 u8 *mac_addr, *mac_addr_mask; 9110 u32 *flags; 9111 enum nl80211_feature_flags randomness_flag; 9112 9113 if (!attrs[NL80211_ATTR_SCAN_FLAGS]) 9114 return 0; 9115 9116 if (is_sched_scan) { 9117 struct cfg80211_sched_scan_request *req = request; 9118 9119 randomness_flag = wdev ? 9120 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR : 9121 NL80211_FEATURE_ND_RANDOM_MAC_ADDR; 9122 flags = &req->flags; 9123 mac_addr = req->mac_addr; 9124 mac_addr_mask = req->mac_addr_mask; 9125 } else { 9126 struct cfg80211_scan_request *req = request; 9127 9128 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; 9129 flags = &req->flags; 9130 mac_addr = req->mac_addr; 9131 mac_addr_mask = req->mac_addr_mask; 9132 } 9133 9134 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]); 9135 9136 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) && 9137 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) || 9138 !nl80211_check_scan_feat(wiphy, *flags, 9139 NL80211_SCAN_FLAG_LOW_SPAN, 9140 NL80211_EXT_FEATURE_LOW_SPAN_SCAN) || 9141 !nl80211_check_scan_feat(wiphy, *flags, 9142 NL80211_SCAN_FLAG_LOW_POWER, 9143 NL80211_EXT_FEATURE_LOW_POWER_SCAN) || 9144 !nl80211_check_scan_feat(wiphy, *flags, 9145 NL80211_SCAN_FLAG_HIGH_ACCURACY, 9146 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) || 9147 !nl80211_check_scan_feat(wiphy, *flags, 9148 NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME, 9149 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) || 9150 !nl80211_check_scan_feat(wiphy, *flags, 9151 NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP, 9152 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) || 9153 !nl80211_check_scan_feat(wiphy, *flags, 9154 NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION, 9155 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) || 9156 !nl80211_check_scan_feat(wiphy, *flags, 9157 NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE, 9158 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) || 9159 !nl80211_check_scan_feat(wiphy, *flags, 9160 NL80211_SCAN_FLAG_RANDOM_SN, 9161 NL80211_EXT_FEATURE_SCAN_RANDOM_SN) || 9162 !nl80211_check_scan_feat(wiphy, *flags, 9163 NL80211_SCAN_FLAG_MIN_PREQ_CONTENT, 9164 NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT)) 9165 return -EOPNOTSUPP; 9166 9167 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { 9168 int err; 9169 9170 if (!(wiphy->features & randomness_flag) || 9171 (wdev && wdev->connected)) 9172 return -EOPNOTSUPP; 9173 9174 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask); 9175 if (err) 9176 return err; 9177 } 9178 9179 return 0; 9180 } 9181 9182 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info) 9183 { 9184 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9185 struct wireless_dev *wdev = info->user_ptr[1]; 9186 struct cfg80211_scan_request *request; 9187 struct nlattr *scan_freqs = NULL; 9188 bool scan_freqs_khz = false; 9189 struct nlattr *attr; 9190 struct wiphy *wiphy; 9191 int err, tmp, n_ssids = 0, n_channels, i; 9192 size_t ie_len, size; 9193 size_t ssids_offset, ie_offset; 9194 9195 wiphy = &rdev->wiphy; 9196 9197 if (wdev->iftype == NL80211_IFTYPE_NAN) 9198 return -EOPNOTSUPP; 9199 9200 if (!rdev->ops->scan) 9201 return -EOPNOTSUPP; 9202 9203 if (rdev->scan_req || rdev->scan_msg) 9204 return -EBUSY; 9205 9206 if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) { 9207 if (!wiphy_ext_feature_isset(wiphy, 9208 NL80211_EXT_FEATURE_SCAN_FREQ_KHZ)) 9209 return -EOPNOTSUPP; 9210 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]; 9211 scan_freqs_khz = true; 9212 } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) 9213 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]; 9214 9215 if (scan_freqs) { 9216 n_channels = validate_scan_freqs(scan_freqs); 9217 if (!n_channels) 9218 return -EINVAL; 9219 } else { 9220 n_channels = ieee80211_get_num_supported_channels(wiphy); 9221 } 9222 9223 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) 9224 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) 9225 n_ssids++; 9226 9227 if (n_ssids > wiphy->max_scan_ssids) 9228 return -EINVAL; 9229 9230 if (info->attrs[NL80211_ATTR_IE]) 9231 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9232 else 9233 ie_len = 0; 9234 9235 if (ie_len > wiphy->max_scan_ie_len) 9236 return -EINVAL; 9237 9238 size = struct_size(request, channels, n_channels); 9239 ssids_offset = size; 9240 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9241 ie_offset = size; 9242 size = size_add(size, ie_len); 9243 request = kzalloc(size, GFP_KERNEL); 9244 if (!request) 9245 return -ENOMEM; 9246 request->n_channels = n_channels; 9247 9248 if (n_ssids) 9249 request->ssids = (void *)request + ssids_offset; 9250 request->n_ssids = n_ssids; 9251 if (ie_len) 9252 request->ie = (void *)request + ie_offset; 9253 9254 i = 0; 9255 if (scan_freqs) { 9256 /* user specified, bail out if channel not found */ 9257 nla_for_each_nested(attr, scan_freqs, tmp) { 9258 struct ieee80211_channel *chan; 9259 int freq = nla_get_u32(attr); 9260 9261 if (!scan_freqs_khz) 9262 freq = MHZ_TO_KHZ(freq); 9263 9264 chan = ieee80211_get_channel_khz(wiphy, freq); 9265 if (!chan) { 9266 err = -EINVAL; 9267 goto out_free; 9268 } 9269 9270 /* ignore disabled channels */ 9271 if (chan->flags & IEEE80211_CHAN_DISABLED) 9272 continue; 9273 9274 request->channels[i] = chan; 9275 i++; 9276 } 9277 } else { 9278 enum nl80211_band band; 9279 9280 /* all channels */ 9281 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9282 int j; 9283 9284 if (!wiphy->bands[band]) 9285 continue; 9286 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9287 struct ieee80211_channel *chan; 9288 9289 chan = &wiphy->bands[band]->channels[j]; 9290 9291 if (chan->flags & IEEE80211_CHAN_DISABLED) 9292 continue; 9293 9294 request->channels[i] = chan; 9295 i++; 9296 } 9297 } 9298 } 9299 9300 if (!i) { 9301 err = -EINVAL; 9302 goto out_free; 9303 } 9304 9305 request->n_channels = i; 9306 9307 for (i = 0; i < request->n_channels; i++) { 9308 struct ieee80211_channel *chan = request->channels[i]; 9309 9310 /* if we can go off-channel to the target channel we're good */ 9311 if (cfg80211_off_channel_oper_allowed(wdev, chan)) 9312 continue; 9313 9314 if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) { 9315 err = -EBUSY; 9316 goto out_free; 9317 } 9318 } 9319 9320 i = 0; 9321 if (n_ssids) { 9322 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) { 9323 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9324 err = -EINVAL; 9325 goto out_free; 9326 } 9327 request->ssids[i].ssid_len = nla_len(attr); 9328 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr)); 9329 i++; 9330 } 9331 } 9332 9333 if (info->attrs[NL80211_ATTR_IE]) { 9334 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9335 memcpy((void *)request->ie, 9336 nla_data(info->attrs[NL80211_ATTR_IE]), 9337 request->ie_len); 9338 } 9339 9340 for (i = 0; i < NUM_NL80211_BANDS; i++) 9341 if (wiphy->bands[i]) 9342 request->rates[i] = 9343 (1 << wiphy->bands[i]->n_bitrates) - 1; 9344 9345 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) { 9346 nla_for_each_nested(attr, 9347 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES], 9348 tmp) { 9349 enum nl80211_band band = nla_type(attr); 9350 9351 if (band < 0 || band >= NUM_NL80211_BANDS) { 9352 err = -EINVAL; 9353 goto out_free; 9354 } 9355 9356 if (!wiphy->bands[band]) 9357 continue; 9358 9359 err = ieee80211_get_ratemask(wiphy->bands[band], 9360 nla_data(attr), 9361 nla_len(attr), 9362 &request->rates[band]); 9363 if (err) 9364 goto out_free; 9365 } 9366 } 9367 9368 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) { 9369 request->duration = 9370 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]); 9371 request->duration_mandatory = 9372 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]); 9373 } 9374 9375 err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs, 9376 false); 9377 if (err) 9378 goto out_free; 9379 9380 request->no_cck = 9381 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 9382 9383 /* Initial implementation used NL80211_ATTR_MAC to set the specific 9384 * BSSID to scan for. This was problematic because that same attribute 9385 * was already used for another purpose (local random MAC address). The 9386 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards 9387 * compatibility with older userspace components, also use the 9388 * NL80211_ATTR_MAC value here if it can be determined to be used for 9389 * the specific BSSID use case instead of the random MAC address 9390 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use). 9391 */ 9392 if (info->attrs[NL80211_ATTR_BSSID]) 9393 memcpy(request->bssid, 9394 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN); 9395 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) && 9396 info->attrs[NL80211_ATTR_MAC]) 9397 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]), 9398 ETH_ALEN); 9399 else 9400 eth_broadcast_addr(request->bssid); 9401 9402 request->tsf_report_link_id = nl80211_link_id_or_invalid(info->attrs); 9403 request->wdev = wdev; 9404 request->wiphy = &rdev->wiphy; 9405 request->scan_start = jiffies; 9406 9407 rdev->scan_req = request; 9408 err = cfg80211_scan(rdev); 9409 9410 if (err) 9411 goto out_free; 9412 9413 nl80211_send_scan_start(rdev, wdev); 9414 dev_hold(wdev->netdev); 9415 9416 return 0; 9417 9418 out_free: 9419 rdev->scan_req = NULL; 9420 kfree(request); 9421 9422 return err; 9423 } 9424 9425 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info) 9426 { 9427 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9428 struct wireless_dev *wdev = info->user_ptr[1]; 9429 9430 if (!rdev->ops->abort_scan) 9431 return -EOPNOTSUPP; 9432 9433 if (rdev->scan_msg) 9434 return 0; 9435 9436 if (!rdev->scan_req) 9437 return -ENOENT; 9438 9439 rdev_abort_scan(rdev, wdev); 9440 return 0; 9441 } 9442 9443 static int 9444 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans, 9445 struct cfg80211_sched_scan_request *request, 9446 struct nlattr **attrs) 9447 { 9448 int tmp, err, i = 0; 9449 struct nlattr *attr; 9450 9451 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9452 u32 interval; 9453 9454 /* 9455 * If scan plans are not specified, 9456 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this 9457 * case one scan plan will be set with the specified scan 9458 * interval and infinite number of iterations. 9459 */ 9460 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]); 9461 if (!interval) 9462 return -EINVAL; 9463 9464 request->scan_plans[0].interval = 9465 DIV_ROUND_UP(interval, MSEC_PER_SEC); 9466 if (!request->scan_plans[0].interval) 9467 return -EINVAL; 9468 9469 if (request->scan_plans[0].interval > 9470 wiphy->max_sched_scan_plan_interval) 9471 request->scan_plans[0].interval = 9472 wiphy->max_sched_scan_plan_interval; 9473 9474 return 0; 9475 } 9476 9477 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) { 9478 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1]; 9479 9480 if (WARN_ON(i >= n_plans)) 9481 return -EINVAL; 9482 9483 err = nla_parse_nested_deprecated(plan, 9484 NL80211_SCHED_SCAN_PLAN_MAX, 9485 attr, nl80211_plan_policy, 9486 NULL); 9487 if (err) 9488 return err; 9489 9490 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]) 9491 return -EINVAL; 9492 9493 request->scan_plans[i].interval = 9494 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]); 9495 if (!request->scan_plans[i].interval || 9496 request->scan_plans[i].interval > 9497 wiphy->max_sched_scan_plan_interval) 9498 return -EINVAL; 9499 9500 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) { 9501 request->scan_plans[i].iterations = 9502 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]); 9503 if (!request->scan_plans[i].iterations || 9504 (request->scan_plans[i].iterations > 9505 wiphy->max_sched_scan_plan_iterations)) 9506 return -EINVAL; 9507 } else if (i < n_plans - 1) { 9508 /* 9509 * All scan plans but the last one must specify 9510 * a finite number of iterations 9511 */ 9512 return -EINVAL; 9513 } 9514 9515 i++; 9516 } 9517 9518 /* 9519 * The last scan plan must not specify the number of 9520 * iterations, it is supposed to run infinitely 9521 */ 9522 if (request->scan_plans[n_plans - 1].iterations) 9523 return -EINVAL; 9524 9525 return 0; 9526 } 9527 9528 static struct cfg80211_sched_scan_request * 9529 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev, 9530 struct nlattr **attrs, int max_match_sets) 9531 { 9532 struct cfg80211_sched_scan_request *request; 9533 struct nlattr *attr; 9534 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0; 9535 enum nl80211_band band; 9536 size_t ie_len, size; 9537 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1]; 9538 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF; 9539 9540 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9541 n_channels = validate_scan_freqs( 9542 attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 9543 if (!n_channels) 9544 return ERR_PTR(-EINVAL); 9545 } else { 9546 n_channels = ieee80211_get_num_supported_channels(wiphy); 9547 } 9548 9549 if (attrs[NL80211_ATTR_SCAN_SSIDS]) 9550 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9551 tmp) 9552 n_ssids++; 9553 9554 if (n_ssids > wiphy->max_sched_scan_ssids) 9555 return ERR_PTR(-EINVAL); 9556 9557 /* 9558 * First, count the number of 'real' matchsets. Due to an issue with 9559 * the old implementation, matchsets containing only the RSSI attribute 9560 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default' 9561 * RSSI for all matchsets, rather than their own matchset for reporting 9562 * all APs with a strong RSSI. This is needed to be compatible with 9563 * older userspace that treated a matchset with only the RSSI as the 9564 * global RSSI for all other matchsets - if there are other matchsets. 9565 */ 9566 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9567 nla_for_each_nested(attr, 9568 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9569 tmp) { 9570 struct nlattr *rssi; 9571 9572 err = nla_parse_nested_deprecated(tb, 9573 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9574 attr, 9575 nl80211_match_policy, 9576 NULL); 9577 if (err) 9578 return ERR_PTR(err); 9579 9580 /* SSID and BSSID are mutually exclusive */ 9581 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] && 9582 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) 9583 return ERR_PTR(-EINVAL); 9584 9585 /* add other standalone attributes here */ 9586 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] || 9587 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) { 9588 n_match_sets++; 9589 continue; 9590 } 9591 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9592 if (rssi) 9593 default_match_rssi = nla_get_s32(rssi); 9594 } 9595 } 9596 9597 /* However, if there's no other matchset, add the RSSI one */ 9598 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF) 9599 n_match_sets = 1; 9600 9601 if (n_match_sets > max_match_sets) 9602 return ERR_PTR(-EINVAL); 9603 9604 if (attrs[NL80211_ATTR_IE]) 9605 ie_len = nla_len(attrs[NL80211_ATTR_IE]); 9606 else 9607 ie_len = 0; 9608 9609 if (ie_len > wiphy->max_sched_scan_ie_len) 9610 return ERR_PTR(-EINVAL); 9611 9612 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9613 /* 9614 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since 9615 * each scan plan already specifies its own interval 9616 */ 9617 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9618 return ERR_PTR(-EINVAL); 9619 9620 nla_for_each_nested(attr, 9621 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) 9622 n_plans++; 9623 } else { 9624 /* 9625 * The scan interval attribute is kept for backward 9626 * compatibility. If no scan plans are specified and sched scan 9627 * interval is specified, one scan plan will be set with this 9628 * scan interval and infinite number of iterations. 9629 */ 9630 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9631 return ERR_PTR(-EINVAL); 9632 9633 n_plans = 1; 9634 } 9635 9636 if (!n_plans || n_plans > wiphy->max_sched_scan_plans) 9637 return ERR_PTR(-EINVAL); 9638 9639 if (!wiphy_ext_feature_isset( 9640 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) && 9641 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] || 9642 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST])) 9643 return ERR_PTR(-EINVAL); 9644 9645 size = struct_size(request, channels, n_channels); 9646 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9647 size = size_add(size, array_size(sizeof(*request->match_sets), 9648 n_match_sets)); 9649 size = size_add(size, array_size(sizeof(*request->scan_plans), 9650 n_plans)); 9651 size = size_add(size, ie_len); 9652 request = kzalloc(size, GFP_KERNEL); 9653 if (!request) 9654 return ERR_PTR(-ENOMEM); 9655 9656 if (n_ssids) 9657 request->ssids = (void *)&request->channels[n_channels]; 9658 request->n_ssids = n_ssids; 9659 if (ie_len) { 9660 if (n_ssids) 9661 request->ie = (void *)(request->ssids + n_ssids); 9662 else 9663 request->ie = (void *)(request->channels + n_channels); 9664 } 9665 9666 if (n_match_sets) { 9667 if (request->ie) 9668 request->match_sets = (void *)(request->ie + ie_len); 9669 else if (n_ssids) 9670 request->match_sets = 9671 (void *)(request->ssids + n_ssids); 9672 else 9673 request->match_sets = 9674 (void *)(request->channels + n_channels); 9675 } 9676 request->n_match_sets = n_match_sets; 9677 9678 if (n_match_sets) 9679 request->scan_plans = (void *)(request->match_sets + 9680 n_match_sets); 9681 else if (request->ie) 9682 request->scan_plans = (void *)(request->ie + ie_len); 9683 else if (n_ssids) 9684 request->scan_plans = (void *)(request->ssids + n_ssids); 9685 else 9686 request->scan_plans = (void *)(request->channels + n_channels); 9687 9688 request->n_scan_plans = n_plans; 9689 9690 i = 0; 9691 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9692 /* user specified, bail out if channel not found */ 9693 nla_for_each_nested(attr, 9694 attrs[NL80211_ATTR_SCAN_FREQUENCIES], 9695 tmp) { 9696 struct ieee80211_channel *chan; 9697 9698 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 9699 9700 if (!chan) { 9701 err = -EINVAL; 9702 goto out_free; 9703 } 9704 9705 /* ignore disabled channels */ 9706 if (chan->flags & IEEE80211_CHAN_DISABLED) 9707 continue; 9708 9709 request->channels[i] = chan; 9710 i++; 9711 } 9712 } else { 9713 /* all channels */ 9714 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9715 int j; 9716 9717 if (!wiphy->bands[band]) 9718 continue; 9719 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9720 struct ieee80211_channel *chan; 9721 9722 chan = &wiphy->bands[band]->channels[j]; 9723 9724 if (chan->flags & IEEE80211_CHAN_DISABLED) 9725 continue; 9726 9727 request->channels[i] = chan; 9728 i++; 9729 } 9730 } 9731 } 9732 9733 if (!i) { 9734 err = -EINVAL; 9735 goto out_free; 9736 } 9737 9738 request->n_channels = i; 9739 9740 i = 0; 9741 if (n_ssids) { 9742 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9743 tmp) { 9744 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9745 err = -EINVAL; 9746 goto out_free; 9747 } 9748 request->ssids[i].ssid_len = nla_len(attr); 9749 memcpy(request->ssids[i].ssid, nla_data(attr), 9750 nla_len(attr)); 9751 i++; 9752 } 9753 } 9754 9755 i = 0; 9756 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9757 nla_for_each_nested(attr, 9758 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9759 tmp) { 9760 struct nlattr *ssid, *bssid, *rssi; 9761 9762 err = nla_parse_nested_deprecated(tb, 9763 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9764 attr, 9765 nl80211_match_policy, 9766 NULL); 9767 if (err) 9768 goto out_free; 9769 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]; 9770 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]; 9771 9772 if (!ssid && !bssid) { 9773 i++; 9774 continue; 9775 } 9776 9777 if (WARN_ON(i >= n_match_sets)) { 9778 /* this indicates a programming error, 9779 * the loop above should have verified 9780 * things properly 9781 */ 9782 err = -EINVAL; 9783 goto out_free; 9784 } 9785 9786 if (ssid) { 9787 memcpy(request->match_sets[i].ssid.ssid, 9788 nla_data(ssid), nla_len(ssid)); 9789 request->match_sets[i].ssid.ssid_len = 9790 nla_len(ssid); 9791 } 9792 if (bssid) 9793 memcpy(request->match_sets[i].bssid, 9794 nla_data(bssid), ETH_ALEN); 9795 9796 /* special attribute - old implementation w/a */ 9797 request->match_sets[i].rssi_thold = default_match_rssi; 9798 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9799 if (rssi) 9800 request->match_sets[i].rssi_thold = 9801 nla_get_s32(rssi); 9802 i++; 9803 } 9804 9805 /* there was no other matchset, so the RSSI one is alone */ 9806 if (i == 0 && n_match_sets) 9807 request->match_sets[0].rssi_thold = default_match_rssi; 9808 9809 request->min_rssi_thold = INT_MAX; 9810 for (i = 0; i < n_match_sets; i++) 9811 request->min_rssi_thold = 9812 min(request->match_sets[i].rssi_thold, 9813 request->min_rssi_thold); 9814 } else { 9815 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF; 9816 } 9817 9818 if (ie_len) { 9819 request->ie_len = ie_len; 9820 memcpy((void *)request->ie, 9821 nla_data(attrs[NL80211_ATTR_IE]), 9822 request->ie_len); 9823 } 9824 9825 err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true); 9826 if (err) 9827 goto out_free; 9828 9829 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY]) 9830 request->delay = 9831 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]); 9832 9833 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) { 9834 request->relative_rssi = nla_get_s8( 9835 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]); 9836 request->relative_rssi_set = true; 9837 } 9838 9839 if (request->relative_rssi_set && 9840 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) { 9841 struct nl80211_bss_select_rssi_adjust *rssi_adjust; 9842 9843 rssi_adjust = nla_data( 9844 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]); 9845 request->rssi_adjust.band = rssi_adjust->band; 9846 request->rssi_adjust.delta = rssi_adjust->delta; 9847 if (!is_band_valid(wiphy, request->rssi_adjust.band)) { 9848 err = -EINVAL; 9849 goto out_free; 9850 } 9851 } 9852 9853 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs); 9854 if (err) 9855 goto out_free; 9856 9857 request->scan_start = jiffies; 9858 9859 return request; 9860 9861 out_free: 9862 kfree(request); 9863 return ERR_PTR(err); 9864 } 9865 9866 static int nl80211_start_sched_scan(struct sk_buff *skb, 9867 struct genl_info *info) 9868 { 9869 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9870 struct net_device *dev = info->user_ptr[1]; 9871 struct wireless_dev *wdev = dev->ieee80211_ptr; 9872 struct cfg80211_sched_scan_request *sched_scan_req; 9873 bool want_multi; 9874 int err; 9875 9876 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start) 9877 return -EOPNOTSUPP; 9878 9879 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI]; 9880 err = cfg80211_sched_scan_req_possible(rdev, want_multi); 9881 if (err) 9882 return err; 9883 9884 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev, 9885 info->attrs, 9886 rdev->wiphy.max_match_sets); 9887 9888 err = PTR_ERR_OR_ZERO(sched_scan_req); 9889 if (err) 9890 goto out_err; 9891 9892 /* leave request id zero for legacy request 9893 * or if driver does not support multi-scheduled scan 9894 */ 9895 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) 9896 sched_scan_req->reqid = cfg80211_assign_cookie(rdev); 9897 9898 err = rdev_sched_scan_start(rdev, dev, sched_scan_req); 9899 if (err) 9900 goto out_free; 9901 9902 sched_scan_req->dev = dev; 9903 sched_scan_req->wiphy = &rdev->wiphy; 9904 9905 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 9906 sched_scan_req->owner_nlportid = info->snd_portid; 9907 9908 cfg80211_add_sched_scan_req(rdev, sched_scan_req); 9909 9910 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN); 9911 return 0; 9912 9913 out_free: 9914 kfree(sched_scan_req); 9915 out_err: 9916 return err; 9917 } 9918 9919 static int nl80211_stop_sched_scan(struct sk_buff *skb, 9920 struct genl_info *info) 9921 { 9922 struct cfg80211_sched_scan_request *req; 9923 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9924 u64 cookie; 9925 9926 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop) 9927 return -EOPNOTSUPP; 9928 9929 if (info->attrs[NL80211_ATTR_COOKIE]) { 9930 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 9931 return __cfg80211_stop_sched_scan(rdev, cookie, false); 9932 } 9933 9934 req = list_first_or_null_rcu(&rdev->sched_scan_req_list, 9935 struct cfg80211_sched_scan_request, 9936 list); 9937 if (!req || req->reqid || 9938 (req->owner_nlportid && 9939 req->owner_nlportid != info->snd_portid)) 9940 return -ENOENT; 9941 9942 return cfg80211_stop_sched_scan_req(rdev, req, false); 9943 } 9944 9945 static int nl80211_start_radar_detection(struct sk_buff *skb, 9946 struct genl_info *info) 9947 { 9948 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9949 struct net_device *dev = info->user_ptr[1]; 9950 struct wireless_dev *wdev = dev->ieee80211_ptr; 9951 struct wiphy *wiphy = wdev->wiphy; 9952 struct cfg80211_chan_def chandef; 9953 enum nl80211_dfs_regions dfs_region; 9954 unsigned int cac_time_ms; 9955 int err = -EINVAL; 9956 9957 flush_delayed_work(&rdev->dfs_update_channels_wk); 9958 9959 wiphy_lock(wiphy); 9960 9961 dfs_region = reg_get_dfs_region(wiphy); 9962 if (dfs_region == NL80211_DFS_UNSET) 9963 goto unlock; 9964 9965 err = nl80211_parse_chandef(rdev, info, &chandef); 9966 if (err) 9967 goto unlock; 9968 9969 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 9970 if (err < 0) 9971 goto unlock; 9972 9973 if (err == 0) { 9974 err = -EINVAL; 9975 goto unlock; 9976 } 9977 9978 if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) { 9979 err = -EINVAL; 9980 goto unlock; 9981 } 9982 9983 if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) { 9984 err = cfg80211_start_background_radar_detection(rdev, wdev, 9985 &chandef); 9986 goto unlock; 9987 } 9988 9989 if (netif_carrier_ok(dev)) { 9990 err = -EBUSY; 9991 goto unlock; 9992 } 9993 9994 if (wdev->cac_started) { 9995 err = -EBUSY; 9996 goto unlock; 9997 } 9998 9999 /* CAC start is offloaded to HW and can't be started manually */ 10000 if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) { 10001 err = -EOPNOTSUPP; 10002 goto unlock; 10003 } 10004 10005 if (!rdev->ops->start_radar_detection) { 10006 err = -EOPNOTSUPP; 10007 goto unlock; 10008 } 10009 10010 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef); 10011 if (WARN_ON(!cac_time_ms)) 10012 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS; 10013 10014 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms); 10015 if (!err) { 10016 wdev->links[0].ap.chandef = chandef; 10017 wdev->cac_started = true; 10018 wdev->cac_start_time = jiffies; 10019 wdev->cac_time_ms = cac_time_ms; 10020 } 10021 unlock: 10022 wiphy_unlock(wiphy); 10023 10024 return err; 10025 } 10026 10027 static int nl80211_notify_radar_detection(struct sk_buff *skb, 10028 struct genl_info *info) 10029 { 10030 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10031 struct net_device *dev = info->user_ptr[1]; 10032 struct wireless_dev *wdev = dev->ieee80211_ptr; 10033 struct wiphy *wiphy = wdev->wiphy; 10034 struct cfg80211_chan_def chandef; 10035 enum nl80211_dfs_regions dfs_region; 10036 int err; 10037 10038 dfs_region = reg_get_dfs_region(wiphy); 10039 if (dfs_region == NL80211_DFS_UNSET) { 10040 GENL_SET_ERR_MSG(info, 10041 "DFS Region is not set. Unexpected Radar indication"); 10042 return -EINVAL; 10043 } 10044 10045 err = nl80211_parse_chandef(rdev, info, &chandef); 10046 if (err) { 10047 GENL_SET_ERR_MSG(info, "Unable to extract chandef info"); 10048 return err; 10049 } 10050 10051 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 10052 if (err < 0) { 10053 GENL_SET_ERR_MSG(info, "chandef is invalid"); 10054 return err; 10055 } 10056 10057 if (err == 0) { 10058 GENL_SET_ERR_MSG(info, 10059 "Unexpected Radar indication for chandef/iftype"); 10060 return -EINVAL; 10061 } 10062 10063 /* Do not process this notification if radar is already detected 10064 * by kernel on this channel, and return success. 10065 */ 10066 if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE) 10067 return 0; 10068 10069 cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE); 10070 10071 cfg80211_sched_dfs_chan_update(rdev); 10072 10073 rdev->radar_chandef = chandef; 10074 10075 /* Propagate this notification to other radios as well */ 10076 queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk); 10077 10078 return 0; 10079 } 10080 10081 static int nl80211_parse_counter_offsets(struct cfg80211_registered_device *rdev, 10082 const u8 *data, size_t datalen, 10083 int first_count, struct nlattr *attr, 10084 const u16 **offsets, unsigned int *n_offsets) 10085 { 10086 int i; 10087 10088 *n_offsets = 0; 10089 10090 if (!attr) 10091 return 0; 10092 10093 if (!nla_len(attr) || (nla_len(attr) % sizeof(u16))) 10094 return -EINVAL; 10095 10096 *n_offsets = nla_len(attr) / sizeof(u16); 10097 if (rdev->wiphy.max_num_csa_counters && 10098 (*n_offsets > rdev->wiphy.max_num_csa_counters)) 10099 return -EINVAL; 10100 10101 *offsets = nla_data(attr); 10102 10103 /* sanity checks - counters should fit and be the same */ 10104 for (i = 0; i < *n_offsets; i++) { 10105 u16 offset = (*offsets)[i]; 10106 10107 if (offset >= datalen) 10108 return -EINVAL; 10109 10110 if (first_count != -1 && data[offset] != first_count) 10111 return -EINVAL; 10112 } 10113 10114 return 0; 10115 } 10116 10117 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info) 10118 { 10119 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10120 unsigned int link_id = nl80211_link_id(info->attrs); 10121 struct net_device *dev = info->user_ptr[1]; 10122 struct wireless_dev *wdev = dev->ieee80211_ptr; 10123 struct cfg80211_csa_settings params; 10124 struct nlattr **csa_attrs = NULL; 10125 int err; 10126 bool need_new_beacon = false; 10127 bool need_handle_dfs_flag = true; 10128 u32 cs_count; 10129 10130 if (!rdev->ops->channel_switch || 10131 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 10132 return -EOPNOTSUPP; 10133 10134 switch (dev->ieee80211_ptr->iftype) { 10135 case NL80211_IFTYPE_AP: 10136 case NL80211_IFTYPE_P2P_GO: 10137 need_new_beacon = true; 10138 /* For all modes except AP the handle_dfs flag needs to be 10139 * supplied to tell the kernel that userspace will handle radar 10140 * events when they happen. Otherwise a switch to a channel 10141 * requiring DFS will be rejected. 10142 */ 10143 need_handle_dfs_flag = false; 10144 10145 /* useless if AP is not running */ 10146 if (!wdev->links[link_id].ap.beacon_interval) 10147 return -ENOTCONN; 10148 break; 10149 case NL80211_IFTYPE_ADHOC: 10150 if (!wdev->u.ibss.ssid_len) 10151 return -ENOTCONN; 10152 break; 10153 case NL80211_IFTYPE_MESH_POINT: 10154 if (!wdev->u.mesh.id_len) 10155 return -ENOTCONN; 10156 break; 10157 default: 10158 return -EOPNOTSUPP; 10159 } 10160 10161 memset(¶ms, 0, sizeof(params)); 10162 params.beacon_csa.ftm_responder = -1; 10163 10164 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 10165 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]) 10166 return -EINVAL; 10167 10168 /* only important for AP, IBSS and mesh create IEs internally */ 10169 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES]) 10170 return -EINVAL; 10171 10172 /* Even though the attribute is u32, the specification says 10173 * u8, so let's make sure we don't overflow. 10174 */ 10175 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]); 10176 if (cs_count > 255) 10177 return -EINVAL; 10178 10179 params.count = cs_count; 10180 10181 if (!need_new_beacon) 10182 goto skip_beacons; 10183 10184 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_after, 10185 info->extack); 10186 if (err) 10187 goto free; 10188 10189 csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs), 10190 GFP_KERNEL); 10191 if (!csa_attrs) { 10192 err = -ENOMEM; 10193 goto free; 10194 } 10195 10196 err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX, 10197 info->attrs[NL80211_ATTR_CSA_IES], 10198 nl80211_policy, info->extack); 10199 if (err) 10200 goto free; 10201 10202 err = nl80211_parse_beacon(rdev, csa_attrs, ¶ms.beacon_csa, 10203 info->extack); 10204 if (err) 10205 goto free; 10206 10207 if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 10208 err = -EINVAL; 10209 goto free; 10210 } 10211 10212 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.tail, 10213 params.beacon_csa.tail_len, 10214 params.count, 10215 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON], 10216 ¶ms.counter_offsets_beacon, 10217 ¶ms.n_counter_offsets_beacon); 10218 if (err) 10219 goto free; 10220 10221 err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.probe_resp, 10222 params.beacon_csa.probe_resp_len, 10223 params.count, 10224 csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP], 10225 ¶ms.counter_offsets_presp, 10226 ¶ms.n_counter_offsets_presp); 10227 if (err) 10228 goto free; 10229 10230 skip_beacons: 10231 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 10232 if (err) 10233 goto free; 10234 10235 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 10236 wdev->iftype)) { 10237 err = -EINVAL; 10238 goto free; 10239 } 10240 10241 err = cfg80211_chandef_dfs_required(wdev->wiphy, 10242 ¶ms.chandef, 10243 wdev->iftype); 10244 if (err < 0) 10245 goto free; 10246 10247 if (err > 0) { 10248 params.radar_required = true; 10249 if (need_handle_dfs_flag && 10250 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) { 10251 err = -EINVAL; 10252 goto free; 10253 } 10254 } 10255 10256 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX]) 10257 params.block_tx = true; 10258 10259 params.link_id = link_id; 10260 err = rdev_channel_switch(rdev, dev, ¶ms); 10261 10262 free: 10263 kfree(params.beacon_after.mbssid_ies); 10264 kfree(params.beacon_csa.mbssid_ies); 10265 kfree(params.beacon_after.rnr_ies); 10266 kfree(params.beacon_csa.rnr_ies); 10267 kfree(csa_attrs); 10268 return err; 10269 } 10270 10271 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb, 10272 u32 seq, int flags, 10273 struct cfg80211_registered_device *rdev, 10274 struct wireless_dev *wdev, 10275 struct cfg80211_internal_bss *intbss) 10276 { 10277 struct cfg80211_bss *res = &intbss->pub; 10278 const struct cfg80211_bss_ies *ies; 10279 unsigned int link_id; 10280 void *hdr; 10281 struct nlattr *bss; 10282 10283 lockdep_assert_wiphy(wdev->wiphy); 10284 10285 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 10286 NL80211_CMD_NEW_SCAN_RESULTS); 10287 if (!hdr) 10288 return -1; 10289 10290 genl_dump_check_consistent(cb, hdr); 10291 10292 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation)) 10293 goto nla_put_failure; 10294 if (wdev->netdev && 10295 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex)) 10296 goto nla_put_failure; 10297 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 10298 NL80211_ATTR_PAD)) 10299 goto nla_put_failure; 10300 10301 bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS); 10302 if (!bss) 10303 goto nla_put_failure; 10304 if ((!is_zero_ether_addr(res->bssid) && 10305 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid))) 10306 goto nla_put_failure; 10307 10308 rcu_read_lock(); 10309 /* indicate whether we have probe response data or not */ 10310 if (rcu_access_pointer(res->proberesp_ies) && 10311 nla_put_flag(msg, NL80211_BSS_PRESP_DATA)) 10312 goto fail_unlock_rcu; 10313 10314 /* this pointer prefers to be pointed to probe response data 10315 * but is always valid 10316 */ 10317 ies = rcu_dereference(res->ies); 10318 if (ies) { 10319 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf, 10320 NL80211_BSS_PAD)) 10321 goto fail_unlock_rcu; 10322 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS, 10323 ies->len, ies->data)) 10324 goto fail_unlock_rcu; 10325 } 10326 10327 /* and this pointer is always (unless driver didn't know) beacon data */ 10328 ies = rcu_dereference(res->beacon_ies); 10329 if (ies && ies->from_beacon) { 10330 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf, 10331 NL80211_BSS_PAD)) 10332 goto fail_unlock_rcu; 10333 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES, 10334 ies->len, ies->data)) 10335 goto fail_unlock_rcu; 10336 } 10337 rcu_read_unlock(); 10338 10339 if (res->beacon_interval && 10340 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval)) 10341 goto nla_put_failure; 10342 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) || 10343 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) || 10344 nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET, 10345 res->channel->freq_offset) || 10346 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO, 10347 jiffies_to_msecs(jiffies - intbss->ts))) 10348 goto nla_put_failure; 10349 10350 if (intbss->parent_tsf && 10351 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF, 10352 intbss->parent_tsf, NL80211_BSS_PAD) || 10353 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN, 10354 intbss->parent_bssid))) 10355 goto nla_put_failure; 10356 10357 if (intbss->ts_boottime && 10358 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME, 10359 intbss->ts_boottime, NL80211_BSS_PAD)) 10360 goto nla_put_failure; 10361 10362 if (!nl80211_put_signal(msg, intbss->pub.chains, 10363 intbss->pub.chain_signal, 10364 NL80211_BSS_CHAIN_SIGNAL)) 10365 goto nla_put_failure; 10366 10367 switch (rdev->wiphy.signal_type) { 10368 case CFG80211_SIGNAL_TYPE_MBM: 10369 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal)) 10370 goto nla_put_failure; 10371 break; 10372 case CFG80211_SIGNAL_TYPE_UNSPEC: 10373 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal)) 10374 goto nla_put_failure; 10375 break; 10376 default: 10377 break; 10378 } 10379 10380 switch (wdev->iftype) { 10381 case NL80211_IFTYPE_P2P_CLIENT: 10382 case NL80211_IFTYPE_STATION: 10383 for_each_valid_link(wdev, link_id) { 10384 if (intbss == wdev->links[link_id].client.current_bss && 10385 (nla_put_u32(msg, NL80211_BSS_STATUS, 10386 NL80211_BSS_STATUS_ASSOCIATED) || 10387 (wdev->valid_links && 10388 (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID, 10389 link_id) || 10390 nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN, 10391 wdev->u.client.connected_addr))))) 10392 goto nla_put_failure; 10393 } 10394 break; 10395 case NL80211_IFTYPE_ADHOC: 10396 if (intbss == wdev->u.ibss.current_bss && 10397 nla_put_u32(msg, NL80211_BSS_STATUS, 10398 NL80211_BSS_STATUS_IBSS_JOINED)) 10399 goto nla_put_failure; 10400 break; 10401 default: 10402 break; 10403 } 10404 10405 if (nla_put_u32(msg, NL80211_BSS_USE_FOR, res->use_for)) 10406 goto nla_put_failure; 10407 10408 if (res->cannot_use_reasons && 10409 nla_put_u64_64bit(msg, NL80211_BSS_CANNOT_USE_REASONS, 10410 res->cannot_use_reasons, 10411 NL80211_BSS_PAD)) 10412 goto nla_put_failure; 10413 10414 nla_nest_end(msg, bss); 10415 10416 genlmsg_end(msg, hdr); 10417 return 0; 10418 10419 fail_unlock_rcu: 10420 rcu_read_unlock(); 10421 nla_put_failure: 10422 genlmsg_cancel(msg, hdr); 10423 return -EMSGSIZE; 10424 } 10425 10426 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb) 10427 { 10428 struct cfg80211_registered_device *rdev; 10429 struct cfg80211_internal_bss *scan; 10430 struct wireless_dev *wdev; 10431 struct nlattr **attrbuf; 10432 int start = cb->args[2], idx = 0; 10433 bool dump_include_use_data; 10434 int err; 10435 10436 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 10437 if (!attrbuf) 10438 return -ENOMEM; 10439 10440 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 10441 if (err) { 10442 kfree(attrbuf); 10443 return err; 10444 } 10445 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10446 __acquire(&rdev->wiphy.mtx); 10447 10448 dump_include_use_data = 10449 attrbuf[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA]; 10450 kfree(attrbuf); 10451 10452 spin_lock_bh(&rdev->bss_lock); 10453 10454 /* 10455 * dump_scan will be called multiple times to break up the scan results 10456 * into multiple messages. It is unlikely that any more bss-es will be 10457 * expired after the first call, so only call only call this on the 10458 * first dump_scan invocation. 10459 */ 10460 if (start == 0) 10461 cfg80211_bss_expire(rdev); 10462 10463 cb->seq = rdev->bss_generation; 10464 10465 list_for_each_entry(scan, &rdev->bss_list, list) { 10466 if (++idx <= start) 10467 continue; 10468 if (!dump_include_use_data && 10469 !(scan->pub.use_for & NL80211_BSS_USE_FOR_NORMAL)) 10470 continue; 10471 if (nl80211_send_bss(skb, cb, 10472 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10473 rdev, wdev, scan) < 0) { 10474 idx--; 10475 break; 10476 } 10477 } 10478 10479 spin_unlock_bh(&rdev->bss_lock); 10480 10481 cb->args[2] = idx; 10482 wiphy_unlock(&rdev->wiphy); 10483 10484 return skb->len; 10485 } 10486 10487 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq, 10488 int flags, struct net_device *dev, 10489 bool allow_radio_stats, 10490 struct survey_info *survey) 10491 { 10492 void *hdr; 10493 struct nlattr *infoattr; 10494 10495 /* skip radio stats if userspace didn't request them */ 10496 if (!survey->channel && !allow_radio_stats) 10497 return 0; 10498 10499 hdr = nl80211hdr_put(msg, portid, seq, flags, 10500 NL80211_CMD_NEW_SURVEY_RESULTS); 10501 if (!hdr) 10502 return -ENOMEM; 10503 10504 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 10505 goto nla_put_failure; 10506 10507 infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO); 10508 if (!infoattr) 10509 goto nla_put_failure; 10510 10511 if (survey->channel && 10512 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY, 10513 survey->channel->center_freq)) 10514 goto nla_put_failure; 10515 10516 if (survey->channel && survey->channel->freq_offset && 10517 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET, 10518 survey->channel->freq_offset)) 10519 goto nla_put_failure; 10520 10521 if ((survey->filled & SURVEY_INFO_NOISE_DBM) && 10522 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise)) 10523 goto nla_put_failure; 10524 if ((survey->filled & SURVEY_INFO_IN_USE) && 10525 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE)) 10526 goto nla_put_failure; 10527 if ((survey->filled & SURVEY_INFO_TIME) && 10528 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME, 10529 survey->time, NL80211_SURVEY_INFO_PAD)) 10530 goto nla_put_failure; 10531 if ((survey->filled & SURVEY_INFO_TIME_BUSY) && 10532 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY, 10533 survey->time_busy, NL80211_SURVEY_INFO_PAD)) 10534 goto nla_put_failure; 10535 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) && 10536 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY, 10537 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD)) 10538 goto nla_put_failure; 10539 if ((survey->filled & SURVEY_INFO_TIME_RX) && 10540 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX, 10541 survey->time_rx, NL80211_SURVEY_INFO_PAD)) 10542 goto nla_put_failure; 10543 if ((survey->filled & SURVEY_INFO_TIME_TX) && 10544 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX, 10545 survey->time_tx, NL80211_SURVEY_INFO_PAD)) 10546 goto nla_put_failure; 10547 if ((survey->filled & SURVEY_INFO_TIME_SCAN) && 10548 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN, 10549 survey->time_scan, NL80211_SURVEY_INFO_PAD)) 10550 goto nla_put_failure; 10551 if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) && 10552 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX, 10553 survey->time_bss_rx, NL80211_SURVEY_INFO_PAD)) 10554 goto nla_put_failure; 10555 10556 nla_nest_end(msg, infoattr); 10557 10558 genlmsg_end(msg, hdr); 10559 return 0; 10560 10561 nla_put_failure: 10562 genlmsg_cancel(msg, hdr); 10563 return -EMSGSIZE; 10564 } 10565 10566 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb) 10567 { 10568 struct nlattr **attrbuf; 10569 struct survey_info survey; 10570 struct cfg80211_registered_device *rdev; 10571 struct wireless_dev *wdev; 10572 int survey_idx = cb->args[2]; 10573 int res; 10574 bool radio_stats; 10575 10576 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 10577 if (!attrbuf) 10578 return -ENOMEM; 10579 10580 res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 10581 if (res) { 10582 kfree(attrbuf); 10583 return res; 10584 } 10585 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10586 __acquire(&rdev->wiphy.mtx); 10587 10588 /* prepare_wdev_dump parsed the attributes */ 10589 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS]; 10590 10591 if (!wdev->netdev) { 10592 res = -EINVAL; 10593 goto out_err; 10594 } 10595 10596 if (!rdev->ops->dump_survey) { 10597 res = -EOPNOTSUPP; 10598 goto out_err; 10599 } 10600 10601 while (1) { 10602 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey); 10603 if (res == -ENOENT) 10604 break; 10605 if (res) 10606 goto out_err; 10607 10608 /* don't send disabled channels, but do send non-channel data */ 10609 if (survey.channel && 10610 survey.channel->flags & IEEE80211_CHAN_DISABLED) { 10611 survey_idx++; 10612 continue; 10613 } 10614 10615 if (nl80211_send_survey(skb, 10616 NETLINK_CB(cb->skb).portid, 10617 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10618 wdev->netdev, radio_stats, &survey) < 0) 10619 goto out; 10620 survey_idx++; 10621 } 10622 10623 out: 10624 cb->args[2] = survey_idx; 10625 res = skb->len; 10626 out_err: 10627 kfree(attrbuf); 10628 wiphy_unlock(&rdev->wiphy); 10629 return res; 10630 } 10631 10632 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info) 10633 { 10634 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10635 struct net_device *dev = info->user_ptr[1]; 10636 struct ieee80211_channel *chan; 10637 const u8 *bssid, *ssid; 10638 int err, ssid_len; 10639 enum nl80211_auth_type auth_type; 10640 struct key_parse key; 10641 bool local_state_change; 10642 struct cfg80211_auth_request req = {}; 10643 u32 freq; 10644 10645 if (!info->attrs[NL80211_ATTR_MAC]) 10646 return -EINVAL; 10647 10648 if (!info->attrs[NL80211_ATTR_AUTH_TYPE]) 10649 return -EINVAL; 10650 10651 if (!info->attrs[NL80211_ATTR_SSID]) 10652 return -EINVAL; 10653 10654 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 10655 return -EINVAL; 10656 10657 err = nl80211_parse_key(info, &key); 10658 if (err) 10659 return err; 10660 10661 if (key.idx >= 0) { 10662 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP) 10663 return -EINVAL; 10664 if (!key.p.key || !key.p.key_len) 10665 return -EINVAL; 10666 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 || 10667 key.p.key_len != WLAN_KEY_LEN_WEP40) && 10668 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 || 10669 key.p.key_len != WLAN_KEY_LEN_WEP104)) 10670 return -EINVAL; 10671 if (key.idx > 3) 10672 return -EINVAL; 10673 } else { 10674 key.p.key_len = 0; 10675 key.p.key = NULL; 10676 } 10677 10678 if (key.idx >= 0) { 10679 int i; 10680 bool ok = false; 10681 10682 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) { 10683 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) { 10684 ok = true; 10685 break; 10686 } 10687 } 10688 if (!ok) 10689 return -EINVAL; 10690 } 10691 10692 if (!rdev->ops->auth) 10693 return -EOPNOTSUPP; 10694 10695 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10696 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10697 return -EOPNOTSUPP; 10698 10699 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 10700 freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 10701 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 10702 freq += 10703 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 10704 10705 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 10706 if (!chan) 10707 return -EINVAL; 10708 10709 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10710 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10711 10712 if (info->attrs[NL80211_ATTR_IE]) { 10713 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10714 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10715 } 10716 10717 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 10718 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE)) 10719 return -EINVAL; 10720 10721 if ((auth_type == NL80211_AUTHTYPE_SAE || 10722 auth_type == NL80211_AUTHTYPE_FILS_SK || 10723 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 10724 auth_type == NL80211_AUTHTYPE_FILS_PK) && 10725 !info->attrs[NL80211_ATTR_AUTH_DATA]) 10726 return -EINVAL; 10727 10728 if (info->attrs[NL80211_ATTR_AUTH_DATA]) { 10729 if (auth_type != NL80211_AUTHTYPE_SAE && 10730 auth_type != NL80211_AUTHTYPE_FILS_SK && 10731 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS && 10732 auth_type != NL80211_AUTHTYPE_FILS_PK) 10733 return -EINVAL; 10734 req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]); 10735 req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]); 10736 } 10737 10738 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 10739 10740 /* 10741 * Since we no longer track auth state, ignore 10742 * requests to only change local state. 10743 */ 10744 if (local_state_change) 10745 return 0; 10746 10747 req.auth_type = auth_type; 10748 req.key = key.p.key; 10749 req.key_len = key.p.key_len; 10750 req.key_idx = key.idx; 10751 req.link_id = nl80211_link_id_or_invalid(info->attrs); 10752 if (req.link_id >= 0) { 10753 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 10754 return -EINVAL; 10755 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 10756 return -EINVAL; 10757 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 10758 if (!is_valid_ether_addr(req.ap_mld_addr)) 10759 return -EINVAL; 10760 } 10761 10762 req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, 10763 IEEE80211_BSS_TYPE_ESS, 10764 IEEE80211_PRIVACY_ANY); 10765 if (!req.bss) 10766 return -ENOENT; 10767 10768 err = cfg80211_mlme_auth(rdev, dev, &req); 10769 10770 cfg80211_put_bss(&rdev->wiphy, req.bss); 10771 10772 return err; 10773 } 10774 10775 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev, 10776 struct genl_info *info) 10777 { 10778 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 10779 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set"); 10780 return -EINVAL; 10781 } 10782 10783 if (!rdev->ops->tx_control_port || 10784 !wiphy_ext_feature_isset(&rdev->wiphy, 10785 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 10786 return -EOPNOTSUPP; 10787 10788 return 0; 10789 } 10790 10791 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 10792 struct genl_info *info, 10793 struct cfg80211_crypto_settings *settings, 10794 int cipher_limit) 10795 { 10796 memset(settings, 0, sizeof(*settings)); 10797 10798 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT]; 10799 10800 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 10801 u16 proto; 10802 10803 proto = nla_get_u16( 10804 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 10805 settings->control_port_ethertype = cpu_to_be16(proto); 10806 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 10807 proto != ETH_P_PAE) 10808 return -EINVAL; 10809 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]) 10810 settings->control_port_no_encrypt = true; 10811 } else 10812 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE); 10813 10814 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 10815 int r = validate_pae_over_nl80211(rdev, info); 10816 10817 if (r < 0) 10818 return r; 10819 10820 settings->control_port_over_nl80211 = true; 10821 10822 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH]) 10823 settings->control_port_no_preauth = true; 10824 } 10825 10826 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) { 10827 void *data; 10828 int len, i; 10829 10830 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 10831 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 10832 settings->n_ciphers_pairwise = len / sizeof(u32); 10833 10834 if (len % sizeof(u32)) 10835 return -EINVAL; 10836 10837 if (settings->n_ciphers_pairwise > cipher_limit) 10838 return -EINVAL; 10839 10840 memcpy(settings->ciphers_pairwise, data, len); 10841 10842 for (i = 0; i < settings->n_ciphers_pairwise; i++) 10843 if (!cfg80211_supported_cipher_suite( 10844 &rdev->wiphy, 10845 settings->ciphers_pairwise[i])) 10846 return -EINVAL; 10847 } 10848 10849 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) { 10850 settings->cipher_group = 10851 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]); 10852 if (!cfg80211_supported_cipher_suite(&rdev->wiphy, 10853 settings->cipher_group)) 10854 return -EINVAL; 10855 } 10856 10857 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) 10858 settings->wpa_versions = 10859 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]); 10860 10861 if (info->attrs[NL80211_ATTR_AKM_SUITES]) { 10862 void *data; 10863 int len; 10864 10865 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]); 10866 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]); 10867 settings->n_akm_suites = len / sizeof(u32); 10868 10869 if (len % sizeof(u32)) 10870 return -EINVAL; 10871 10872 if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites) 10873 return -EINVAL; 10874 10875 memcpy(settings->akm_suites, data, len); 10876 } 10877 10878 if (info->attrs[NL80211_ATTR_PMK]) { 10879 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN) 10880 return -EINVAL; 10881 if (!wiphy_ext_feature_isset(&rdev->wiphy, 10882 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) && 10883 !wiphy_ext_feature_isset(&rdev->wiphy, 10884 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK)) 10885 return -EINVAL; 10886 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]); 10887 } 10888 10889 if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) { 10890 if (!wiphy_ext_feature_isset(&rdev->wiphy, 10891 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 10892 !wiphy_ext_feature_isset(&rdev->wiphy, 10893 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP)) 10894 return -EINVAL; 10895 settings->sae_pwd = 10896 nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 10897 settings->sae_pwd_len = 10898 nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 10899 } 10900 10901 if (info->attrs[NL80211_ATTR_SAE_PWE]) 10902 settings->sae_pwe = 10903 nla_get_u8(info->attrs[NL80211_ATTR_SAE_PWE]); 10904 else 10905 settings->sae_pwe = NL80211_SAE_PWE_UNSPECIFIED; 10906 10907 return 0; 10908 } 10909 10910 static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev, 10911 const u8 *ssid, int ssid_len, 10912 struct nlattr **attrs, 10913 int assoc_link_id, int link_id) 10914 { 10915 struct ieee80211_channel *chan; 10916 struct cfg80211_bss *bss; 10917 const u8 *bssid; 10918 u32 freq, use_for = 0; 10919 10920 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ]) 10921 return ERR_PTR(-EINVAL); 10922 10923 bssid = nla_data(attrs[NL80211_ATTR_MAC]); 10924 10925 freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ])); 10926 if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 10927 freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 10928 10929 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 10930 if (!chan) 10931 return ERR_PTR(-EINVAL); 10932 10933 if (assoc_link_id >= 0) 10934 use_for = NL80211_BSS_USE_FOR_MLD_LINK; 10935 if (assoc_link_id == link_id) 10936 use_for |= NL80211_BSS_USE_FOR_NORMAL; 10937 10938 bss = __cfg80211_get_bss(&rdev->wiphy, chan, bssid, 10939 ssid, ssid_len, 10940 IEEE80211_BSS_TYPE_ESS, 10941 IEEE80211_PRIVACY_ANY, 10942 use_for); 10943 if (!bss) 10944 return ERR_PTR(-ENOENT); 10945 10946 return bss; 10947 } 10948 10949 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info) 10950 { 10951 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10952 struct net_device *dev = info->user_ptr[1]; 10953 struct cfg80211_assoc_request req = {}; 10954 struct nlattr **attrs = NULL; 10955 const u8 *ap_addr, *ssid; 10956 unsigned int link_id; 10957 int err, ssid_len; 10958 10959 if (dev->ieee80211_ptr->conn_owner_nlportid && 10960 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 10961 return -EPERM; 10962 10963 if (!info->attrs[NL80211_ATTR_SSID]) 10964 return -EINVAL; 10965 10966 if (!rdev->ops->assoc) 10967 return -EOPNOTSUPP; 10968 10969 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10970 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10971 return -EOPNOTSUPP; 10972 10973 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10974 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10975 10976 if (info->attrs[NL80211_ATTR_IE]) { 10977 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10978 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10979 10980 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 10981 req.ie, req.ie_len)) { 10982 NL_SET_ERR_MSG_ATTR(info->extack, 10983 info->attrs[NL80211_ATTR_IE], 10984 "non-inheritance makes no sense"); 10985 return -EINVAL; 10986 } 10987 } 10988 10989 if (info->attrs[NL80211_ATTR_USE_MFP]) { 10990 enum nl80211_mfp mfp = 10991 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 10992 if (mfp == NL80211_MFP_REQUIRED) 10993 req.use_mfp = true; 10994 else if (mfp != NL80211_MFP_NO) 10995 return -EINVAL; 10996 } 10997 10998 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 10999 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 11000 11001 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 11002 req.flags |= ASSOC_REQ_DISABLE_HT; 11003 11004 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11005 memcpy(&req.ht_capa_mask, 11006 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11007 sizeof(req.ht_capa_mask)); 11008 11009 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11010 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11011 return -EINVAL; 11012 memcpy(&req.ht_capa, 11013 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11014 sizeof(req.ht_capa)); 11015 } 11016 11017 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 11018 req.flags |= ASSOC_REQ_DISABLE_VHT; 11019 11020 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 11021 req.flags |= ASSOC_REQ_DISABLE_HE; 11022 11023 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 11024 req.flags |= ASSOC_REQ_DISABLE_EHT; 11025 11026 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11027 memcpy(&req.vht_capa_mask, 11028 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 11029 sizeof(req.vht_capa_mask)); 11030 11031 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 11032 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11033 return -EINVAL; 11034 memcpy(&req.vht_capa, 11035 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 11036 sizeof(req.vht_capa)); 11037 } 11038 11039 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 11040 if (!((rdev->wiphy.features & 11041 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 11042 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 11043 !wiphy_ext_feature_isset(&rdev->wiphy, 11044 NL80211_EXT_FEATURE_RRM)) 11045 return -EINVAL; 11046 req.flags |= ASSOC_REQ_USE_RRM; 11047 } 11048 11049 if (info->attrs[NL80211_ATTR_FILS_KEK]) { 11050 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 11051 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 11052 if (!info->attrs[NL80211_ATTR_FILS_NONCES]) 11053 return -EINVAL; 11054 req.fils_nonces = 11055 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 11056 } 11057 11058 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) { 11059 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 11060 return -EINVAL; 11061 memcpy(&req.s1g_capa_mask, 11062 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]), 11063 sizeof(req.s1g_capa_mask)); 11064 } 11065 11066 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) { 11067 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) 11068 return -EINVAL; 11069 memcpy(&req.s1g_capa, 11070 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]), 11071 sizeof(req.s1g_capa)); 11072 } 11073 11074 if (nla_get_flag(info->attrs[NL80211_ATTR_ASSOC_SPP_AMSDU])) { 11075 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11076 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT)) { 11077 GENL_SET_ERR_MSG(info, "SPP A-MSDUs not supported"); 11078 return -EINVAL; 11079 } 11080 req.flags |= ASSOC_REQ_SPP_AMSDU; 11081 } 11082 11083 req.link_id = nl80211_link_id_or_invalid(info->attrs); 11084 11085 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 11086 unsigned int attrsize = NUM_NL80211_ATTR * sizeof(*attrs); 11087 struct nlattr *link; 11088 int rem = 0; 11089 11090 if (req.link_id < 0) 11091 return -EINVAL; 11092 11093 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 11094 return -EINVAL; 11095 11096 if (info->attrs[NL80211_ATTR_MAC] || 11097 info->attrs[NL80211_ATTR_WIPHY_FREQ] || 11098 !info->attrs[NL80211_ATTR_MLD_ADDR]) 11099 return -EINVAL; 11100 11101 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 11102 ap_addr = req.ap_mld_addr; 11103 11104 attrs = kzalloc(attrsize, GFP_KERNEL); 11105 if (!attrs) 11106 return -ENOMEM; 11107 11108 nla_for_each_nested(link, 11109 info->attrs[NL80211_ATTR_MLO_LINKS], 11110 rem) { 11111 memset(attrs, 0, attrsize); 11112 11113 nla_parse_nested(attrs, NL80211_ATTR_MAX, 11114 link, NULL, NULL); 11115 11116 if (!attrs[NL80211_ATTR_MLO_LINK_ID]) { 11117 err = -EINVAL; 11118 NL_SET_BAD_ATTR(info->extack, link); 11119 goto free; 11120 } 11121 11122 link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]); 11123 /* cannot use the same link ID again */ 11124 if (req.links[link_id].bss) { 11125 err = -EINVAL; 11126 NL_SET_BAD_ATTR(info->extack, link); 11127 goto free; 11128 } 11129 req.links[link_id].bss = 11130 nl80211_assoc_bss(rdev, ssid, ssid_len, attrs, 11131 req.link_id, link_id); 11132 if (IS_ERR(req.links[link_id].bss)) { 11133 err = PTR_ERR(req.links[link_id].bss); 11134 req.links[link_id].bss = NULL; 11135 NL_SET_ERR_MSG_ATTR(info->extack, 11136 link, "Error fetching BSS for link"); 11137 goto free; 11138 } 11139 11140 if (attrs[NL80211_ATTR_IE]) { 11141 req.links[link_id].elems = 11142 nla_data(attrs[NL80211_ATTR_IE]); 11143 req.links[link_id].elems_len = 11144 nla_len(attrs[NL80211_ATTR_IE]); 11145 11146 if (cfg80211_find_elem(WLAN_EID_FRAGMENT, 11147 req.links[link_id].elems, 11148 req.links[link_id].elems_len)) { 11149 NL_SET_ERR_MSG_ATTR(info->extack, 11150 attrs[NL80211_ATTR_IE], 11151 "cannot deal with fragmentation"); 11152 err = -EINVAL; 11153 goto free; 11154 } 11155 11156 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 11157 req.links[link_id].elems, 11158 req.links[link_id].elems_len)) { 11159 NL_SET_ERR_MSG_ATTR(info->extack, 11160 attrs[NL80211_ATTR_IE], 11161 "cannot deal with non-inheritance"); 11162 err = -EINVAL; 11163 goto free; 11164 } 11165 } 11166 11167 req.links[link_id].disabled = 11168 nla_get_flag(attrs[NL80211_ATTR_MLO_LINK_DISABLED]); 11169 } 11170 11171 if (!req.links[req.link_id].bss) { 11172 err = -EINVAL; 11173 goto free; 11174 } 11175 11176 if (req.links[req.link_id].elems_len) { 11177 GENL_SET_ERR_MSG(info, 11178 "cannot have per-link elems on assoc link"); 11179 err = -EINVAL; 11180 goto free; 11181 } 11182 11183 if (req.links[req.link_id].disabled) { 11184 GENL_SET_ERR_MSG(info, 11185 "cannot have assoc link disabled"); 11186 err = -EINVAL; 11187 goto free; 11188 } 11189 11190 kfree(attrs); 11191 attrs = NULL; 11192 } else { 11193 if (req.link_id >= 0) 11194 return -EINVAL; 11195 11196 req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs, 11197 -1, -1); 11198 if (IS_ERR(req.bss)) 11199 return PTR_ERR(req.bss); 11200 ap_addr = req.bss->bssid; 11201 } 11202 11203 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1); 11204 if (!err) { 11205 struct nlattr *link; 11206 int rem = 0; 11207 11208 err = cfg80211_mlme_assoc(rdev, dev, &req, 11209 info->extack); 11210 11211 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 11212 dev->ieee80211_ptr->conn_owner_nlportid = 11213 info->snd_portid; 11214 memcpy(dev->ieee80211_ptr->disconnect_bssid, 11215 ap_addr, ETH_ALEN); 11216 } 11217 11218 /* Report error from first problematic link */ 11219 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 11220 nla_for_each_nested(link, 11221 info->attrs[NL80211_ATTR_MLO_LINKS], 11222 rem) { 11223 struct nlattr *link_id_attr = 11224 nla_find_nested(link, NL80211_ATTR_MLO_LINK_ID); 11225 11226 if (!link_id_attr) 11227 continue; 11228 11229 link_id = nla_get_u8(link_id_attr); 11230 11231 if (link_id == req.link_id) 11232 continue; 11233 11234 if (!req.links[link_id].error || 11235 WARN_ON(req.links[link_id].error > 0)) 11236 continue; 11237 11238 WARN_ON(err >= 0); 11239 11240 NL_SET_BAD_ATTR(info->extack, link); 11241 err = req.links[link_id].error; 11242 break; 11243 } 11244 } 11245 } 11246 11247 free: 11248 for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++) 11249 cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss); 11250 cfg80211_put_bss(&rdev->wiphy, req.bss); 11251 kfree(attrs); 11252 11253 return err; 11254 } 11255 11256 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info) 11257 { 11258 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11259 struct net_device *dev = info->user_ptr[1]; 11260 const u8 *ie = NULL, *bssid; 11261 int ie_len = 0; 11262 u16 reason_code; 11263 bool local_state_change; 11264 11265 if (dev->ieee80211_ptr->conn_owner_nlportid && 11266 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11267 return -EPERM; 11268 11269 if (!info->attrs[NL80211_ATTR_MAC]) 11270 return -EINVAL; 11271 11272 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11273 return -EINVAL; 11274 11275 if (!rdev->ops->deauth) 11276 return -EOPNOTSUPP; 11277 11278 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11279 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11280 return -EOPNOTSUPP; 11281 11282 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11283 11284 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11285 if (reason_code == 0) { 11286 /* Reason Code 0 is reserved */ 11287 return -EINVAL; 11288 } 11289 11290 if (info->attrs[NL80211_ATTR_IE]) { 11291 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11292 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11293 } 11294 11295 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11296 11297 return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code, 11298 local_state_change); 11299 } 11300 11301 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info) 11302 { 11303 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11304 struct net_device *dev = info->user_ptr[1]; 11305 const u8 *ie = NULL, *bssid; 11306 int ie_len = 0; 11307 u16 reason_code; 11308 bool local_state_change; 11309 11310 if (dev->ieee80211_ptr->conn_owner_nlportid && 11311 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11312 return -EPERM; 11313 11314 if (!info->attrs[NL80211_ATTR_MAC]) 11315 return -EINVAL; 11316 11317 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11318 return -EINVAL; 11319 11320 if (!rdev->ops->disassoc) 11321 return -EOPNOTSUPP; 11322 11323 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11324 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11325 return -EOPNOTSUPP; 11326 11327 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11328 11329 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11330 if (reason_code == 0) { 11331 /* Reason Code 0 is reserved */ 11332 return -EINVAL; 11333 } 11334 11335 if (info->attrs[NL80211_ATTR_IE]) { 11336 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11337 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11338 } 11339 11340 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11341 11342 return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code, 11343 local_state_change); 11344 } 11345 11346 static bool 11347 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev, 11348 int mcast_rate[NUM_NL80211_BANDS], 11349 int rateval) 11350 { 11351 struct wiphy *wiphy = &rdev->wiphy; 11352 bool found = false; 11353 int band, i; 11354 11355 for (band = 0; band < NUM_NL80211_BANDS; band++) { 11356 struct ieee80211_supported_band *sband; 11357 11358 sband = wiphy->bands[band]; 11359 if (!sband) 11360 continue; 11361 11362 for (i = 0; i < sband->n_bitrates; i++) { 11363 if (sband->bitrates[i].bitrate == rateval) { 11364 mcast_rate[band] = i + 1; 11365 found = true; 11366 break; 11367 } 11368 } 11369 } 11370 11371 return found; 11372 } 11373 11374 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info) 11375 { 11376 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11377 struct net_device *dev = info->user_ptr[1]; 11378 struct cfg80211_ibss_params ibss; 11379 struct wiphy *wiphy; 11380 struct cfg80211_cached_keys *connkeys = NULL; 11381 int err; 11382 11383 memset(&ibss, 0, sizeof(ibss)); 11384 11385 if (!info->attrs[NL80211_ATTR_SSID] || 11386 !nla_len(info->attrs[NL80211_ATTR_SSID])) 11387 return -EINVAL; 11388 11389 ibss.beacon_interval = 100; 11390 11391 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) 11392 ibss.beacon_interval = 11393 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 11394 11395 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC, 11396 ibss.beacon_interval); 11397 if (err) 11398 return err; 11399 11400 if (!rdev->ops->join_ibss) 11401 return -EOPNOTSUPP; 11402 11403 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11404 return -EOPNOTSUPP; 11405 11406 wiphy = &rdev->wiphy; 11407 11408 if (info->attrs[NL80211_ATTR_MAC]) { 11409 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11410 11411 if (!is_valid_ether_addr(ibss.bssid)) 11412 return -EINVAL; 11413 } 11414 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11415 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11416 11417 if (info->attrs[NL80211_ATTR_IE]) { 11418 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11419 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11420 } 11421 11422 err = nl80211_parse_chandef(rdev, info, &ibss.chandef); 11423 if (err) 11424 return err; 11425 11426 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef, 11427 NL80211_IFTYPE_ADHOC)) 11428 return -EINVAL; 11429 11430 switch (ibss.chandef.width) { 11431 case NL80211_CHAN_WIDTH_5: 11432 case NL80211_CHAN_WIDTH_10: 11433 case NL80211_CHAN_WIDTH_20_NOHT: 11434 break; 11435 case NL80211_CHAN_WIDTH_20: 11436 case NL80211_CHAN_WIDTH_40: 11437 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11438 return -EINVAL; 11439 break; 11440 case NL80211_CHAN_WIDTH_80: 11441 case NL80211_CHAN_WIDTH_80P80: 11442 case NL80211_CHAN_WIDTH_160: 11443 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11444 return -EINVAL; 11445 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11446 NL80211_EXT_FEATURE_VHT_IBSS)) 11447 return -EINVAL; 11448 break; 11449 case NL80211_CHAN_WIDTH_320: 11450 return -EINVAL; 11451 default: 11452 return -EINVAL; 11453 } 11454 11455 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED]; 11456 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 11457 11458 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 11459 u8 *rates = 11460 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11461 int n_rates = 11462 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11463 struct ieee80211_supported_band *sband = 11464 wiphy->bands[ibss.chandef.chan->band]; 11465 11466 err = ieee80211_get_ratemask(sband, rates, n_rates, 11467 &ibss.basic_rates); 11468 if (err) 11469 return err; 11470 } 11471 11472 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11473 memcpy(&ibss.ht_capa_mask, 11474 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11475 sizeof(ibss.ht_capa_mask)); 11476 11477 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11478 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11479 return -EINVAL; 11480 memcpy(&ibss.ht_capa, 11481 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11482 sizeof(ibss.ht_capa)); 11483 } 11484 11485 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 11486 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate, 11487 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 11488 return -EINVAL; 11489 11490 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) { 11491 bool no_ht = false; 11492 11493 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht); 11494 if (IS_ERR(connkeys)) 11495 return PTR_ERR(connkeys); 11496 11497 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) && 11498 no_ht) { 11499 kfree_sensitive(connkeys); 11500 return -EINVAL; 11501 } 11502 } 11503 11504 ibss.control_port = 11505 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]); 11506 11507 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 11508 int r = validate_pae_over_nl80211(rdev, info); 11509 11510 if (r < 0) { 11511 kfree_sensitive(connkeys); 11512 return r; 11513 } 11514 11515 ibss.control_port_over_nl80211 = true; 11516 } 11517 11518 ibss.userspace_handles_dfs = 11519 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 11520 11521 err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys); 11522 if (err) 11523 kfree_sensitive(connkeys); 11524 else if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 11525 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 11526 11527 return err; 11528 } 11529 11530 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info) 11531 { 11532 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11533 struct net_device *dev = info->user_ptr[1]; 11534 11535 if (!rdev->ops->leave_ibss) 11536 return -EOPNOTSUPP; 11537 11538 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11539 return -EOPNOTSUPP; 11540 11541 return cfg80211_leave_ibss(rdev, dev, false); 11542 } 11543 11544 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info) 11545 { 11546 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11547 struct net_device *dev = info->user_ptr[1]; 11548 int mcast_rate[NUM_NL80211_BANDS]; 11549 u32 nla_rate; 11550 11551 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC && 11552 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 11553 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB) 11554 return -EOPNOTSUPP; 11555 11556 if (!rdev->ops->set_mcast_rate) 11557 return -EOPNOTSUPP; 11558 11559 memset(mcast_rate, 0, sizeof(mcast_rate)); 11560 11561 if (!info->attrs[NL80211_ATTR_MCAST_RATE]) 11562 return -EINVAL; 11563 11564 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]); 11565 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate)) 11566 return -EINVAL; 11567 11568 return rdev_set_mcast_rate(rdev, dev, mcast_rate); 11569 } 11570 11571 static struct sk_buff * 11572 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev, 11573 struct wireless_dev *wdev, int approxlen, 11574 u32 portid, u32 seq, enum nl80211_commands cmd, 11575 enum nl80211_attrs attr, 11576 const struct nl80211_vendor_cmd_info *info, 11577 gfp_t gfp) 11578 { 11579 struct sk_buff *skb; 11580 void *hdr; 11581 struct nlattr *data; 11582 11583 skb = nlmsg_new(approxlen + 100, gfp); 11584 if (!skb) 11585 return NULL; 11586 11587 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd); 11588 if (!hdr) { 11589 kfree_skb(skb); 11590 return NULL; 11591 } 11592 11593 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 11594 goto nla_put_failure; 11595 11596 if (info) { 11597 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID, 11598 info->vendor_id)) 11599 goto nla_put_failure; 11600 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD, 11601 info->subcmd)) 11602 goto nla_put_failure; 11603 } 11604 11605 if (wdev) { 11606 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 11607 wdev_id(wdev), NL80211_ATTR_PAD)) 11608 goto nla_put_failure; 11609 if (wdev->netdev && 11610 nla_put_u32(skb, NL80211_ATTR_IFINDEX, 11611 wdev->netdev->ifindex)) 11612 goto nla_put_failure; 11613 } 11614 11615 data = nla_nest_start_noflag(skb, attr); 11616 if (!data) 11617 goto nla_put_failure; 11618 11619 ((void **)skb->cb)[0] = rdev; 11620 ((void **)skb->cb)[1] = hdr; 11621 ((void **)skb->cb)[2] = data; 11622 11623 return skb; 11624 11625 nla_put_failure: 11626 kfree_skb(skb); 11627 return NULL; 11628 } 11629 11630 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy, 11631 struct wireless_dev *wdev, 11632 enum nl80211_commands cmd, 11633 enum nl80211_attrs attr, 11634 unsigned int portid, 11635 int vendor_event_idx, 11636 int approxlen, gfp_t gfp) 11637 { 11638 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 11639 const struct nl80211_vendor_cmd_info *info; 11640 11641 switch (cmd) { 11642 case NL80211_CMD_TESTMODE: 11643 if (WARN_ON(vendor_event_idx != -1)) 11644 return NULL; 11645 info = NULL; 11646 break; 11647 case NL80211_CMD_VENDOR: 11648 if (WARN_ON(vendor_event_idx < 0 || 11649 vendor_event_idx >= wiphy->n_vendor_events)) 11650 return NULL; 11651 info = &wiphy->vendor_events[vendor_event_idx]; 11652 break; 11653 default: 11654 WARN_ON(1); 11655 return NULL; 11656 } 11657 11658 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0, 11659 cmd, attr, info, gfp); 11660 } 11661 EXPORT_SYMBOL(__cfg80211_alloc_event_skb); 11662 11663 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp) 11664 { 11665 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 11666 void *hdr = ((void **)skb->cb)[1]; 11667 struct nlmsghdr *nlhdr = nlmsg_hdr(skb); 11668 struct nlattr *data = ((void **)skb->cb)[2]; 11669 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE; 11670 11671 /* clear CB data for netlink core to own from now on */ 11672 memset(skb->cb, 0, sizeof(skb->cb)); 11673 11674 nla_nest_end(skb, data); 11675 genlmsg_end(skb, hdr); 11676 11677 if (nlhdr->nlmsg_pid) { 11678 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb, 11679 nlhdr->nlmsg_pid); 11680 } else { 11681 if (data->nla_type == NL80211_ATTR_VENDOR_DATA) 11682 mcgrp = NL80211_MCGRP_VENDOR; 11683 11684 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 11685 skb, 0, mcgrp, gfp); 11686 } 11687 } 11688 EXPORT_SYMBOL(__cfg80211_send_event_skb); 11689 11690 #ifdef CONFIG_NL80211_TESTMODE 11691 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info) 11692 { 11693 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11694 struct wireless_dev *wdev; 11695 int err; 11696 11697 lockdep_assert_held(&rdev->wiphy.mtx); 11698 11699 wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 11700 info->attrs); 11701 11702 if (!rdev->ops->testmode_cmd) 11703 return -EOPNOTSUPP; 11704 11705 if (IS_ERR(wdev)) { 11706 err = PTR_ERR(wdev); 11707 if (err != -EINVAL) 11708 return err; 11709 wdev = NULL; 11710 } else if (wdev->wiphy != &rdev->wiphy) { 11711 return -EINVAL; 11712 } 11713 11714 if (!info->attrs[NL80211_ATTR_TESTDATA]) 11715 return -EINVAL; 11716 11717 rdev->cur_cmd_info = info; 11718 err = rdev_testmode_cmd(rdev, wdev, 11719 nla_data(info->attrs[NL80211_ATTR_TESTDATA]), 11720 nla_len(info->attrs[NL80211_ATTR_TESTDATA])); 11721 rdev->cur_cmd_info = NULL; 11722 11723 return err; 11724 } 11725 11726 static int nl80211_testmode_dump(struct sk_buff *skb, 11727 struct netlink_callback *cb) 11728 { 11729 struct cfg80211_registered_device *rdev; 11730 struct nlattr **attrbuf = NULL; 11731 int err; 11732 long phy_idx; 11733 void *data = NULL; 11734 int data_len = 0; 11735 11736 rtnl_lock(); 11737 11738 if (cb->args[0]) { 11739 /* 11740 * 0 is a valid index, but not valid for args[0], 11741 * so we need to offset by 1. 11742 */ 11743 phy_idx = cb->args[0] - 1; 11744 11745 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx); 11746 if (!rdev) { 11747 err = -ENOENT; 11748 goto out_err; 11749 } 11750 } else { 11751 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 11752 GFP_KERNEL); 11753 if (!attrbuf) { 11754 err = -ENOMEM; 11755 goto out_err; 11756 } 11757 11758 err = nlmsg_parse_deprecated(cb->nlh, 11759 GENL_HDRLEN + nl80211_fam.hdrsize, 11760 attrbuf, nl80211_fam.maxattr, 11761 nl80211_policy, NULL); 11762 if (err) 11763 goto out_err; 11764 11765 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 11766 if (IS_ERR(rdev)) { 11767 err = PTR_ERR(rdev); 11768 goto out_err; 11769 } 11770 phy_idx = rdev->wiphy_idx; 11771 11772 if (attrbuf[NL80211_ATTR_TESTDATA]) 11773 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA]; 11774 } 11775 11776 if (cb->args[1]) { 11777 data = nla_data((void *)cb->args[1]); 11778 data_len = nla_len((void *)cb->args[1]); 11779 } 11780 11781 if (!rdev->ops->testmode_dump) { 11782 err = -EOPNOTSUPP; 11783 goto out_err; 11784 } 11785 11786 while (1) { 11787 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 11788 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11789 NL80211_CMD_TESTMODE); 11790 struct nlattr *tmdata; 11791 11792 if (!hdr) 11793 break; 11794 11795 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) { 11796 genlmsg_cancel(skb, hdr); 11797 break; 11798 } 11799 11800 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA); 11801 if (!tmdata) { 11802 genlmsg_cancel(skb, hdr); 11803 break; 11804 } 11805 err = rdev_testmode_dump(rdev, skb, cb, data, data_len); 11806 nla_nest_end(skb, tmdata); 11807 11808 if (err == -ENOBUFS || err == -ENOENT) { 11809 genlmsg_cancel(skb, hdr); 11810 break; 11811 } else if (err) { 11812 genlmsg_cancel(skb, hdr); 11813 goto out_err; 11814 } 11815 11816 genlmsg_end(skb, hdr); 11817 } 11818 11819 err = skb->len; 11820 /* see above */ 11821 cb->args[0] = phy_idx + 1; 11822 out_err: 11823 kfree(attrbuf); 11824 rtnl_unlock(); 11825 return err; 11826 } 11827 #endif 11828 11829 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info) 11830 { 11831 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11832 struct net_device *dev = info->user_ptr[1]; 11833 struct cfg80211_connect_params connect; 11834 struct wiphy *wiphy; 11835 struct cfg80211_cached_keys *connkeys = NULL; 11836 u32 freq = 0; 11837 int err; 11838 11839 memset(&connect, 0, sizeof(connect)); 11840 11841 if (!info->attrs[NL80211_ATTR_SSID] || 11842 !nla_len(info->attrs[NL80211_ATTR_SSID])) 11843 return -EINVAL; 11844 11845 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 11846 connect.auth_type = 11847 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 11848 if (!nl80211_valid_auth_type(rdev, connect.auth_type, 11849 NL80211_CMD_CONNECT)) 11850 return -EINVAL; 11851 } else 11852 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 11853 11854 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY]; 11855 11856 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] && 11857 !wiphy_ext_feature_isset(&rdev->wiphy, 11858 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 11859 return -EINVAL; 11860 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS]; 11861 11862 err = nl80211_crypto_settings(rdev, info, &connect.crypto, 11863 NL80211_MAX_NR_CIPHER_SUITES); 11864 if (err) 11865 return err; 11866 11867 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11868 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11869 return -EOPNOTSUPP; 11870 11871 wiphy = &rdev->wiphy; 11872 11873 connect.bg_scan_period = -1; 11874 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] && 11875 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) { 11876 connect.bg_scan_period = 11877 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]); 11878 } 11879 11880 if (info->attrs[NL80211_ATTR_MAC]) 11881 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11882 else if (info->attrs[NL80211_ATTR_MAC_HINT]) 11883 connect.bssid_hint = 11884 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]); 11885 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11886 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11887 11888 if (info->attrs[NL80211_ATTR_IE]) { 11889 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11890 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11891 } 11892 11893 if (info->attrs[NL80211_ATTR_USE_MFP]) { 11894 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 11895 if (connect.mfp == NL80211_MFP_OPTIONAL && 11896 !wiphy_ext_feature_isset(&rdev->wiphy, 11897 NL80211_EXT_FEATURE_MFP_OPTIONAL)) 11898 return -EOPNOTSUPP; 11899 } else { 11900 connect.mfp = NL80211_MFP_NO; 11901 } 11902 11903 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 11904 connect.prev_bssid = 11905 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 11906 11907 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) 11908 freq = MHZ_TO_KHZ(nla_get_u32( 11909 info->attrs[NL80211_ATTR_WIPHY_FREQ])); 11910 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 11911 freq += 11912 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 11913 11914 if (freq) { 11915 connect.channel = nl80211_get_valid_chan(wiphy, freq); 11916 if (!connect.channel) 11917 return -EINVAL; 11918 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) { 11919 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]); 11920 freq = MHZ_TO_KHZ(freq); 11921 connect.channel_hint = nl80211_get_valid_chan(wiphy, freq); 11922 if (!connect.channel_hint) 11923 return -EINVAL; 11924 } 11925 11926 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 11927 connect.edmg.channels = 11928 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 11929 11930 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 11931 connect.edmg.bw_config = 11932 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 11933 } 11934 11935 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) { 11936 connkeys = nl80211_parse_connkeys(rdev, info, NULL); 11937 if (IS_ERR(connkeys)) 11938 return PTR_ERR(connkeys); 11939 } 11940 11941 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 11942 connect.flags |= ASSOC_REQ_DISABLE_HT; 11943 11944 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11945 memcpy(&connect.ht_capa_mask, 11946 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11947 sizeof(connect.ht_capa_mask)); 11948 11949 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11950 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) { 11951 kfree_sensitive(connkeys); 11952 return -EINVAL; 11953 } 11954 memcpy(&connect.ht_capa, 11955 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11956 sizeof(connect.ht_capa)); 11957 } 11958 11959 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 11960 connect.flags |= ASSOC_REQ_DISABLE_VHT; 11961 11962 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 11963 connect.flags |= ASSOC_REQ_DISABLE_HE; 11964 11965 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 11966 connect.flags |= ASSOC_REQ_DISABLE_EHT; 11967 11968 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11969 memcpy(&connect.vht_capa_mask, 11970 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 11971 sizeof(connect.vht_capa_mask)); 11972 11973 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 11974 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) { 11975 kfree_sensitive(connkeys); 11976 return -EINVAL; 11977 } 11978 memcpy(&connect.vht_capa, 11979 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 11980 sizeof(connect.vht_capa)); 11981 } 11982 11983 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 11984 if (!((rdev->wiphy.features & 11985 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 11986 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 11987 !wiphy_ext_feature_isset(&rdev->wiphy, 11988 NL80211_EXT_FEATURE_RRM)) { 11989 kfree_sensitive(connkeys); 11990 return -EINVAL; 11991 } 11992 connect.flags |= ASSOC_REQ_USE_RRM; 11993 } 11994 11995 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 11996 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 11997 kfree_sensitive(connkeys); 11998 return -EOPNOTSUPP; 11999 } 12000 12001 if (info->attrs[NL80211_ATTR_BSS_SELECT]) { 12002 /* bss selection makes no sense if bssid is set */ 12003 if (connect.bssid) { 12004 kfree_sensitive(connkeys); 12005 return -EINVAL; 12006 } 12007 12008 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT], 12009 wiphy, &connect.bss_select); 12010 if (err) { 12011 kfree_sensitive(connkeys); 12012 return err; 12013 } 12014 } 12015 12016 if (wiphy_ext_feature_isset(&rdev->wiphy, 12017 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 12018 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 12019 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 12020 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 12021 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12022 connect.fils_erp_username = 12023 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12024 connect.fils_erp_username_len = 12025 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12026 connect.fils_erp_realm = 12027 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12028 connect.fils_erp_realm_len = 12029 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12030 connect.fils_erp_next_seq_num = 12031 nla_get_u16( 12032 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 12033 connect.fils_erp_rrk = 12034 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12035 connect.fils_erp_rrk_len = 12036 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12037 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 12038 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 12039 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 12040 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12041 kfree_sensitive(connkeys); 12042 return -EINVAL; 12043 } 12044 12045 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) { 12046 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12047 kfree_sensitive(connkeys); 12048 GENL_SET_ERR_MSG(info, 12049 "external auth requires connection ownership"); 12050 return -EINVAL; 12051 } 12052 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT; 12053 } 12054 12055 if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT])) 12056 connect.flags |= CONNECT_REQ_MLO_SUPPORT; 12057 12058 err = cfg80211_connect(rdev, dev, &connect, connkeys, 12059 connect.prev_bssid); 12060 if (err) 12061 kfree_sensitive(connkeys); 12062 12063 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12064 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 12065 if (connect.bssid) 12066 memcpy(dev->ieee80211_ptr->disconnect_bssid, 12067 connect.bssid, ETH_ALEN); 12068 else 12069 eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid); 12070 } 12071 12072 return err; 12073 } 12074 12075 static int nl80211_update_connect_params(struct sk_buff *skb, 12076 struct genl_info *info) 12077 { 12078 struct cfg80211_connect_params connect = {}; 12079 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12080 struct net_device *dev = info->user_ptr[1]; 12081 struct wireless_dev *wdev = dev->ieee80211_ptr; 12082 bool fils_sk_offload; 12083 u32 auth_type; 12084 u32 changed = 0; 12085 12086 if (!rdev->ops->update_connect_params) 12087 return -EOPNOTSUPP; 12088 12089 if (info->attrs[NL80211_ATTR_IE]) { 12090 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12091 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12092 changed |= UPDATE_ASSOC_IES; 12093 } 12094 12095 fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy, 12096 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD); 12097 12098 /* 12099 * when driver supports fils-sk offload all attributes must be 12100 * provided. So the else covers "fils-sk-not-all" and 12101 * "no-fils-sk-any". 12102 */ 12103 if (fils_sk_offload && 12104 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 12105 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 12106 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 12107 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12108 connect.fils_erp_username = 12109 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12110 connect.fils_erp_username_len = 12111 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12112 connect.fils_erp_realm = 12113 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12114 connect.fils_erp_realm_len = 12115 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12116 connect.fils_erp_next_seq_num = 12117 nla_get_u16( 12118 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 12119 connect.fils_erp_rrk = 12120 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12121 connect.fils_erp_rrk_len = 12122 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12123 changed |= UPDATE_FILS_ERP_INFO; 12124 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 12125 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 12126 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 12127 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12128 return -EINVAL; 12129 } 12130 12131 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 12132 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 12133 if (!nl80211_valid_auth_type(rdev, auth_type, 12134 NL80211_CMD_CONNECT)) 12135 return -EINVAL; 12136 12137 if (auth_type == NL80211_AUTHTYPE_FILS_SK && 12138 fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO)) 12139 return -EINVAL; 12140 12141 connect.auth_type = auth_type; 12142 changed |= UPDATE_AUTH_TYPE; 12143 } 12144 12145 if (!wdev->connected) 12146 return -ENOLINK; 12147 12148 return rdev_update_connect_params(rdev, dev, &connect, changed); 12149 } 12150 12151 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info) 12152 { 12153 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12154 struct net_device *dev = info->user_ptr[1]; 12155 u16 reason; 12156 12157 if (dev->ieee80211_ptr->conn_owner_nlportid && 12158 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12159 return -EPERM; 12160 12161 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 12162 reason = WLAN_REASON_DEAUTH_LEAVING; 12163 else 12164 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 12165 12166 if (reason == 0) 12167 return -EINVAL; 12168 12169 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12170 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12171 return -EOPNOTSUPP; 12172 12173 return cfg80211_disconnect(rdev, dev, reason, true); 12174 } 12175 12176 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info) 12177 { 12178 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12179 struct net *net; 12180 int err; 12181 12182 if (info->attrs[NL80211_ATTR_PID]) { 12183 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]); 12184 12185 net = get_net_ns_by_pid(pid); 12186 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) { 12187 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]); 12188 12189 net = get_net_ns_by_fd(fd); 12190 } else { 12191 return -EINVAL; 12192 } 12193 12194 if (IS_ERR(net)) 12195 return PTR_ERR(net); 12196 12197 err = 0; 12198 12199 /* check if anything to do */ 12200 if (!net_eq(wiphy_net(&rdev->wiphy), net)) 12201 err = cfg80211_switch_netns(rdev, net); 12202 12203 put_net(net); 12204 return err; 12205 } 12206 12207 static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info) 12208 { 12209 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12210 struct net_device *dev = info->user_ptr[1]; 12211 struct cfg80211_pmksa pmksa; 12212 bool ap_pmksa_caching_support = false; 12213 12214 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 12215 12216 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 12217 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 12218 12219 if (!info->attrs[NL80211_ATTR_PMKID]) 12220 return -EINVAL; 12221 12222 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 12223 12224 if (info->attrs[NL80211_ATTR_MAC]) { 12225 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12226 } else if (info->attrs[NL80211_ATTR_SSID] && 12227 info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 12228 info->attrs[NL80211_ATTR_PMK]) { 12229 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12230 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12231 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 12232 } else { 12233 return -EINVAL; 12234 } 12235 12236 if (info->attrs[NL80211_ATTR_PMK]) { 12237 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 12238 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 12239 } 12240 12241 if (info->attrs[NL80211_ATTR_PMK_LIFETIME]) 12242 pmksa.pmk_lifetime = 12243 nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]); 12244 12245 if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]) 12246 pmksa.pmk_reauth_threshold = 12247 nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]); 12248 12249 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12250 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 12251 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 12252 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 12253 ap_pmksa_caching_support)) 12254 return -EOPNOTSUPP; 12255 12256 if (!rdev->ops->set_pmksa) 12257 return -EOPNOTSUPP; 12258 12259 return rdev_set_pmksa(rdev, dev, &pmksa); 12260 } 12261 12262 static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info) 12263 { 12264 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12265 struct net_device *dev = info->user_ptr[1]; 12266 struct cfg80211_pmksa pmksa; 12267 bool sae_offload_support = false; 12268 bool owe_offload_support = false; 12269 bool ap_pmksa_caching_support = false; 12270 12271 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 12272 12273 sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 12274 NL80211_EXT_FEATURE_SAE_OFFLOAD); 12275 owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 12276 NL80211_EXT_FEATURE_OWE_OFFLOAD); 12277 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 12278 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 12279 12280 if (info->attrs[NL80211_ATTR_PMKID]) 12281 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 12282 12283 if (info->attrs[NL80211_ATTR_MAC]) { 12284 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12285 } else if (info->attrs[NL80211_ATTR_SSID]) { 12286 /* SSID based pmksa flush suppported only for FILS, 12287 * OWE/SAE OFFLOAD cases 12288 */ 12289 if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 12290 info->attrs[NL80211_ATTR_PMK]) { 12291 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 12292 } else if (!sae_offload_support && !owe_offload_support) { 12293 return -EINVAL; 12294 } 12295 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12296 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12297 } else { 12298 return -EINVAL; 12299 } 12300 12301 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12302 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 12303 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 12304 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 12305 ap_pmksa_caching_support)) 12306 return -EOPNOTSUPP; 12307 12308 if (!rdev->ops->del_pmksa) 12309 return -EOPNOTSUPP; 12310 12311 return rdev_del_pmksa(rdev, dev, &pmksa); 12312 } 12313 12314 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info) 12315 { 12316 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12317 struct net_device *dev = info->user_ptr[1]; 12318 12319 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12320 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12321 return -EOPNOTSUPP; 12322 12323 if (!rdev->ops->flush_pmksa) 12324 return -EOPNOTSUPP; 12325 12326 return rdev_flush_pmksa(rdev, dev); 12327 } 12328 12329 static int nl80211_tdls_mgmt(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 u8 action_code, dialog_token; 12334 u32 peer_capability = 0; 12335 u16 status_code; 12336 u8 *peer; 12337 int link_id; 12338 bool initiator; 12339 12340 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12341 !rdev->ops->tdls_mgmt) 12342 return -EOPNOTSUPP; 12343 12344 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] || 12345 !info->attrs[NL80211_ATTR_STATUS_CODE] || 12346 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] || 12347 !info->attrs[NL80211_ATTR_IE] || 12348 !info->attrs[NL80211_ATTR_MAC]) 12349 return -EINVAL; 12350 12351 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12352 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]); 12353 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 12354 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]); 12355 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]); 12356 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]) 12357 peer_capability = 12358 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]); 12359 link_id = nl80211_link_id_or_invalid(info->attrs); 12360 12361 return rdev_tdls_mgmt(rdev, dev, peer, link_id, action_code, 12362 dialog_token, status_code, peer_capability, 12363 initiator, 12364 nla_data(info->attrs[NL80211_ATTR_IE]), 12365 nla_len(info->attrs[NL80211_ATTR_IE])); 12366 } 12367 12368 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info) 12369 { 12370 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12371 struct net_device *dev = info->user_ptr[1]; 12372 enum nl80211_tdls_operation operation; 12373 u8 *peer; 12374 12375 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12376 !rdev->ops->tdls_oper) 12377 return -EOPNOTSUPP; 12378 12379 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] || 12380 !info->attrs[NL80211_ATTR_MAC]) 12381 return -EINVAL; 12382 12383 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]); 12384 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12385 12386 return rdev_tdls_oper(rdev, dev, peer, operation); 12387 } 12388 12389 static int nl80211_remain_on_channel(struct sk_buff *skb, 12390 struct genl_info *info) 12391 { 12392 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12393 unsigned int link_id = nl80211_link_id(info->attrs); 12394 struct wireless_dev *wdev = info->user_ptr[1]; 12395 struct cfg80211_chan_def chandef; 12396 struct sk_buff *msg; 12397 void *hdr; 12398 u64 cookie; 12399 u32 duration; 12400 int err; 12401 12402 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 12403 !info->attrs[NL80211_ATTR_DURATION]) 12404 return -EINVAL; 12405 12406 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12407 12408 if (!rdev->ops->remain_on_channel || 12409 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)) 12410 return -EOPNOTSUPP; 12411 12412 /* 12413 * We should be on that channel for at least a minimum amount of 12414 * time (10ms) but no longer than the driver supports. 12415 */ 12416 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12417 duration > rdev->wiphy.max_remain_on_channel_duration) 12418 return -EINVAL; 12419 12420 err = nl80211_parse_chandef(rdev, info, &chandef); 12421 if (err) 12422 return err; 12423 12424 if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) { 12425 const struct cfg80211_chan_def *oper_chandef, *compat_chandef; 12426 12427 oper_chandef = wdev_chandef(wdev, link_id); 12428 12429 if (WARN_ON(!oper_chandef)) { 12430 /* cannot happen since we must beacon to get here */ 12431 WARN_ON(1); 12432 return -EBUSY; 12433 } 12434 12435 /* note: returns first one if identical chandefs */ 12436 compat_chandef = cfg80211_chandef_compatible(&chandef, 12437 oper_chandef); 12438 12439 if (compat_chandef != &chandef) 12440 return -EBUSY; 12441 } 12442 12443 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12444 if (!msg) 12445 return -ENOMEM; 12446 12447 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12448 NL80211_CMD_REMAIN_ON_CHANNEL); 12449 if (!hdr) { 12450 err = -ENOBUFS; 12451 goto free_msg; 12452 } 12453 12454 err = rdev_remain_on_channel(rdev, wdev, chandef.chan, 12455 duration, &cookie); 12456 12457 if (err) 12458 goto free_msg; 12459 12460 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12461 NL80211_ATTR_PAD)) 12462 goto nla_put_failure; 12463 12464 genlmsg_end(msg, hdr); 12465 12466 return genlmsg_reply(msg, info); 12467 12468 nla_put_failure: 12469 err = -ENOBUFS; 12470 free_msg: 12471 nlmsg_free(msg); 12472 return err; 12473 } 12474 12475 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb, 12476 struct genl_info *info) 12477 { 12478 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12479 struct wireless_dev *wdev = info->user_ptr[1]; 12480 u64 cookie; 12481 12482 if (!info->attrs[NL80211_ATTR_COOKIE]) 12483 return -EINVAL; 12484 12485 if (!rdev->ops->cancel_remain_on_channel) 12486 return -EOPNOTSUPP; 12487 12488 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12489 12490 return rdev_cancel_remain_on_channel(rdev, wdev, cookie); 12491 } 12492 12493 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb, 12494 struct genl_info *info) 12495 { 12496 struct cfg80211_bitrate_mask mask; 12497 unsigned int link_id = nl80211_link_id(info->attrs); 12498 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12499 struct net_device *dev = info->user_ptr[1]; 12500 int err; 12501 12502 if (!rdev->ops->set_bitrate_mask) 12503 return -EOPNOTSUPP; 12504 12505 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 12506 NL80211_ATTR_TX_RATES, &mask, 12507 dev, true, link_id); 12508 if (err) 12509 return err; 12510 12511 return rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask); 12512 } 12513 12514 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info) 12515 { 12516 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12517 struct wireless_dev *wdev = info->user_ptr[1]; 12518 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION; 12519 12520 if (!info->attrs[NL80211_ATTR_FRAME_MATCH]) 12521 return -EINVAL; 12522 12523 if (info->attrs[NL80211_ATTR_FRAME_TYPE]) 12524 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]); 12525 12526 switch (wdev->iftype) { 12527 case NL80211_IFTYPE_STATION: 12528 case NL80211_IFTYPE_ADHOC: 12529 case NL80211_IFTYPE_P2P_CLIENT: 12530 case NL80211_IFTYPE_AP: 12531 case NL80211_IFTYPE_AP_VLAN: 12532 case NL80211_IFTYPE_MESH_POINT: 12533 case NL80211_IFTYPE_P2P_GO: 12534 case NL80211_IFTYPE_P2P_DEVICE: 12535 break; 12536 case NL80211_IFTYPE_NAN: 12537 if (!wiphy_ext_feature_isset(wdev->wiphy, 12538 NL80211_EXT_FEATURE_SECURE_NAN)) 12539 return -EOPNOTSUPP; 12540 break; 12541 default: 12542 return -EOPNOTSUPP; 12543 } 12544 12545 /* not much point in registering if we can't reply */ 12546 if (!rdev->ops->mgmt_tx) 12547 return -EOPNOTSUPP; 12548 12549 if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] && 12550 !wiphy_ext_feature_isset(&rdev->wiphy, 12551 NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) { 12552 GENL_SET_ERR_MSG(info, 12553 "multicast RX registrations are not supported"); 12554 return -EOPNOTSUPP; 12555 } 12556 12557 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type, 12558 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12559 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12560 info->attrs[NL80211_ATTR_RECEIVE_MULTICAST], 12561 info->extack); 12562 } 12563 12564 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info) 12565 { 12566 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12567 struct wireless_dev *wdev = info->user_ptr[1]; 12568 struct cfg80211_chan_def chandef; 12569 int err; 12570 void *hdr = NULL; 12571 u64 cookie; 12572 struct sk_buff *msg = NULL; 12573 struct cfg80211_mgmt_tx_params params = { 12574 .dont_wait_for_ack = 12575 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK], 12576 }; 12577 12578 if (!info->attrs[NL80211_ATTR_FRAME]) 12579 return -EINVAL; 12580 12581 if (!rdev->ops->mgmt_tx) 12582 return -EOPNOTSUPP; 12583 12584 switch (wdev->iftype) { 12585 case NL80211_IFTYPE_P2P_DEVICE: 12586 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 12587 return -EINVAL; 12588 break; 12589 case NL80211_IFTYPE_STATION: 12590 case NL80211_IFTYPE_ADHOC: 12591 case NL80211_IFTYPE_P2P_CLIENT: 12592 case NL80211_IFTYPE_AP: 12593 case NL80211_IFTYPE_AP_VLAN: 12594 case NL80211_IFTYPE_MESH_POINT: 12595 case NL80211_IFTYPE_P2P_GO: 12596 break; 12597 case NL80211_IFTYPE_NAN: 12598 if (!wiphy_ext_feature_isset(wdev->wiphy, 12599 NL80211_EXT_FEATURE_SECURE_NAN)) 12600 return -EOPNOTSUPP; 12601 break; 12602 default: 12603 return -EOPNOTSUPP; 12604 } 12605 12606 if (info->attrs[NL80211_ATTR_DURATION]) { 12607 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12608 return -EINVAL; 12609 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12610 12611 /* 12612 * We should wait on the channel for at least a minimum amount 12613 * of time (10ms) but no longer than the driver supports. 12614 */ 12615 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12616 params.wait > rdev->wiphy.max_remain_on_channel_duration) 12617 return -EINVAL; 12618 } 12619 12620 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK]; 12621 12622 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12623 return -EINVAL; 12624 12625 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 12626 12627 /* get the channel if any has been specified, otherwise pass NULL to 12628 * the driver. The latter will use the current one 12629 */ 12630 chandef.chan = NULL; 12631 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 12632 err = nl80211_parse_chandef(rdev, info, &chandef); 12633 if (err) 12634 return err; 12635 } 12636 12637 if (!chandef.chan && params.offchan) 12638 return -EINVAL; 12639 12640 if (params.offchan && 12641 !cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) 12642 return -EBUSY; 12643 12644 params.link_id = nl80211_link_id_or_invalid(info->attrs); 12645 /* 12646 * This now races due to the unlock, but we cannot check 12647 * the valid links for the _station_ anyway, so that's up 12648 * to the driver. 12649 */ 12650 if (params.link_id >= 0 && 12651 !(wdev->valid_links & BIT(params.link_id))) 12652 return -EINVAL; 12653 12654 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 12655 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 12656 12657 err = nl80211_parse_counter_offsets(rdev, NULL, params.len, -1, 12658 info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX], 12659 ¶ms.csa_offsets, 12660 ¶ms.n_csa_offsets); 12661 if (err) 12662 return err; 12663 12664 if (!params.dont_wait_for_ack) { 12665 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12666 if (!msg) 12667 return -ENOMEM; 12668 12669 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12670 NL80211_CMD_FRAME); 12671 if (!hdr) { 12672 err = -ENOBUFS; 12673 goto free_msg; 12674 } 12675 } 12676 12677 params.chan = chandef.chan; 12678 err = cfg80211_mlme_mgmt_tx(rdev, wdev, ¶ms, &cookie); 12679 if (err) 12680 goto free_msg; 12681 12682 if (msg) { 12683 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12684 NL80211_ATTR_PAD)) 12685 goto nla_put_failure; 12686 12687 genlmsg_end(msg, hdr); 12688 return genlmsg_reply(msg, info); 12689 } 12690 12691 return 0; 12692 12693 nla_put_failure: 12694 err = -ENOBUFS; 12695 free_msg: 12696 nlmsg_free(msg); 12697 return err; 12698 } 12699 12700 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info) 12701 { 12702 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12703 struct wireless_dev *wdev = info->user_ptr[1]; 12704 u64 cookie; 12705 12706 if (!info->attrs[NL80211_ATTR_COOKIE]) 12707 return -EINVAL; 12708 12709 if (!rdev->ops->mgmt_tx_cancel_wait) 12710 return -EOPNOTSUPP; 12711 12712 switch (wdev->iftype) { 12713 case NL80211_IFTYPE_STATION: 12714 case NL80211_IFTYPE_ADHOC: 12715 case NL80211_IFTYPE_P2P_CLIENT: 12716 case NL80211_IFTYPE_AP: 12717 case NL80211_IFTYPE_AP_VLAN: 12718 case NL80211_IFTYPE_P2P_GO: 12719 case NL80211_IFTYPE_P2P_DEVICE: 12720 break; 12721 case NL80211_IFTYPE_NAN: 12722 if (!wiphy_ext_feature_isset(wdev->wiphy, 12723 NL80211_EXT_FEATURE_SECURE_NAN)) 12724 return -EOPNOTSUPP; 12725 break; 12726 default: 12727 return -EOPNOTSUPP; 12728 } 12729 12730 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12731 12732 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie); 12733 } 12734 12735 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info) 12736 { 12737 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12738 struct wireless_dev *wdev; 12739 struct net_device *dev = info->user_ptr[1]; 12740 u8 ps_state; 12741 bool state; 12742 int err; 12743 12744 if (!info->attrs[NL80211_ATTR_PS_STATE]) 12745 return -EINVAL; 12746 12747 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]); 12748 12749 wdev = dev->ieee80211_ptr; 12750 12751 if (!rdev->ops->set_power_mgmt) 12752 return -EOPNOTSUPP; 12753 12754 state = (ps_state == NL80211_PS_ENABLED) ? true : false; 12755 12756 if (state == wdev->ps) 12757 return 0; 12758 12759 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout); 12760 if (!err) 12761 wdev->ps = state; 12762 return err; 12763 } 12764 12765 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info) 12766 { 12767 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12768 enum nl80211_ps_state ps_state; 12769 struct wireless_dev *wdev; 12770 struct net_device *dev = info->user_ptr[1]; 12771 struct sk_buff *msg; 12772 void *hdr; 12773 int err; 12774 12775 wdev = dev->ieee80211_ptr; 12776 12777 if (!rdev->ops->set_power_mgmt) 12778 return -EOPNOTSUPP; 12779 12780 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12781 if (!msg) 12782 return -ENOMEM; 12783 12784 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12785 NL80211_CMD_GET_POWER_SAVE); 12786 if (!hdr) { 12787 err = -ENOBUFS; 12788 goto free_msg; 12789 } 12790 12791 if (wdev->ps) 12792 ps_state = NL80211_PS_ENABLED; 12793 else 12794 ps_state = NL80211_PS_DISABLED; 12795 12796 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state)) 12797 goto nla_put_failure; 12798 12799 genlmsg_end(msg, hdr); 12800 return genlmsg_reply(msg, info); 12801 12802 nla_put_failure: 12803 err = -ENOBUFS; 12804 free_msg: 12805 nlmsg_free(msg); 12806 return err; 12807 } 12808 12809 static const struct nla_policy 12810 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = { 12811 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY }, 12812 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 }, 12813 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 }, 12814 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 }, 12815 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 }, 12816 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 }, 12817 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 }, 12818 }; 12819 12820 static int nl80211_set_cqm_txe(struct genl_info *info, 12821 u32 rate, u32 pkts, u32 intvl) 12822 { 12823 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12824 struct net_device *dev = info->user_ptr[1]; 12825 struct wireless_dev *wdev = dev->ieee80211_ptr; 12826 12827 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL) 12828 return -EINVAL; 12829 12830 if (!rdev->ops->set_cqm_txe_config) 12831 return -EOPNOTSUPP; 12832 12833 if (wdev->iftype != NL80211_IFTYPE_STATION && 12834 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 12835 return -EOPNOTSUPP; 12836 12837 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl); 12838 } 12839 12840 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev, 12841 struct net_device *dev, 12842 struct cfg80211_cqm_config *cqm_config) 12843 { 12844 struct wireless_dev *wdev = dev->ieee80211_ptr; 12845 s32 last, low, high; 12846 u32 hyst; 12847 int i, n, low_index; 12848 int err; 12849 12850 /* 12851 * Obtain current RSSI value if possible, if not and no RSSI threshold 12852 * event has been received yet, we should receive an event after a 12853 * connection is established and enough beacons received to calculate 12854 * the average. 12855 */ 12856 if (!cqm_config->last_rssi_event_value && 12857 wdev->links[0].client.current_bss && 12858 rdev->ops->get_station) { 12859 struct station_info sinfo = {}; 12860 u8 *mac_addr; 12861 12862 mac_addr = wdev->links[0].client.current_bss->pub.bssid; 12863 12864 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 12865 if (err) 12866 return err; 12867 12868 cfg80211_sinfo_release_content(&sinfo); 12869 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG)) 12870 cqm_config->last_rssi_event_value = 12871 (s8) sinfo.rx_beacon_signal_avg; 12872 } 12873 12874 last = cqm_config->last_rssi_event_value; 12875 hyst = cqm_config->rssi_hyst; 12876 n = cqm_config->n_rssi_thresholds; 12877 12878 for (i = 0; i < n; i++) { 12879 i = array_index_nospec(i, n); 12880 if (last < cqm_config->rssi_thresholds[i]) 12881 break; 12882 } 12883 12884 low_index = i - 1; 12885 if (low_index >= 0) { 12886 low_index = array_index_nospec(low_index, n); 12887 low = cqm_config->rssi_thresholds[low_index] - hyst; 12888 } else { 12889 low = S32_MIN; 12890 } 12891 if (i < n) { 12892 i = array_index_nospec(i, n); 12893 high = cqm_config->rssi_thresholds[i] + hyst - 1; 12894 } else { 12895 high = S32_MAX; 12896 } 12897 12898 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high); 12899 } 12900 12901 static int nl80211_set_cqm_rssi(struct genl_info *info, 12902 const s32 *thresholds, int n_thresholds, 12903 u32 hysteresis) 12904 { 12905 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12906 struct cfg80211_cqm_config *cqm_config = NULL, *old; 12907 struct net_device *dev = info->user_ptr[1]; 12908 struct wireless_dev *wdev = dev->ieee80211_ptr; 12909 s32 prev = S32_MIN; 12910 int i, err; 12911 12912 /* Check all values negative and sorted */ 12913 for (i = 0; i < n_thresholds; i++) { 12914 if (thresholds[i] > 0 || thresholds[i] <= prev) 12915 return -EINVAL; 12916 12917 prev = thresholds[i]; 12918 } 12919 12920 if (wdev->iftype != NL80211_IFTYPE_STATION && 12921 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 12922 return -EOPNOTSUPP; 12923 12924 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */ 12925 n_thresholds = 0; 12926 12927 old = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 12928 12929 /* if already disabled just succeed */ 12930 if (!n_thresholds && !old) 12931 return 0; 12932 12933 if (n_thresholds > 1) { 12934 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12935 NL80211_EXT_FEATURE_CQM_RSSI_LIST) || 12936 !rdev->ops->set_cqm_rssi_range_config) 12937 return -EOPNOTSUPP; 12938 } else { 12939 if (!rdev->ops->set_cqm_rssi_config) 12940 return -EOPNOTSUPP; 12941 } 12942 12943 if (n_thresholds) { 12944 cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds, 12945 n_thresholds), 12946 GFP_KERNEL); 12947 if (!cqm_config) 12948 return -ENOMEM; 12949 12950 cqm_config->rssi_hyst = hysteresis; 12951 cqm_config->n_rssi_thresholds = n_thresholds; 12952 memcpy(cqm_config->rssi_thresholds, thresholds, 12953 flex_array_size(cqm_config, rssi_thresholds, 12954 n_thresholds)); 12955 cqm_config->use_range_api = n_thresholds > 1 || 12956 !rdev->ops->set_cqm_rssi_config; 12957 12958 rcu_assign_pointer(wdev->cqm_config, cqm_config); 12959 12960 if (cqm_config->use_range_api) 12961 err = cfg80211_cqm_rssi_update(rdev, dev, cqm_config); 12962 else 12963 err = rdev_set_cqm_rssi_config(rdev, dev, 12964 thresholds[0], 12965 hysteresis); 12966 } else { 12967 RCU_INIT_POINTER(wdev->cqm_config, NULL); 12968 /* if enabled as range also disable via range */ 12969 if (old->use_range_api) 12970 err = rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0); 12971 else 12972 err = rdev_set_cqm_rssi_config(rdev, dev, 0, 0); 12973 } 12974 12975 if (err) { 12976 rcu_assign_pointer(wdev->cqm_config, old); 12977 kfree_rcu(cqm_config, rcu_head); 12978 } else { 12979 kfree_rcu(old, rcu_head); 12980 } 12981 12982 return err; 12983 } 12984 12985 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info) 12986 { 12987 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1]; 12988 struct nlattr *cqm; 12989 int err; 12990 12991 cqm = info->attrs[NL80211_ATTR_CQM]; 12992 if (!cqm) 12993 return -EINVAL; 12994 12995 err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm, 12996 nl80211_attr_cqm_policy, 12997 info->extack); 12998 if (err) 12999 return err; 13000 13001 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] && 13002 attrs[NL80211_ATTR_CQM_RSSI_HYST]) { 13003 const s32 *thresholds = 13004 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 13005 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 13006 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]); 13007 13008 if (len % 4) 13009 return -EINVAL; 13010 13011 return nl80211_set_cqm_rssi(info, thresholds, len / 4, 13012 hysteresis); 13013 } 13014 13015 if (attrs[NL80211_ATTR_CQM_TXE_RATE] && 13016 attrs[NL80211_ATTR_CQM_TXE_PKTS] && 13017 attrs[NL80211_ATTR_CQM_TXE_INTVL]) { 13018 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]); 13019 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]); 13020 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]); 13021 13022 return nl80211_set_cqm_txe(info, rate, pkts, intvl); 13023 } 13024 13025 return -EINVAL; 13026 } 13027 13028 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info) 13029 { 13030 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13031 struct net_device *dev = info->user_ptr[1]; 13032 struct ocb_setup setup = {}; 13033 int err; 13034 13035 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 13036 if (err) 13037 return err; 13038 13039 return cfg80211_join_ocb(rdev, dev, &setup); 13040 } 13041 13042 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info) 13043 { 13044 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13045 struct net_device *dev = info->user_ptr[1]; 13046 13047 return cfg80211_leave_ocb(rdev, dev); 13048 } 13049 13050 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info) 13051 { 13052 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13053 struct net_device *dev = info->user_ptr[1]; 13054 struct mesh_config cfg; 13055 struct mesh_setup setup; 13056 int err; 13057 13058 /* start with default */ 13059 memcpy(&cfg, &default_mesh_config, sizeof(cfg)); 13060 memcpy(&setup, &default_mesh_setup, sizeof(setup)); 13061 13062 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) { 13063 /* and parse parameters if given */ 13064 err = nl80211_parse_mesh_config(info, &cfg, NULL); 13065 if (err) 13066 return err; 13067 } 13068 13069 if (!info->attrs[NL80211_ATTR_MESH_ID] || 13070 !nla_len(info->attrs[NL80211_ATTR_MESH_ID])) 13071 return -EINVAL; 13072 13073 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]); 13074 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 13075 13076 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 13077 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate, 13078 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 13079 return -EINVAL; 13080 13081 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) { 13082 setup.beacon_interval = 13083 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 13084 13085 err = cfg80211_validate_beacon_int(rdev, 13086 NL80211_IFTYPE_MESH_POINT, 13087 setup.beacon_interval); 13088 if (err) 13089 return err; 13090 } 13091 13092 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) { 13093 setup.dtim_period = 13094 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 13095 if (setup.dtim_period < 1 || setup.dtim_period > 100) 13096 return -EINVAL; 13097 } 13098 13099 if (info->attrs[NL80211_ATTR_MESH_SETUP]) { 13100 /* parse additional setup parameters if given */ 13101 err = nl80211_parse_mesh_setup(info, &setup); 13102 if (err) 13103 return err; 13104 } 13105 13106 if (setup.user_mpm) 13107 cfg.auto_open_plinks = false; 13108 13109 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 13110 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 13111 if (err) 13112 return err; 13113 } else { 13114 /* __cfg80211_join_mesh() will sort it out */ 13115 setup.chandef.chan = NULL; 13116 } 13117 13118 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 13119 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13120 int n_rates = 13121 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13122 struct ieee80211_supported_band *sband; 13123 13124 if (!setup.chandef.chan) 13125 return -EINVAL; 13126 13127 sband = rdev->wiphy.bands[setup.chandef.chan->band]; 13128 13129 err = ieee80211_get_ratemask(sband, rates, n_rates, 13130 &setup.basic_rates); 13131 if (err) 13132 return err; 13133 } 13134 13135 if (info->attrs[NL80211_ATTR_TX_RATES]) { 13136 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 13137 NL80211_ATTR_TX_RATES, 13138 &setup.beacon_rate, 13139 dev, false, 0); 13140 if (err) 13141 return err; 13142 13143 if (!setup.chandef.chan) 13144 return -EINVAL; 13145 13146 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band, 13147 &setup.beacon_rate); 13148 if (err) 13149 return err; 13150 } 13151 13152 setup.userspace_handles_dfs = 13153 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 13154 13155 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 13156 int r = validate_pae_over_nl80211(rdev, info); 13157 13158 if (r < 0) 13159 return r; 13160 13161 setup.control_port_over_nl80211 = true; 13162 } 13163 13164 err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg); 13165 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) 13166 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 13167 13168 return err; 13169 } 13170 13171 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info) 13172 { 13173 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13174 struct net_device *dev = info->user_ptr[1]; 13175 13176 return cfg80211_leave_mesh(rdev, dev); 13177 } 13178 13179 #ifdef CONFIG_PM 13180 static int nl80211_send_wowlan_patterns(struct sk_buff *msg, 13181 struct cfg80211_registered_device *rdev) 13182 { 13183 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config; 13184 struct nlattr *nl_pats, *nl_pat; 13185 int i, pat_len; 13186 13187 if (!wowlan->n_patterns) 13188 return 0; 13189 13190 nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN); 13191 if (!nl_pats) 13192 return -ENOBUFS; 13193 13194 for (i = 0; i < wowlan->n_patterns; i++) { 13195 nl_pat = nla_nest_start_noflag(msg, i + 1); 13196 if (!nl_pat) 13197 return -ENOBUFS; 13198 pat_len = wowlan->patterns[i].pattern_len; 13199 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8), 13200 wowlan->patterns[i].mask) || 13201 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 13202 wowlan->patterns[i].pattern) || 13203 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 13204 wowlan->patterns[i].pkt_offset)) 13205 return -ENOBUFS; 13206 nla_nest_end(msg, nl_pat); 13207 } 13208 nla_nest_end(msg, nl_pats); 13209 13210 return 0; 13211 } 13212 13213 static int nl80211_send_wowlan_tcp(struct sk_buff *msg, 13214 struct cfg80211_wowlan_tcp *tcp) 13215 { 13216 struct nlattr *nl_tcp; 13217 13218 if (!tcp) 13219 return 0; 13220 13221 nl_tcp = nla_nest_start_noflag(msg, 13222 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 13223 if (!nl_tcp) 13224 return -ENOBUFS; 13225 13226 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) || 13227 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) || 13228 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) || 13229 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) || 13230 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) || 13231 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 13232 tcp->payload_len, tcp->payload) || 13233 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 13234 tcp->data_interval) || 13235 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 13236 tcp->wake_len, tcp->wake_data) || 13237 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK, 13238 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask)) 13239 return -ENOBUFS; 13240 13241 if (tcp->payload_seq.len && 13242 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ, 13243 sizeof(tcp->payload_seq), &tcp->payload_seq)) 13244 return -ENOBUFS; 13245 13246 if (tcp->payload_tok.len && 13247 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 13248 sizeof(tcp->payload_tok) + tcp->tokens_size, 13249 &tcp->payload_tok)) 13250 return -ENOBUFS; 13251 13252 nla_nest_end(msg, nl_tcp); 13253 13254 return 0; 13255 } 13256 13257 static int nl80211_send_wowlan_nd(struct sk_buff *msg, 13258 struct cfg80211_sched_scan_request *req) 13259 { 13260 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan; 13261 int i; 13262 13263 if (!req) 13264 return 0; 13265 13266 nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT); 13267 if (!nd) 13268 return -ENOBUFS; 13269 13270 if (req->n_scan_plans == 1 && 13271 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL, 13272 req->scan_plans[0].interval * 1000)) 13273 return -ENOBUFS; 13274 13275 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay)) 13276 return -ENOBUFS; 13277 13278 if (req->relative_rssi_set) { 13279 struct nl80211_bss_select_rssi_adjust rssi_adjust; 13280 13281 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI, 13282 req->relative_rssi)) 13283 return -ENOBUFS; 13284 13285 rssi_adjust.band = req->rssi_adjust.band; 13286 rssi_adjust.delta = req->rssi_adjust.delta; 13287 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST, 13288 sizeof(rssi_adjust), &rssi_adjust)) 13289 return -ENOBUFS; 13290 } 13291 13292 freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 13293 if (!freqs) 13294 return -ENOBUFS; 13295 13296 for (i = 0; i < req->n_channels; i++) { 13297 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 13298 return -ENOBUFS; 13299 } 13300 13301 nla_nest_end(msg, freqs); 13302 13303 if (req->n_match_sets) { 13304 matches = nla_nest_start_noflag(msg, 13305 NL80211_ATTR_SCHED_SCAN_MATCH); 13306 if (!matches) 13307 return -ENOBUFS; 13308 13309 for (i = 0; i < req->n_match_sets; i++) { 13310 match = nla_nest_start_noflag(msg, i); 13311 if (!match) 13312 return -ENOBUFS; 13313 13314 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID, 13315 req->match_sets[i].ssid.ssid_len, 13316 req->match_sets[i].ssid.ssid)) 13317 return -ENOBUFS; 13318 nla_nest_end(msg, match); 13319 } 13320 nla_nest_end(msg, matches); 13321 } 13322 13323 scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS); 13324 if (!scan_plans) 13325 return -ENOBUFS; 13326 13327 for (i = 0; i < req->n_scan_plans; i++) { 13328 scan_plan = nla_nest_start_noflag(msg, i + 1); 13329 if (!scan_plan) 13330 return -ENOBUFS; 13331 13332 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL, 13333 req->scan_plans[i].interval) || 13334 (req->scan_plans[i].iterations && 13335 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS, 13336 req->scan_plans[i].iterations))) 13337 return -ENOBUFS; 13338 nla_nest_end(msg, scan_plan); 13339 } 13340 nla_nest_end(msg, scan_plans); 13341 13342 nla_nest_end(msg, nd); 13343 13344 return 0; 13345 } 13346 13347 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info) 13348 { 13349 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13350 struct sk_buff *msg; 13351 void *hdr; 13352 u32 size = NLMSG_DEFAULT_SIZE; 13353 13354 if (!rdev->wiphy.wowlan) 13355 return -EOPNOTSUPP; 13356 13357 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) { 13358 /* adjust size to have room for all the data */ 13359 size += rdev->wiphy.wowlan_config->tcp->tokens_size + 13360 rdev->wiphy.wowlan_config->tcp->payload_len + 13361 rdev->wiphy.wowlan_config->tcp->wake_len + 13362 rdev->wiphy.wowlan_config->tcp->wake_len / 8; 13363 } 13364 13365 msg = nlmsg_new(size, GFP_KERNEL); 13366 if (!msg) 13367 return -ENOMEM; 13368 13369 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13370 NL80211_CMD_GET_WOWLAN); 13371 if (!hdr) 13372 goto nla_put_failure; 13373 13374 if (rdev->wiphy.wowlan_config) { 13375 struct nlattr *nl_wowlan; 13376 13377 nl_wowlan = nla_nest_start_noflag(msg, 13378 NL80211_ATTR_WOWLAN_TRIGGERS); 13379 if (!nl_wowlan) 13380 goto nla_put_failure; 13381 13382 if ((rdev->wiphy.wowlan_config->any && 13383 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 13384 (rdev->wiphy.wowlan_config->disconnect && 13385 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 13386 (rdev->wiphy.wowlan_config->magic_pkt && 13387 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 13388 (rdev->wiphy.wowlan_config->gtk_rekey_failure && 13389 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 13390 (rdev->wiphy.wowlan_config->eap_identity_req && 13391 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 13392 (rdev->wiphy.wowlan_config->four_way_handshake && 13393 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 13394 (rdev->wiphy.wowlan_config->rfkill_release && 13395 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 13396 goto nla_put_failure; 13397 13398 if (nl80211_send_wowlan_patterns(msg, rdev)) 13399 goto nla_put_failure; 13400 13401 if (nl80211_send_wowlan_tcp(msg, 13402 rdev->wiphy.wowlan_config->tcp)) 13403 goto nla_put_failure; 13404 13405 if (nl80211_send_wowlan_nd( 13406 msg, 13407 rdev->wiphy.wowlan_config->nd_config)) 13408 goto nla_put_failure; 13409 13410 nla_nest_end(msg, nl_wowlan); 13411 } 13412 13413 genlmsg_end(msg, hdr); 13414 return genlmsg_reply(msg, info); 13415 13416 nla_put_failure: 13417 nlmsg_free(msg); 13418 return -ENOBUFS; 13419 } 13420 13421 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev, 13422 struct nlattr *attr, 13423 struct cfg80211_wowlan *trig) 13424 { 13425 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP]; 13426 struct cfg80211_wowlan_tcp *cfg; 13427 struct nl80211_wowlan_tcp_data_token *tok = NULL; 13428 struct nl80211_wowlan_tcp_data_seq *seq = NULL; 13429 u32 size; 13430 u32 data_size, wake_size, tokens_size = 0, wake_mask_size; 13431 int err, port; 13432 13433 if (!rdev->wiphy.wowlan->tcp) 13434 return -EINVAL; 13435 13436 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr, 13437 nl80211_wowlan_tcp_policy, NULL); 13438 if (err) 13439 return err; 13440 13441 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] || 13442 !tb[NL80211_WOWLAN_TCP_DST_IPV4] || 13443 !tb[NL80211_WOWLAN_TCP_DST_MAC] || 13444 !tb[NL80211_WOWLAN_TCP_DST_PORT] || 13445 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] || 13446 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] || 13447 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] || 13448 !tb[NL80211_WOWLAN_TCP_WAKE_MASK]) 13449 return -EINVAL; 13450 13451 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]); 13452 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max) 13453 return -EINVAL; 13454 13455 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) > 13456 rdev->wiphy.wowlan->tcp->data_interval_max || 13457 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0) 13458 return -EINVAL; 13459 13460 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]); 13461 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max) 13462 return -EINVAL; 13463 13464 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]); 13465 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8)) 13466 return -EINVAL; 13467 13468 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) { 13469 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13470 13471 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13472 tokens_size = tokln - sizeof(*tok); 13473 13474 if (!tok->len || tokens_size % tok->len) 13475 return -EINVAL; 13476 if (!rdev->wiphy.wowlan->tcp->tok) 13477 return -EINVAL; 13478 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len) 13479 return -EINVAL; 13480 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len) 13481 return -EINVAL; 13482 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize) 13483 return -EINVAL; 13484 if (tok->offset + tok->len > data_size) 13485 return -EINVAL; 13486 } 13487 13488 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) { 13489 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]); 13490 if (!rdev->wiphy.wowlan->tcp->seq) 13491 return -EINVAL; 13492 if (seq->len == 0 || seq->len > 4) 13493 return -EINVAL; 13494 if (seq->len + seq->offset > data_size) 13495 return -EINVAL; 13496 } 13497 13498 size = sizeof(*cfg); 13499 size += data_size; 13500 size += wake_size + wake_mask_size; 13501 size += tokens_size; 13502 13503 cfg = kzalloc(size, GFP_KERNEL); 13504 if (!cfg) 13505 return -ENOMEM; 13506 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]); 13507 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]); 13508 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]), 13509 ETH_ALEN); 13510 if (tb[NL80211_WOWLAN_TCP_SRC_PORT]) 13511 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]); 13512 else 13513 port = 0; 13514 #ifdef CONFIG_INET 13515 /* allocate a socket and port for it and use it */ 13516 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM, 13517 IPPROTO_TCP, &cfg->sock, 1); 13518 if (err) { 13519 kfree(cfg); 13520 return err; 13521 } 13522 if (inet_csk_get_port(cfg->sock->sk, port)) { 13523 sock_release(cfg->sock); 13524 kfree(cfg); 13525 return -EADDRINUSE; 13526 } 13527 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num; 13528 #else 13529 if (!port) { 13530 kfree(cfg); 13531 return -EINVAL; 13532 } 13533 cfg->src_port = port; 13534 #endif 13535 13536 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]); 13537 cfg->payload_len = data_size; 13538 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size; 13539 memcpy((void *)cfg->payload, 13540 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]), 13541 data_size); 13542 if (seq) 13543 cfg->payload_seq = *seq; 13544 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]); 13545 cfg->wake_len = wake_size; 13546 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size; 13547 memcpy((void *)cfg->wake_data, 13548 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]), 13549 wake_size); 13550 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size + 13551 data_size + wake_size; 13552 memcpy((void *)cfg->wake_mask, 13553 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]), 13554 wake_mask_size); 13555 if (tok) { 13556 cfg->tokens_size = tokens_size; 13557 cfg->payload_tok = *tok; 13558 memcpy(cfg->payload_tok.token_stream, tok->token_stream, 13559 tokens_size); 13560 } 13561 13562 trig->tcp = cfg; 13563 13564 return 0; 13565 } 13566 13567 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev, 13568 const struct wiphy_wowlan_support *wowlan, 13569 struct nlattr *attr, 13570 struct cfg80211_wowlan *trig) 13571 { 13572 struct nlattr **tb; 13573 int err; 13574 13575 tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 13576 if (!tb) 13577 return -ENOMEM; 13578 13579 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) { 13580 err = -EOPNOTSUPP; 13581 goto out; 13582 } 13583 13584 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr, 13585 nl80211_policy, NULL); 13586 if (err) 13587 goto out; 13588 13589 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb, 13590 wowlan->max_nd_match_sets); 13591 err = PTR_ERR_OR_ZERO(trig->nd_config); 13592 if (err) 13593 trig->nd_config = NULL; 13594 13595 out: 13596 kfree(tb); 13597 return err; 13598 } 13599 13600 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info) 13601 { 13602 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13603 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG]; 13604 struct cfg80211_wowlan new_triggers = {}; 13605 struct cfg80211_wowlan *ntrig; 13606 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan; 13607 int err, i; 13608 bool prev_enabled = rdev->wiphy.wowlan_config; 13609 bool regular = false; 13610 13611 if (!wowlan) 13612 return -EOPNOTSUPP; 13613 13614 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) { 13615 cfg80211_rdev_free_wowlan(rdev); 13616 rdev->wiphy.wowlan_config = NULL; 13617 goto set_wakeup; 13618 } 13619 13620 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG, 13621 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS], 13622 nl80211_wowlan_policy, info->extack); 13623 if (err) 13624 return err; 13625 13626 if (tb[NL80211_WOWLAN_TRIG_ANY]) { 13627 if (!(wowlan->flags & WIPHY_WOWLAN_ANY)) 13628 return -EINVAL; 13629 new_triggers.any = true; 13630 } 13631 13632 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) { 13633 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT)) 13634 return -EINVAL; 13635 new_triggers.disconnect = true; 13636 regular = true; 13637 } 13638 13639 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) { 13640 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT)) 13641 return -EINVAL; 13642 new_triggers.magic_pkt = true; 13643 regular = true; 13644 } 13645 13646 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED]) 13647 return -EINVAL; 13648 13649 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) { 13650 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE)) 13651 return -EINVAL; 13652 new_triggers.gtk_rekey_failure = true; 13653 regular = true; 13654 } 13655 13656 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) { 13657 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ)) 13658 return -EINVAL; 13659 new_triggers.eap_identity_req = true; 13660 regular = true; 13661 } 13662 13663 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) { 13664 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE)) 13665 return -EINVAL; 13666 new_triggers.four_way_handshake = true; 13667 regular = true; 13668 } 13669 13670 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) { 13671 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE)) 13672 return -EINVAL; 13673 new_triggers.rfkill_release = true; 13674 regular = true; 13675 } 13676 13677 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) { 13678 struct nlattr *pat; 13679 int n_patterns = 0; 13680 int rem, pat_len, mask_len, pkt_offset; 13681 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 13682 13683 regular = true; 13684 13685 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13686 rem) 13687 n_patterns++; 13688 if (n_patterns > wowlan->n_patterns) 13689 return -EINVAL; 13690 13691 new_triggers.patterns = kcalloc(n_patterns, 13692 sizeof(new_triggers.patterns[0]), 13693 GFP_KERNEL); 13694 if (!new_triggers.patterns) 13695 return -ENOMEM; 13696 13697 new_triggers.n_patterns = n_patterns; 13698 i = 0; 13699 13700 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13701 rem) { 13702 u8 *mask_pat; 13703 13704 err = nla_parse_nested_deprecated(pat_tb, 13705 MAX_NL80211_PKTPAT, 13706 pat, 13707 nl80211_packet_pattern_policy, 13708 info->extack); 13709 if (err) 13710 goto error; 13711 13712 err = -EINVAL; 13713 if (!pat_tb[NL80211_PKTPAT_MASK] || 13714 !pat_tb[NL80211_PKTPAT_PATTERN]) 13715 goto error; 13716 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 13717 mask_len = DIV_ROUND_UP(pat_len, 8); 13718 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 13719 goto error; 13720 if (pat_len > wowlan->pattern_max_len || 13721 pat_len < wowlan->pattern_min_len) 13722 goto error; 13723 13724 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 13725 pkt_offset = 0; 13726 else 13727 pkt_offset = nla_get_u32( 13728 pat_tb[NL80211_PKTPAT_OFFSET]); 13729 if (pkt_offset > wowlan->max_pkt_offset) 13730 goto error; 13731 new_triggers.patterns[i].pkt_offset = pkt_offset; 13732 13733 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 13734 if (!mask_pat) { 13735 err = -ENOMEM; 13736 goto error; 13737 } 13738 new_triggers.patterns[i].mask = mask_pat; 13739 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 13740 mask_len); 13741 mask_pat += mask_len; 13742 new_triggers.patterns[i].pattern = mask_pat; 13743 new_triggers.patterns[i].pattern_len = pat_len; 13744 memcpy(mask_pat, 13745 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 13746 pat_len); 13747 i++; 13748 } 13749 } 13750 13751 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) { 13752 regular = true; 13753 err = nl80211_parse_wowlan_tcp( 13754 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION], 13755 &new_triggers); 13756 if (err) 13757 goto error; 13758 } 13759 13760 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) { 13761 regular = true; 13762 err = nl80211_parse_wowlan_nd( 13763 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT], 13764 &new_triggers); 13765 if (err) 13766 goto error; 13767 } 13768 13769 /* The 'any' trigger means the device continues operating more or less 13770 * as in its normal operation mode and wakes up the host on most of the 13771 * normal interrupts (like packet RX, ...) 13772 * It therefore makes little sense to combine with the more constrained 13773 * wakeup trigger modes. 13774 */ 13775 if (new_triggers.any && regular) { 13776 err = -EINVAL; 13777 goto error; 13778 } 13779 13780 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL); 13781 if (!ntrig) { 13782 err = -ENOMEM; 13783 goto error; 13784 } 13785 cfg80211_rdev_free_wowlan(rdev); 13786 rdev->wiphy.wowlan_config = ntrig; 13787 13788 set_wakeup: 13789 if (rdev->ops->set_wakeup && 13790 prev_enabled != !!rdev->wiphy.wowlan_config) 13791 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config); 13792 13793 return 0; 13794 error: 13795 for (i = 0; i < new_triggers.n_patterns; i++) 13796 kfree(new_triggers.patterns[i].mask); 13797 kfree(new_triggers.patterns); 13798 if (new_triggers.tcp && new_triggers.tcp->sock) 13799 sock_release(new_triggers.tcp->sock); 13800 kfree(new_triggers.tcp); 13801 kfree(new_triggers.nd_config); 13802 return err; 13803 } 13804 #endif 13805 13806 static int nl80211_send_coalesce_rules(struct sk_buff *msg, 13807 struct cfg80211_registered_device *rdev) 13808 { 13809 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules; 13810 int i, j, pat_len; 13811 struct cfg80211_coalesce_rules *rule; 13812 13813 if (!rdev->coalesce->n_rules) 13814 return 0; 13815 13816 nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE); 13817 if (!nl_rules) 13818 return -ENOBUFS; 13819 13820 for (i = 0; i < rdev->coalesce->n_rules; i++) { 13821 nl_rule = nla_nest_start_noflag(msg, i + 1); 13822 if (!nl_rule) 13823 return -ENOBUFS; 13824 13825 rule = &rdev->coalesce->rules[i]; 13826 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY, 13827 rule->delay)) 13828 return -ENOBUFS; 13829 13830 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION, 13831 rule->condition)) 13832 return -ENOBUFS; 13833 13834 nl_pats = nla_nest_start_noflag(msg, 13835 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN); 13836 if (!nl_pats) 13837 return -ENOBUFS; 13838 13839 for (j = 0; j < rule->n_patterns; j++) { 13840 nl_pat = nla_nest_start_noflag(msg, j + 1); 13841 if (!nl_pat) 13842 return -ENOBUFS; 13843 pat_len = rule->patterns[j].pattern_len; 13844 if (nla_put(msg, NL80211_PKTPAT_MASK, 13845 DIV_ROUND_UP(pat_len, 8), 13846 rule->patterns[j].mask) || 13847 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 13848 rule->patterns[j].pattern) || 13849 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 13850 rule->patterns[j].pkt_offset)) 13851 return -ENOBUFS; 13852 nla_nest_end(msg, nl_pat); 13853 } 13854 nla_nest_end(msg, nl_pats); 13855 nla_nest_end(msg, nl_rule); 13856 } 13857 nla_nest_end(msg, nl_rules); 13858 13859 return 0; 13860 } 13861 13862 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info) 13863 { 13864 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13865 struct sk_buff *msg; 13866 void *hdr; 13867 13868 if (!rdev->wiphy.coalesce) 13869 return -EOPNOTSUPP; 13870 13871 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13872 if (!msg) 13873 return -ENOMEM; 13874 13875 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13876 NL80211_CMD_GET_COALESCE); 13877 if (!hdr) 13878 goto nla_put_failure; 13879 13880 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev)) 13881 goto nla_put_failure; 13882 13883 genlmsg_end(msg, hdr); 13884 return genlmsg_reply(msg, info); 13885 13886 nla_put_failure: 13887 nlmsg_free(msg); 13888 return -ENOBUFS; 13889 } 13890 13891 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev) 13892 { 13893 struct cfg80211_coalesce *coalesce = rdev->coalesce; 13894 int i, j; 13895 struct cfg80211_coalesce_rules *rule; 13896 13897 if (!coalesce) 13898 return; 13899 13900 for (i = 0; i < coalesce->n_rules; i++) { 13901 rule = &coalesce->rules[i]; 13902 for (j = 0; j < rule->n_patterns; j++) 13903 kfree(rule->patterns[j].mask); 13904 kfree(rule->patterns); 13905 } 13906 kfree(coalesce->rules); 13907 kfree(coalesce); 13908 rdev->coalesce = NULL; 13909 } 13910 13911 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev, 13912 struct nlattr *rule, 13913 struct cfg80211_coalesce_rules *new_rule) 13914 { 13915 int err, i; 13916 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 13917 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat; 13918 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0; 13919 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 13920 13921 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX, 13922 rule, nl80211_coalesce_policy, NULL); 13923 if (err) 13924 return err; 13925 13926 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY]) 13927 new_rule->delay = 13928 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]); 13929 if (new_rule->delay > coalesce->max_delay) 13930 return -EINVAL; 13931 13932 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION]) 13933 new_rule->condition = 13934 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]); 13935 13936 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN]) 13937 return -EINVAL; 13938 13939 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 13940 rem) 13941 n_patterns++; 13942 if (n_patterns > coalesce->n_patterns) 13943 return -EINVAL; 13944 13945 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]), 13946 GFP_KERNEL); 13947 if (!new_rule->patterns) 13948 return -ENOMEM; 13949 13950 new_rule->n_patterns = n_patterns; 13951 i = 0; 13952 13953 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 13954 rem) { 13955 u8 *mask_pat; 13956 13957 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT, 13958 pat, 13959 nl80211_packet_pattern_policy, 13960 NULL); 13961 if (err) 13962 return err; 13963 13964 if (!pat_tb[NL80211_PKTPAT_MASK] || 13965 !pat_tb[NL80211_PKTPAT_PATTERN]) 13966 return -EINVAL; 13967 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 13968 mask_len = DIV_ROUND_UP(pat_len, 8); 13969 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 13970 return -EINVAL; 13971 if (pat_len > coalesce->pattern_max_len || 13972 pat_len < coalesce->pattern_min_len) 13973 return -EINVAL; 13974 13975 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 13976 pkt_offset = 0; 13977 else 13978 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]); 13979 if (pkt_offset > coalesce->max_pkt_offset) 13980 return -EINVAL; 13981 new_rule->patterns[i].pkt_offset = pkt_offset; 13982 13983 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 13984 if (!mask_pat) 13985 return -ENOMEM; 13986 13987 new_rule->patterns[i].mask = mask_pat; 13988 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 13989 mask_len); 13990 13991 mask_pat += mask_len; 13992 new_rule->patterns[i].pattern = mask_pat; 13993 new_rule->patterns[i].pattern_len = pat_len; 13994 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 13995 pat_len); 13996 i++; 13997 } 13998 13999 return 0; 14000 } 14001 14002 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info) 14003 { 14004 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14005 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 14006 struct cfg80211_coalesce new_coalesce = {}; 14007 struct cfg80211_coalesce *n_coalesce; 14008 int err, rem_rule, n_rules = 0, i, j; 14009 struct nlattr *rule; 14010 struct cfg80211_coalesce_rules *tmp_rule; 14011 14012 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce) 14013 return -EOPNOTSUPP; 14014 14015 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) { 14016 cfg80211_rdev_free_coalesce(rdev); 14017 rdev_set_coalesce(rdev, NULL); 14018 return 0; 14019 } 14020 14021 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 14022 rem_rule) 14023 n_rules++; 14024 if (n_rules > coalesce->n_rules) 14025 return -EINVAL; 14026 14027 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]), 14028 GFP_KERNEL); 14029 if (!new_coalesce.rules) 14030 return -ENOMEM; 14031 14032 new_coalesce.n_rules = n_rules; 14033 i = 0; 14034 14035 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 14036 rem_rule) { 14037 err = nl80211_parse_coalesce_rule(rdev, rule, 14038 &new_coalesce.rules[i]); 14039 if (err) 14040 goto error; 14041 14042 i++; 14043 } 14044 14045 err = rdev_set_coalesce(rdev, &new_coalesce); 14046 if (err) 14047 goto error; 14048 14049 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL); 14050 if (!n_coalesce) { 14051 err = -ENOMEM; 14052 goto error; 14053 } 14054 cfg80211_rdev_free_coalesce(rdev); 14055 rdev->coalesce = n_coalesce; 14056 14057 return 0; 14058 error: 14059 for (i = 0; i < new_coalesce.n_rules; i++) { 14060 tmp_rule = &new_coalesce.rules[i]; 14061 if (!tmp_rule) 14062 continue; 14063 for (j = 0; j < tmp_rule->n_patterns; j++) 14064 kfree(tmp_rule->patterns[j].mask); 14065 kfree(tmp_rule->patterns); 14066 } 14067 kfree(new_coalesce.rules); 14068 14069 return err; 14070 } 14071 14072 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info) 14073 { 14074 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14075 struct net_device *dev = info->user_ptr[1]; 14076 struct wireless_dev *wdev = dev->ieee80211_ptr; 14077 struct nlattr *tb[NUM_NL80211_REKEY_DATA]; 14078 struct cfg80211_gtk_rekey_data rekey_data = {}; 14079 int err; 14080 14081 if (!info->attrs[NL80211_ATTR_REKEY_DATA]) 14082 return -EINVAL; 14083 14084 err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA, 14085 info->attrs[NL80211_ATTR_REKEY_DATA], 14086 nl80211_rekey_policy, info->extack); 14087 if (err) 14088 return err; 14089 14090 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] || 14091 !tb[NL80211_REKEY_DATA_KCK]) 14092 return -EINVAL; 14093 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN && 14094 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14095 nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN)) 14096 return -ERANGE; 14097 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN && 14098 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14099 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) && 14100 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 && 14101 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32)) 14102 return -ERANGE; 14103 14104 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]); 14105 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]); 14106 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]); 14107 rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]); 14108 rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]); 14109 if (tb[NL80211_REKEY_DATA_AKM]) 14110 rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]); 14111 14112 if (!wdev->connected) 14113 return -ENOTCONN; 14114 14115 if (!rdev->ops->set_rekey_data) 14116 return -EOPNOTSUPP; 14117 14118 return rdev_set_rekey_data(rdev, dev, &rekey_data); 14119 } 14120 14121 static int nl80211_register_unexpected_frame(struct sk_buff *skb, 14122 struct genl_info *info) 14123 { 14124 struct net_device *dev = info->user_ptr[1]; 14125 struct wireless_dev *wdev = dev->ieee80211_ptr; 14126 14127 if (wdev->iftype != NL80211_IFTYPE_AP && 14128 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14129 return -EINVAL; 14130 14131 if (wdev->ap_unexpected_nlportid) 14132 return -EBUSY; 14133 14134 wdev->ap_unexpected_nlportid = info->snd_portid; 14135 return 0; 14136 } 14137 14138 static int nl80211_probe_client(struct sk_buff *skb, 14139 struct genl_info *info) 14140 { 14141 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14142 struct net_device *dev = info->user_ptr[1]; 14143 struct wireless_dev *wdev = dev->ieee80211_ptr; 14144 struct sk_buff *msg; 14145 void *hdr; 14146 const u8 *addr; 14147 u64 cookie; 14148 int err; 14149 14150 if (wdev->iftype != NL80211_IFTYPE_AP && 14151 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14152 return -EOPNOTSUPP; 14153 14154 if (!info->attrs[NL80211_ATTR_MAC]) 14155 return -EINVAL; 14156 14157 if (!rdev->ops->probe_client) 14158 return -EOPNOTSUPP; 14159 14160 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14161 if (!msg) 14162 return -ENOMEM; 14163 14164 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14165 NL80211_CMD_PROBE_CLIENT); 14166 if (!hdr) { 14167 err = -ENOBUFS; 14168 goto free_msg; 14169 } 14170 14171 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 14172 14173 err = rdev_probe_client(rdev, dev, addr, &cookie); 14174 if (err) 14175 goto free_msg; 14176 14177 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14178 NL80211_ATTR_PAD)) 14179 goto nla_put_failure; 14180 14181 genlmsg_end(msg, hdr); 14182 14183 return genlmsg_reply(msg, info); 14184 14185 nla_put_failure: 14186 err = -ENOBUFS; 14187 free_msg: 14188 nlmsg_free(msg); 14189 return err; 14190 } 14191 14192 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info) 14193 { 14194 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14195 struct cfg80211_beacon_registration *reg, *nreg; 14196 int rv; 14197 14198 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS)) 14199 return -EOPNOTSUPP; 14200 14201 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL); 14202 if (!nreg) 14203 return -ENOMEM; 14204 14205 /* First, check if already registered. */ 14206 spin_lock_bh(&rdev->beacon_registrations_lock); 14207 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 14208 if (reg->nlportid == info->snd_portid) { 14209 rv = -EALREADY; 14210 goto out_err; 14211 } 14212 } 14213 /* Add it to the list */ 14214 nreg->nlportid = info->snd_portid; 14215 list_add(&nreg->list, &rdev->beacon_registrations); 14216 14217 spin_unlock_bh(&rdev->beacon_registrations_lock); 14218 14219 return 0; 14220 out_err: 14221 spin_unlock_bh(&rdev->beacon_registrations_lock); 14222 kfree(nreg); 14223 return rv; 14224 } 14225 14226 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info) 14227 { 14228 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14229 struct wireless_dev *wdev = info->user_ptr[1]; 14230 int err; 14231 14232 if (!rdev->ops->start_p2p_device) 14233 return -EOPNOTSUPP; 14234 14235 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14236 return -EOPNOTSUPP; 14237 14238 if (wdev_running(wdev)) 14239 return 0; 14240 14241 if (rfkill_blocked(rdev->wiphy.rfkill)) 14242 return -ERFKILL; 14243 14244 err = rdev_start_p2p_device(rdev, wdev); 14245 if (err) 14246 return err; 14247 14248 wdev->is_running = true; 14249 rdev->opencount++; 14250 14251 return 0; 14252 } 14253 14254 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info) 14255 { 14256 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14257 struct wireless_dev *wdev = info->user_ptr[1]; 14258 14259 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14260 return -EOPNOTSUPP; 14261 14262 if (!rdev->ops->stop_p2p_device) 14263 return -EOPNOTSUPP; 14264 14265 cfg80211_stop_p2p_device(rdev, wdev); 14266 14267 return 0; 14268 } 14269 14270 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info) 14271 { 14272 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14273 struct wireless_dev *wdev = info->user_ptr[1]; 14274 struct cfg80211_nan_conf conf = {}; 14275 int err; 14276 14277 if (wdev->iftype != NL80211_IFTYPE_NAN) 14278 return -EOPNOTSUPP; 14279 14280 if (wdev_running(wdev)) 14281 return -EEXIST; 14282 14283 if (rfkill_blocked(rdev->wiphy.rfkill)) 14284 return -ERFKILL; 14285 14286 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) 14287 return -EINVAL; 14288 14289 conf.master_pref = 14290 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14291 14292 if (info->attrs[NL80211_ATTR_BANDS]) { 14293 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14294 14295 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14296 return -EOPNOTSUPP; 14297 14298 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14299 return -EINVAL; 14300 14301 conf.bands = bands; 14302 } 14303 14304 err = rdev_start_nan(rdev, wdev, &conf); 14305 if (err) 14306 return err; 14307 14308 wdev->is_running = true; 14309 rdev->opencount++; 14310 14311 return 0; 14312 } 14313 14314 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info) 14315 { 14316 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14317 struct wireless_dev *wdev = info->user_ptr[1]; 14318 14319 if (wdev->iftype != NL80211_IFTYPE_NAN) 14320 return -EOPNOTSUPP; 14321 14322 cfg80211_stop_nan(rdev, wdev); 14323 14324 return 0; 14325 } 14326 14327 static int validate_nan_filter(struct nlattr *filter_attr) 14328 { 14329 struct nlattr *attr; 14330 int len = 0, n_entries = 0, rem; 14331 14332 nla_for_each_nested(attr, filter_attr, rem) { 14333 len += nla_len(attr); 14334 n_entries++; 14335 } 14336 14337 if (len >= U8_MAX) 14338 return -EINVAL; 14339 14340 return n_entries; 14341 } 14342 14343 static int handle_nan_filter(struct nlattr *attr_filter, 14344 struct cfg80211_nan_func *func, 14345 bool tx) 14346 { 14347 struct nlattr *attr; 14348 int n_entries, rem, i; 14349 struct cfg80211_nan_func_filter *filter; 14350 14351 n_entries = validate_nan_filter(attr_filter); 14352 if (n_entries < 0) 14353 return n_entries; 14354 14355 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters)); 14356 14357 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL); 14358 if (!filter) 14359 return -ENOMEM; 14360 14361 i = 0; 14362 nla_for_each_nested(attr, attr_filter, rem) { 14363 filter[i].filter = nla_memdup(attr, GFP_KERNEL); 14364 if (!filter[i].filter) 14365 goto err; 14366 14367 filter[i].len = nla_len(attr); 14368 i++; 14369 } 14370 if (tx) { 14371 func->num_tx_filters = n_entries; 14372 func->tx_filters = filter; 14373 } else { 14374 func->num_rx_filters = n_entries; 14375 func->rx_filters = filter; 14376 } 14377 14378 return 0; 14379 14380 err: 14381 i = 0; 14382 nla_for_each_nested(attr, attr_filter, rem) { 14383 kfree(filter[i].filter); 14384 i++; 14385 } 14386 kfree(filter); 14387 return -ENOMEM; 14388 } 14389 14390 static int nl80211_nan_add_func(struct sk_buff *skb, 14391 struct genl_info *info) 14392 { 14393 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14394 struct wireless_dev *wdev = info->user_ptr[1]; 14395 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr; 14396 struct cfg80211_nan_func *func; 14397 struct sk_buff *msg = NULL; 14398 void *hdr = NULL; 14399 int err = 0; 14400 14401 if (wdev->iftype != NL80211_IFTYPE_NAN) 14402 return -EOPNOTSUPP; 14403 14404 if (!wdev_running(wdev)) 14405 return -ENOTCONN; 14406 14407 if (!info->attrs[NL80211_ATTR_NAN_FUNC]) 14408 return -EINVAL; 14409 14410 err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX, 14411 info->attrs[NL80211_ATTR_NAN_FUNC], 14412 nl80211_nan_func_policy, 14413 info->extack); 14414 if (err) 14415 return err; 14416 14417 func = kzalloc(sizeof(*func), GFP_KERNEL); 14418 if (!func) 14419 return -ENOMEM; 14420 14421 func->cookie = cfg80211_assign_cookie(rdev); 14422 14423 if (!tb[NL80211_NAN_FUNC_TYPE]) { 14424 err = -EINVAL; 14425 goto out; 14426 } 14427 14428 14429 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]); 14430 14431 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) { 14432 err = -EINVAL; 14433 goto out; 14434 } 14435 14436 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]), 14437 sizeof(func->service_id)); 14438 14439 func->close_range = 14440 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]); 14441 14442 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) { 14443 func->serv_spec_info_len = 14444 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]); 14445 func->serv_spec_info = 14446 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]), 14447 func->serv_spec_info_len, 14448 GFP_KERNEL); 14449 if (!func->serv_spec_info) { 14450 err = -ENOMEM; 14451 goto out; 14452 } 14453 } 14454 14455 if (tb[NL80211_NAN_FUNC_TTL]) 14456 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]); 14457 14458 switch (func->type) { 14459 case NL80211_NAN_FUNC_PUBLISH: 14460 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) { 14461 err = -EINVAL; 14462 goto out; 14463 } 14464 14465 func->publish_type = 14466 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]); 14467 func->publish_bcast = 14468 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]); 14469 14470 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) && 14471 func->publish_bcast) { 14472 err = -EINVAL; 14473 goto out; 14474 } 14475 break; 14476 case NL80211_NAN_FUNC_SUBSCRIBE: 14477 func->subscribe_active = 14478 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]); 14479 break; 14480 case NL80211_NAN_FUNC_FOLLOW_UP: 14481 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] || 14482 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] || 14483 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) { 14484 err = -EINVAL; 14485 goto out; 14486 } 14487 14488 func->followup_id = 14489 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]); 14490 func->followup_reqid = 14491 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]); 14492 memcpy(func->followup_dest.addr, 14493 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]), 14494 sizeof(func->followup_dest.addr)); 14495 if (func->ttl) { 14496 err = -EINVAL; 14497 goto out; 14498 } 14499 break; 14500 default: 14501 err = -EINVAL; 14502 goto out; 14503 } 14504 14505 if (tb[NL80211_NAN_FUNC_SRF]) { 14506 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR]; 14507 14508 err = nla_parse_nested_deprecated(srf_tb, 14509 NL80211_NAN_SRF_ATTR_MAX, 14510 tb[NL80211_NAN_FUNC_SRF], 14511 nl80211_nan_srf_policy, 14512 info->extack); 14513 if (err) 14514 goto out; 14515 14516 func->srf_include = 14517 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]); 14518 14519 if (srf_tb[NL80211_NAN_SRF_BF]) { 14520 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] || 14521 !srf_tb[NL80211_NAN_SRF_BF_IDX]) { 14522 err = -EINVAL; 14523 goto out; 14524 } 14525 14526 func->srf_bf_len = 14527 nla_len(srf_tb[NL80211_NAN_SRF_BF]); 14528 func->srf_bf = 14529 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]), 14530 func->srf_bf_len, GFP_KERNEL); 14531 if (!func->srf_bf) { 14532 err = -ENOMEM; 14533 goto out; 14534 } 14535 14536 func->srf_bf_idx = 14537 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]); 14538 } else { 14539 struct nlattr *attr, *mac_attr = 14540 srf_tb[NL80211_NAN_SRF_MAC_ADDRS]; 14541 int n_entries, rem, i = 0; 14542 14543 if (!mac_attr) { 14544 err = -EINVAL; 14545 goto out; 14546 } 14547 14548 n_entries = validate_acl_mac_addrs(mac_attr); 14549 if (n_entries <= 0) { 14550 err = -EINVAL; 14551 goto out; 14552 } 14553 14554 func->srf_num_macs = n_entries; 14555 func->srf_macs = 14556 kcalloc(n_entries, sizeof(*func->srf_macs), 14557 GFP_KERNEL); 14558 if (!func->srf_macs) { 14559 err = -ENOMEM; 14560 goto out; 14561 } 14562 14563 nla_for_each_nested(attr, mac_attr, rem) 14564 memcpy(func->srf_macs[i++].addr, nla_data(attr), 14565 sizeof(*func->srf_macs)); 14566 } 14567 } 14568 14569 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) { 14570 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER], 14571 func, true); 14572 if (err) 14573 goto out; 14574 } 14575 14576 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) { 14577 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER], 14578 func, false); 14579 if (err) 14580 goto out; 14581 } 14582 14583 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14584 if (!msg) { 14585 err = -ENOMEM; 14586 goto out; 14587 } 14588 14589 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14590 NL80211_CMD_ADD_NAN_FUNCTION); 14591 /* This can't really happen - we just allocated 4KB */ 14592 if (WARN_ON(!hdr)) { 14593 err = -ENOMEM; 14594 goto out; 14595 } 14596 14597 err = rdev_add_nan_func(rdev, wdev, func); 14598 out: 14599 if (err < 0) { 14600 cfg80211_free_nan_func(func); 14601 nlmsg_free(msg); 14602 return err; 14603 } 14604 14605 /* propagate the instance id and cookie to userspace */ 14606 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie, 14607 NL80211_ATTR_PAD)) 14608 goto nla_put_failure; 14609 14610 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14611 if (!func_attr) 14612 goto nla_put_failure; 14613 14614 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, 14615 func->instance_id)) 14616 goto nla_put_failure; 14617 14618 nla_nest_end(msg, func_attr); 14619 14620 genlmsg_end(msg, hdr); 14621 return genlmsg_reply(msg, info); 14622 14623 nla_put_failure: 14624 nlmsg_free(msg); 14625 return -ENOBUFS; 14626 } 14627 14628 static int nl80211_nan_del_func(struct sk_buff *skb, 14629 struct genl_info *info) 14630 { 14631 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14632 struct wireless_dev *wdev = info->user_ptr[1]; 14633 u64 cookie; 14634 14635 if (wdev->iftype != NL80211_IFTYPE_NAN) 14636 return -EOPNOTSUPP; 14637 14638 if (!wdev_running(wdev)) 14639 return -ENOTCONN; 14640 14641 if (!info->attrs[NL80211_ATTR_COOKIE]) 14642 return -EINVAL; 14643 14644 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 14645 14646 rdev_del_nan_func(rdev, wdev, cookie); 14647 14648 return 0; 14649 } 14650 14651 static int nl80211_nan_change_config(struct sk_buff *skb, 14652 struct genl_info *info) 14653 { 14654 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14655 struct wireless_dev *wdev = info->user_ptr[1]; 14656 struct cfg80211_nan_conf conf = {}; 14657 u32 changed = 0; 14658 14659 if (wdev->iftype != NL80211_IFTYPE_NAN) 14660 return -EOPNOTSUPP; 14661 14662 if (!wdev_running(wdev)) 14663 return -ENOTCONN; 14664 14665 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) { 14666 conf.master_pref = 14667 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14668 if (conf.master_pref <= 1 || conf.master_pref == 255) 14669 return -EINVAL; 14670 14671 changed |= CFG80211_NAN_CONF_CHANGED_PREF; 14672 } 14673 14674 if (info->attrs[NL80211_ATTR_BANDS]) { 14675 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14676 14677 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14678 return -EOPNOTSUPP; 14679 14680 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14681 return -EINVAL; 14682 14683 conf.bands = bands; 14684 changed |= CFG80211_NAN_CONF_CHANGED_BANDS; 14685 } 14686 14687 if (!changed) 14688 return -EINVAL; 14689 14690 return rdev_nan_change_conf(rdev, wdev, &conf, changed); 14691 } 14692 14693 void cfg80211_nan_match(struct wireless_dev *wdev, 14694 struct cfg80211_nan_match_params *match, gfp_t gfp) 14695 { 14696 struct wiphy *wiphy = wdev->wiphy; 14697 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14698 struct nlattr *match_attr, *local_func_attr, *peer_func_attr; 14699 struct sk_buff *msg; 14700 void *hdr; 14701 14702 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr)) 14703 return; 14704 14705 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14706 if (!msg) 14707 return; 14708 14709 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH); 14710 if (!hdr) { 14711 nlmsg_free(msg); 14712 return; 14713 } 14714 14715 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14716 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14717 wdev->netdev->ifindex)) || 14718 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14719 NL80211_ATTR_PAD)) 14720 goto nla_put_failure; 14721 14722 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie, 14723 NL80211_ATTR_PAD) || 14724 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr)) 14725 goto nla_put_failure; 14726 14727 match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH); 14728 if (!match_attr) 14729 goto nla_put_failure; 14730 14731 local_func_attr = nla_nest_start_noflag(msg, 14732 NL80211_NAN_MATCH_FUNC_LOCAL); 14733 if (!local_func_attr) 14734 goto nla_put_failure; 14735 14736 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id)) 14737 goto nla_put_failure; 14738 14739 nla_nest_end(msg, local_func_attr); 14740 14741 peer_func_attr = nla_nest_start_noflag(msg, 14742 NL80211_NAN_MATCH_FUNC_PEER); 14743 if (!peer_func_attr) 14744 goto nla_put_failure; 14745 14746 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) || 14747 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id)) 14748 goto nla_put_failure; 14749 14750 if (match->info && match->info_len && 14751 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len, 14752 match->info)) 14753 goto nla_put_failure; 14754 14755 nla_nest_end(msg, peer_func_attr); 14756 nla_nest_end(msg, match_attr); 14757 genlmsg_end(msg, hdr); 14758 14759 if (!wdev->owner_nlportid) 14760 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14761 msg, 0, NL80211_MCGRP_NAN, gfp); 14762 else 14763 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14764 wdev->owner_nlportid); 14765 14766 return; 14767 14768 nla_put_failure: 14769 nlmsg_free(msg); 14770 } 14771 EXPORT_SYMBOL(cfg80211_nan_match); 14772 14773 void cfg80211_nan_func_terminated(struct wireless_dev *wdev, 14774 u8 inst_id, 14775 enum nl80211_nan_func_term_reason reason, 14776 u64 cookie, gfp_t gfp) 14777 { 14778 struct wiphy *wiphy = wdev->wiphy; 14779 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14780 struct sk_buff *msg; 14781 struct nlattr *func_attr; 14782 void *hdr; 14783 14784 if (WARN_ON(!inst_id)) 14785 return; 14786 14787 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14788 if (!msg) 14789 return; 14790 14791 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION); 14792 if (!hdr) { 14793 nlmsg_free(msg); 14794 return; 14795 } 14796 14797 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14798 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14799 wdev->netdev->ifindex)) || 14800 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14801 NL80211_ATTR_PAD)) 14802 goto nla_put_failure; 14803 14804 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14805 NL80211_ATTR_PAD)) 14806 goto nla_put_failure; 14807 14808 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14809 if (!func_attr) 14810 goto nla_put_failure; 14811 14812 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) || 14813 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason)) 14814 goto nla_put_failure; 14815 14816 nla_nest_end(msg, func_attr); 14817 genlmsg_end(msg, hdr); 14818 14819 if (!wdev->owner_nlportid) 14820 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14821 msg, 0, NL80211_MCGRP_NAN, gfp); 14822 else 14823 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14824 wdev->owner_nlportid); 14825 14826 return; 14827 14828 nla_put_failure: 14829 nlmsg_free(msg); 14830 } 14831 EXPORT_SYMBOL(cfg80211_nan_func_terminated); 14832 14833 static int nl80211_get_protocol_features(struct sk_buff *skb, 14834 struct genl_info *info) 14835 { 14836 void *hdr; 14837 struct sk_buff *msg; 14838 14839 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14840 if (!msg) 14841 return -ENOMEM; 14842 14843 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14844 NL80211_CMD_GET_PROTOCOL_FEATURES); 14845 if (!hdr) 14846 goto nla_put_failure; 14847 14848 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES, 14849 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP)) 14850 goto nla_put_failure; 14851 14852 genlmsg_end(msg, hdr); 14853 return genlmsg_reply(msg, info); 14854 14855 nla_put_failure: 14856 kfree_skb(msg); 14857 return -ENOBUFS; 14858 } 14859 14860 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info) 14861 { 14862 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14863 struct cfg80211_update_ft_ies_params ft_params; 14864 struct net_device *dev = info->user_ptr[1]; 14865 14866 if (!rdev->ops->update_ft_ies) 14867 return -EOPNOTSUPP; 14868 14869 if (!info->attrs[NL80211_ATTR_MDID] || 14870 !info->attrs[NL80211_ATTR_IE]) 14871 return -EINVAL; 14872 14873 memset(&ft_params, 0, sizeof(ft_params)); 14874 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]); 14875 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 14876 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 14877 14878 return rdev_update_ft_ies(rdev, dev, &ft_params); 14879 } 14880 14881 static int nl80211_crit_protocol_start(struct sk_buff *skb, 14882 struct genl_info *info) 14883 { 14884 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14885 struct wireless_dev *wdev = info->user_ptr[1]; 14886 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC; 14887 u16 duration; 14888 int ret; 14889 14890 if (!rdev->ops->crit_proto_start) 14891 return -EOPNOTSUPP; 14892 14893 if (WARN_ON(!rdev->ops->crit_proto_stop)) 14894 return -EINVAL; 14895 14896 if (rdev->crit_proto_nlportid) 14897 return -EBUSY; 14898 14899 /* determine protocol if provided */ 14900 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID]) 14901 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]); 14902 14903 if (proto >= NUM_NL80211_CRIT_PROTO) 14904 return -EINVAL; 14905 14906 /* timeout must be provided */ 14907 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]) 14908 return -EINVAL; 14909 14910 duration = 14911 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]); 14912 14913 ret = rdev_crit_proto_start(rdev, wdev, proto, duration); 14914 if (!ret) 14915 rdev->crit_proto_nlportid = info->snd_portid; 14916 14917 return ret; 14918 } 14919 14920 static int nl80211_crit_protocol_stop(struct sk_buff *skb, 14921 struct genl_info *info) 14922 { 14923 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14924 struct wireless_dev *wdev = info->user_ptr[1]; 14925 14926 if (!rdev->ops->crit_proto_stop) 14927 return -EOPNOTSUPP; 14928 14929 if (rdev->crit_proto_nlportid) { 14930 rdev->crit_proto_nlportid = 0; 14931 rdev_crit_proto_stop(rdev, wdev); 14932 } 14933 return 0; 14934 } 14935 14936 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd, 14937 struct nlattr *attr, 14938 struct netlink_ext_ack *extack) 14939 { 14940 if (vcmd->policy == VENDOR_CMD_RAW_DATA) { 14941 if (attr->nla_type & NLA_F_NESTED) { 14942 NL_SET_ERR_MSG_ATTR(extack, attr, 14943 "unexpected nested data"); 14944 return -EINVAL; 14945 } 14946 14947 return 0; 14948 } 14949 14950 if (!(attr->nla_type & NLA_F_NESTED)) { 14951 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data"); 14952 return -EINVAL; 14953 } 14954 14955 return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack); 14956 } 14957 14958 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info) 14959 { 14960 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14961 struct wireless_dev *wdev = 14962 __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 14963 info->attrs); 14964 int i, err; 14965 u32 vid, subcmd; 14966 14967 if (!rdev->wiphy.vendor_commands) 14968 return -EOPNOTSUPP; 14969 14970 if (IS_ERR(wdev)) { 14971 err = PTR_ERR(wdev); 14972 if (err != -EINVAL) 14973 return err; 14974 wdev = NULL; 14975 } else if (wdev->wiphy != &rdev->wiphy) { 14976 return -EINVAL; 14977 } 14978 14979 if (!info->attrs[NL80211_ATTR_VENDOR_ID] || 14980 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD]) 14981 return -EINVAL; 14982 14983 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]); 14984 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]); 14985 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 14986 const struct wiphy_vendor_command *vcmd; 14987 void *data = NULL; 14988 int len = 0; 14989 14990 vcmd = &rdev->wiphy.vendor_commands[i]; 14991 14992 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 14993 continue; 14994 14995 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 14996 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 14997 if (!wdev) 14998 return -EINVAL; 14999 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 15000 !wdev->netdev) 15001 return -EINVAL; 15002 15003 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 15004 if (!wdev_running(wdev)) 15005 return -ENETDOWN; 15006 } 15007 } else { 15008 wdev = NULL; 15009 } 15010 15011 if (!vcmd->doit) 15012 return -EOPNOTSUPP; 15013 15014 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) { 15015 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]); 15016 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]); 15017 15018 err = nl80211_vendor_check_policy(vcmd, 15019 info->attrs[NL80211_ATTR_VENDOR_DATA], 15020 info->extack); 15021 if (err) 15022 return err; 15023 } 15024 15025 rdev->cur_cmd_info = info; 15026 err = vcmd->doit(&rdev->wiphy, wdev, data, len); 15027 rdev->cur_cmd_info = NULL; 15028 return err; 15029 } 15030 15031 return -EOPNOTSUPP; 15032 } 15033 15034 static int nl80211_prepare_vendor_dump(struct sk_buff *skb, 15035 struct netlink_callback *cb, 15036 struct cfg80211_registered_device **rdev, 15037 struct wireless_dev **wdev) 15038 { 15039 struct nlattr **attrbuf; 15040 u32 vid, subcmd; 15041 unsigned int i; 15042 int vcmd_idx = -1; 15043 int err; 15044 void *data = NULL; 15045 unsigned int data_len = 0; 15046 15047 if (cb->args[0]) { 15048 /* subtract the 1 again here */ 15049 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 15050 struct wireless_dev *tmp; 15051 15052 if (!wiphy) 15053 return -ENODEV; 15054 *rdev = wiphy_to_rdev(wiphy); 15055 *wdev = NULL; 15056 15057 if (cb->args[1]) { 15058 list_for_each_entry(tmp, &wiphy->wdev_list, list) { 15059 if (tmp->identifier == cb->args[1] - 1) { 15060 *wdev = tmp; 15061 break; 15062 } 15063 } 15064 } 15065 15066 /* keep rtnl locked in successful case */ 15067 return 0; 15068 } 15069 15070 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 15071 if (!attrbuf) 15072 return -ENOMEM; 15073 15074 err = nlmsg_parse_deprecated(cb->nlh, 15075 GENL_HDRLEN + nl80211_fam.hdrsize, 15076 attrbuf, nl80211_fam.maxattr, 15077 nl80211_policy, NULL); 15078 if (err) 15079 goto out; 15080 15081 if (!attrbuf[NL80211_ATTR_VENDOR_ID] || 15082 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) { 15083 err = -EINVAL; 15084 goto out; 15085 } 15086 15087 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf); 15088 if (IS_ERR(*wdev)) 15089 *wdev = NULL; 15090 15091 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 15092 if (IS_ERR(*rdev)) { 15093 err = PTR_ERR(*rdev); 15094 goto out; 15095 } 15096 15097 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]); 15098 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]); 15099 15100 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) { 15101 const struct wiphy_vendor_command *vcmd; 15102 15103 vcmd = &(*rdev)->wiphy.vendor_commands[i]; 15104 15105 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 15106 continue; 15107 15108 if (!vcmd->dumpit) { 15109 err = -EOPNOTSUPP; 15110 goto out; 15111 } 15112 15113 vcmd_idx = i; 15114 break; 15115 } 15116 15117 if (vcmd_idx < 0) { 15118 err = -EOPNOTSUPP; 15119 goto out; 15120 } 15121 15122 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) { 15123 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15124 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15125 15126 err = nl80211_vendor_check_policy( 15127 &(*rdev)->wiphy.vendor_commands[vcmd_idx], 15128 attrbuf[NL80211_ATTR_VENDOR_DATA], 15129 cb->extack); 15130 if (err) 15131 goto out; 15132 } 15133 15134 /* 0 is the first index - add 1 to parse only once */ 15135 cb->args[0] = (*rdev)->wiphy_idx + 1; 15136 /* add 1 to know if it was NULL */ 15137 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0; 15138 cb->args[2] = vcmd_idx; 15139 cb->args[3] = (unsigned long)data; 15140 cb->args[4] = data_len; 15141 15142 /* keep rtnl locked in successful case */ 15143 err = 0; 15144 out: 15145 kfree(attrbuf); 15146 return err; 15147 } 15148 15149 static int nl80211_vendor_cmd_dump(struct sk_buff *skb, 15150 struct netlink_callback *cb) 15151 { 15152 struct cfg80211_registered_device *rdev; 15153 struct wireless_dev *wdev; 15154 unsigned int vcmd_idx; 15155 const struct wiphy_vendor_command *vcmd; 15156 void *data; 15157 int data_len; 15158 int err; 15159 struct nlattr *vendor_data; 15160 15161 rtnl_lock(); 15162 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev); 15163 if (err) 15164 goto out; 15165 15166 vcmd_idx = cb->args[2]; 15167 data = (void *)cb->args[3]; 15168 data_len = cb->args[4]; 15169 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx]; 15170 15171 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 15172 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 15173 if (!wdev) { 15174 err = -EINVAL; 15175 goto out; 15176 } 15177 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 15178 !wdev->netdev) { 15179 err = -EINVAL; 15180 goto out; 15181 } 15182 15183 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 15184 if (!wdev_running(wdev)) { 15185 err = -ENETDOWN; 15186 goto out; 15187 } 15188 } 15189 } 15190 15191 while (1) { 15192 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 15193 cb->nlh->nlmsg_seq, NLM_F_MULTI, 15194 NL80211_CMD_VENDOR); 15195 if (!hdr) 15196 break; 15197 15198 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15199 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 15200 wdev_id(wdev), 15201 NL80211_ATTR_PAD))) { 15202 genlmsg_cancel(skb, hdr); 15203 break; 15204 } 15205 15206 vendor_data = nla_nest_start_noflag(skb, 15207 NL80211_ATTR_VENDOR_DATA); 15208 if (!vendor_data) { 15209 genlmsg_cancel(skb, hdr); 15210 break; 15211 } 15212 15213 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len, 15214 (unsigned long *)&cb->args[5]); 15215 nla_nest_end(skb, vendor_data); 15216 15217 if (err == -ENOBUFS || err == -ENOENT) { 15218 genlmsg_cancel(skb, hdr); 15219 break; 15220 } else if (err <= 0) { 15221 genlmsg_cancel(skb, hdr); 15222 goto out; 15223 } 15224 15225 genlmsg_end(skb, hdr); 15226 } 15227 15228 err = skb->len; 15229 out: 15230 rtnl_unlock(); 15231 return err; 15232 } 15233 15234 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy, 15235 enum nl80211_commands cmd, 15236 enum nl80211_attrs attr, 15237 int approxlen) 15238 { 15239 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15240 15241 if (WARN_ON(!rdev->cur_cmd_info)) 15242 return NULL; 15243 15244 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen, 15245 rdev->cur_cmd_info->snd_portid, 15246 rdev->cur_cmd_info->snd_seq, 15247 cmd, attr, NULL, GFP_KERNEL); 15248 } 15249 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb); 15250 15251 int cfg80211_vendor_cmd_reply(struct sk_buff *skb) 15252 { 15253 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 15254 void *hdr = ((void **)skb->cb)[1]; 15255 struct nlattr *data = ((void **)skb->cb)[2]; 15256 15257 /* clear CB data for netlink core to own from now on */ 15258 memset(skb->cb, 0, sizeof(skb->cb)); 15259 15260 if (WARN_ON(!rdev->cur_cmd_info)) { 15261 kfree_skb(skb); 15262 return -EINVAL; 15263 } 15264 15265 nla_nest_end(skb, data); 15266 genlmsg_end(skb, hdr); 15267 return genlmsg_reply(skb, rdev->cur_cmd_info); 15268 } 15269 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply); 15270 15271 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy) 15272 { 15273 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15274 15275 if (WARN_ON(!rdev->cur_cmd_info)) 15276 return 0; 15277 15278 return rdev->cur_cmd_info->snd_portid; 15279 } 15280 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender); 15281 15282 static int nl80211_set_qos_map(struct sk_buff *skb, 15283 struct genl_info *info) 15284 { 15285 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15286 struct cfg80211_qos_map *qos_map = NULL; 15287 struct net_device *dev = info->user_ptr[1]; 15288 u8 *pos, len, num_des, des_len, des; 15289 int ret; 15290 15291 if (!rdev->ops->set_qos_map) 15292 return -EOPNOTSUPP; 15293 15294 if (info->attrs[NL80211_ATTR_QOS_MAP]) { 15295 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]); 15296 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]); 15297 15298 if (len % 2) 15299 return -EINVAL; 15300 15301 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL); 15302 if (!qos_map) 15303 return -ENOMEM; 15304 15305 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1; 15306 if (num_des) { 15307 des_len = num_des * 15308 sizeof(struct cfg80211_dscp_exception); 15309 memcpy(qos_map->dscp_exception, pos, des_len); 15310 qos_map->num_des = num_des; 15311 for (des = 0; des < num_des; des++) { 15312 if (qos_map->dscp_exception[des].up > 7) { 15313 kfree(qos_map); 15314 return -EINVAL; 15315 } 15316 } 15317 pos += des_len; 15318 } 15319 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN); 15320 } 15321 15322 ret = nl80211_key_allowed(dev->ieee80211_ptr); 15323 if (!ret) 15324 ret = rdev_set_qos_map(rdev, dev, qos_map); 15325 15326 kfree(qos_map); 15327 return ret; 15328 } 15329 15330 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info) 15331 { 15332 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15333 struct net_device *dev = info->user_ptr[1]; 15334 struct wireless_dev *wdev = dev->ieee80211_ptr; 15335 const u8 *peer; 15336 u8 tsid, up; 15337 u16 admitted_time = 0; 15338 15339 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)) 15340 return -EOPNOTSUPP; 15341 15342 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] || 15343 !info->attrs[NL80211_ATTR_USER_PRIO]) 15344 return -EINVAL; 15345 15346 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15347 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]); 15348 15349 /* WMM uses TIDs 0-7 even for TSPEC */ 15350 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) { 15351 /* TODO: handle 802.11 TSPEC/admission control 15352 * need more attributes for that (e.g. BA session requirement); 15353 * change the WMM adminssion test above to allow both then 15354 */ 15355 return -EINVAL; 15356 } 15357 15358 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15359 15360 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) { 15361 admitted_time = 15362 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]); 15363 if (!admitted_time) 15364 return -EINVAL; 15365 } 15366 15367 switch (wdev->iftype) { 15368 case NL80211_IFTYPE_STATION: 15369 case NL80211_IFTYPE_P2P_CLIENT: 15370 if (wdev->connected) 15371 break; 15372 return -ENOTCONN; 15373 default: 15374 return -EOPNOTSUPP; 15375 } 15376 15377 return rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time); 15378 } 15379 15380 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info) 15381 { 15382 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15383 struct net_device *dev = info->user_ptr[1]; 15384 const u8 *peer; 15385 u8 tsid; 15386 15387 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC]) 15388 return -EINVAL; 15389 15390 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15391 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15392 15393 return rdev_del_tx_ts(rdev, dev, tsid, peer); 15394 } 15395 15396 static int nl80211_tdls_channel_switch(struct sk_buff *skb, 15397 struct genl_info *info) 15398 { 15399 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15400 struct net_device *dev = info->user_ptr[1]; 15401 struct wireless_dev *wdev = dev->ieee80211_ptr; 15402 struct cfg80211_chan_def chandef = {}; 15403 const u8 *addr; 15404 u8 oper_class; 15405 int err; 15406 15407 if (!rdev->ops->tdls_channel_switch || 15408 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15409 return -EOPNOTSUPP; 15410 15411 switch (dev->ieee80211_ptr->iftype) { 15412 case NL80211_IFTYPE_STATION: 15413 case NL80211_IFTYPE_P2P_CLIENT: 15414 break; 15415 default: 15416 return -EOPNOTSUPP; 15417 } 15418 15419 if (!info->attrs[NL80211_ATTR_MAC] || 15420 !info->attrs[NL80211_ATTR_OPER_CLASS]) 15421 return -EINVAL; 15422 15423 err = nl80211_parse_chandef(rdev, info, &chandef); 15424 if (err) 15425 return err; 15426 15427 /* 15428 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012 15429 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the 15430 * specification is not defined for them. 15431 */ 15432 if (chandef.chan->band == NL80211_BAND_2GHZ && 15433 chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 15434 chandef.width != NL80211_CHAN_WIDTH_20) 15435 return -EINVAL; 15436 15437 /* we will be active on the TDLS link */ 15438 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 15439 wdev->iftype)) 15440 return -EINVAL; 15441 15442 /* don't allow switching to DFS channels */ 15443 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype)) 15444 return -EINVAL; 15445 15446 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15447 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]); 15448 15449 return rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef); 15450 } 15451 15452 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb, 15453 struct genl_info *info) 15454 { 15455 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15456 struct net_device *dev = info->user_ptr[1]; 15457 const u8 *addr; 15458 15459 if (!rdev->ops->tdls_channel_switch || 15460 !rdev->ops->tdls_cancel_channel_switch || 15461 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15462 return -EOPNOTSUPP; 15463 15464 switch (dev->ieee80211_ptr->iftype) { 15465 case NL80211_IFTYPE_STATION: 15466 case NL80211_IFTYPE_P2P_CLIENT: 15467 break; 15468 default: 15469 return -EOPNOTSUPP; 15470 } 15471 15472 if (!info->attrs[NL80211_ATTR_MAC]) 15473 return -EINVAL; 15474 15475 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15476 15477 rdev_tdls_cancel_channel_switch(rdev, dev, addr); 15478 15479 return 0; 15480 } 15481 15482 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb, 15483 struct genl_info *info) 15484 { 15485 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15486 struct net_device *dev = info->user_ptr[1]; 15487 struct wireless_dev *wdev = dev->ieee80211_ptr; 15488 const struct nlattr *nla; 15489 bool enabled; 15490 15491 if (!rdev->ops->set_multicast_to_unicast) 15492 return -EOPNOTSUPP; 15493 15494 if (wdev->iftype != NL80211_IFTYPE_AP && 15495 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15496 return -EOPNOTSUPP; 15497 15498 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED]; 15499 enabled = nla_get_flag(nla); 15500 15501 return rdev_set_multicast_to_unicast(rdev, dev, enabled); 15502 } 15503 15504 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info) 15505 { 15506 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15507 struct net_device *dev = info->user_ptr[1]; 15508 struct wireless_dev *wdev = dev->ieee80211_ptr; 15509 struct cfg80211_pmk_conf pmk_conf = {}; 15510 15511 if (wdev->iftype != NL80211_IFTYPE_STATION && 15512 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15513 return -EOPNOTSUPP; 15514 15515 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15516 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15517 return -EOPNOTSUPP; 15518 15519 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK]) 15520 return -EINVAL; 15521 15522 if (!wdev->connected) 15523 return -ENOTCONN; 15524 15525 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15526 if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN)) 15527 return -EINVAL; 15528 15529 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 15530 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 15531 if (pmk_conf.pmk_len != WLAN_PMK_LEN && 15532 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) 15533 return -EINVAL; 15534 15535 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) 15536 pmk_conf.pmk_r0_name = 15537 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]); 15538 15539 return rdev_set_pmk(rdev, dev, &pmk_conf); 15540 } 15541 15542 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info) 15543 { 15544 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15545 struct net_device *dev = info->user_ptr[1]; 15546 struct wireless_dev *wdev = dev->ieee80211_ptr; 15547 const u8 *aa; 15548 15549 if (wdev->iftype != NL80211_IFTYPE_STATION && 15550 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15551 return -EOPNOTSUPP; 15552 15553 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15554 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15555 return -EOPNOTSUPP; 15556 15557 if (!info->attrs[NL80211_ATTR_MAC]) 15558 return -EINVAL; 15559 15560 aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15561 return rdev_del_pmk(rdev, dev, aa); 15562 } 15563 15564 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info) 15565 { 15566 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15567 struct net_device *dev = info->user_ptr[1]; 15568 struct cfg80211_external_auth_params params; 15569 15570 if (!rdev->ops->external_auth) 15571 return -EOPNOTSUPP; 15572 15573 if (!info->attrs[NL80211_ATTR_SSID] && 15574 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 15575 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 15576 return -EINVAL; 15577 15578 if (!info->attrs[NL80211_ATTR_BSSID]) 15579 return -EINVAL; 15580 15581 if (!info->attrs[NL80211_ATTR_STATUS_CODE]) 15582 return -EINVAL; 15583 15584 memset(¶ms, 0, sizeof(params)); 15585 15586 if (info->attrs[NL80211_ATTR_SSID]) { 15587 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 15588 if (params.ssid.ssid_len == 0) 15589 return -EINVAL; 15590 memcpy(params.ssid.ssid, 15591 nla_data(info->attrs[NL80211_ATTR_SSID]), 15592 params.ssid.ssid_len); 15593 } 15594 15595 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]), 15596 ETH_ALEN); 15597 15598 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15599 15600 if (info->attrs[NL80211_ATTR_PMKID]) 15601 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 15602 15603 return rdev_external_auth(rdev, dev, ¶ms); 15604 } 15605 15606 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info) 15607 { 15608 bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK]; 15609 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15610 struct net_device *dev = info->user_ptr[1]; 15611 struct wireless_dev *wdev = dev->ieee80211_ptr; 15612 const u8 *buf; 15613 size_t len; 15614 u8 *dest; 15615 u16 proto; 15616 bool noencrypt; 15617 u64 cookie = 0; 15618 int link_id; 15619 int err; 15620 15621 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15622 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 15623 return -EOPNOTSUPP; 15624 15625 if (!rdev->ops->tx_control_port) 15626 return -EOPNOTSUPP; 15627 15628 if (!info->attrs[NL80211_ATTR_FRAME] || 15629 !info->attrs[NL80211_ATTR_MAC] || 15630 !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 15631 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing"); 15632 return -EINVAL; 15633 } 15634 15635 switch (wdev->iftype) { 15636 case NL80211_IFTYPE_AP: 15637 case NL80211_IFTYPE_P2P_GO: 15638 case NL80211_IFTYPE_MESH_POINT: 15639 break; 15640 case NL80211_IFTYPE_ADHOC: 15641 if (wdev->u.ibss.current_bss) 15642 break; 15643 return -ENOTCONN; 15644 case NL80211_IFTYPE_STATION: 15645 case NL80211_IFTYPE_P2P_CLIENT: 15646 if (wdev->connected) 15647 break; 15648 return -ENOTCONN; 15649 default: 15650 return -EOPNOTSUPP; 15651 } 15652 15653 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15654 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15655 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15656 proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 15657 noencrypt = 15658 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]); 15659 15660 link_id = nl80211_link_id_or_invalid(info->attrs); 15661 15662 err = rdev_tx_control_port(rdev, dev, buf, len, 15663 dest, cpu_to_be16(proto), noencrypt, link_id, 15664 dont_wait_for_ack ? NULL : &cookie); 15665 if (!err && !dont_wait_for_ack) 15666 nl_set_extack_cookie_u64(info->extack, cookie); 15667 return err; 15668 } 15669 15670 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb, 15671 struct genl_info *info) 15672 { 15673 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15674 struct net_device *dev = info->user_ptr[1]; 15675 struct wireless_dev *wdev = dev->ieee80211_ptr; 15676 struct cfg80211_ftm_responder_stats ftm_stats = {}; 15677 unsigned int link_id = nl80211_link_id(info->attrs); 15678 struct sk_buff *msg; 15679 void *hdr; 15680 struct nlattr *ftm_stats_attr; 15681 int err; 15682 15683 if (wdev->iftype != NL80211_IFTYPE_AP || 15684 !wdev->links[link_id].ap.beacon_interval) 15685 return -EOPNOTSUPP; 15686 15687 err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats); 15688 if (err) 15689 return err; 15690 15691 if (!ftm_stats.filled) 15692 return -ENODATA; 15693 15694 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15695 if (!msg) 15696 return -ENOMEM; 15697 15698 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15699 NL80211_CMD_GET_FTM_RESPONDER_STATS); 15700 if (!hdr) 15701 goto nla_put_failure; 15702 15703 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 15704 goto nla_put_failure; 15705 15706 ftm_stats_attr = nla_nest_start_noflag(msg, 15707 NL80211_ATTR_FTM_RESPONDER_STATS); 15708 if (!ftm_stats_attr) 15709 goto nla_put_failure; 15710 15711 #define SET_FTM(field, name, type) \ 15712 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15713 nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \ 15714 ftm_stats.field)) \ 15715 goto nla_put_failure; } while (0) 15716 #define SET_FTM_U64(field, name) \ 15717 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15718 nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \ 15719 ftm_stats.field, NL80211_FTM_STATS_PAD)) \ 15720 goto nla_put_failure; } while (0) 15721 15722 SET_FTM(success_num, SUCCESS_NUM, u32); 15723 SET_FTM(partial_num, PARTIAL_NUM, u32); 15724 SET_FTM(failed_num, FAILED_NUM, u32); 15725 SET_FTM(asap_num, ASAP_NUM, u32); 15726 SET_FTM(non_asap_num, NON_ASAP_NUM, u32); 15727 SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC); 15728 SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32); 15729 SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32); 15730 SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32); 15731 #undef SET_FTM 15732 15733 nla_nest_end(msg, ftm_stats_attr); 15734 15735 genlmsg_end(msg, hdr); 15736 return genlmsg_reply(msg, info); 15737 15738 nla_put_failure: 15739 nlmsg_free(msg); 15740 return -ENOBUFS; 15741 } 15742 15743 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info) 15744 { 15745 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15746 struct cfg80211_update_owe_info owe_info; 15747 struct net_device *dev = info->user_ptr[1]; 15748 15749 if (!rdev->ops->update_owe_info) 15750 return -EOPNOTSUPP; 15751 15752 if (!info->attrs[NL80211_ATTR_STATUS_CODE] || 15753 !info->attrs[NL80211_ATTR_MAC]) 15754 return -EINVAL; 15755 15756 memset(&owe_info, 0, sizeof(owe_info)); 15757 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15758 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN); 15759 15760 if (info->attrs[NL80211_ATTR_IE]) { 15761 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 15762 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 15763 } 15764 15765 return rdev_update_owe_info(rdev, dev, &owe_info); 15766 } 15767 15768 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info) 15769 { 15770 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15771 struct net_device *dev = info->user_ptr[1]; 15772 struct wireless_dev *wdev = dev->ieee80211_ptr; 15773 struct station_info sinfo = {}; 15774 const u8 *buf; 15775 size_t len; 15776 u8 *dest; 15777 int err; 15778 15779 if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station) 15780 return -EOPNOTSUPP; 15781 15782 if (!info->attrs[NL80211_ATTR_MAC] || 15783 !info->attrs[NL80211_ATTR_FRAME]) { 15784 GENL_SET_ERR_MSG(info, "Frame or MAC missing"); 15785 return -EINVAL; 15786 } 15787 15788 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 15789 return -EOPNOTSUPP; 15790 15791 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15792 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15793 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15794 15795 if (len < sizeof(struct ethhdr)) 15796 return -EINVAL; 15797 15798 if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) || 15799 !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr)) 15800 return -EINVAL; 15801 15802 err = rdev_get_station(rdev, dev, dest, &sinfo); 15803 if (err) 15804 return err; 15805 15806 cfg80211_sinfo_release_content(&sinfo); 15807 15808 return rdev_probe_mesh_link(rdev, dev, dest, buf, len); 15809 } 15810 15811 static int parse_tid_conf(struct cfg80211_registered_device *rdev, 15812 struct nlattr *attrs[], struct net_device *dev, 15813 struct cfg80211_tid_cfg *tid_conf, 15814 struct genl_info *info, const u8 *peer, 15815 unsigned int link_id) 15816 { 15817 struct netlink_ext_ack *extack = info->extack; 15818 u64 mask; 15819 int err; 15820 15821 if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS]) 15822 return -EINVAL; 15823 15824 tid_conf->config_override = 15825 nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]); 15826 tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]); 15827 15828 if (tid_conf->config_override) { 15829 if (rdev->ops->reset_tid_config) { 15830 err = rdev_reset_tid_config(rdev, dev, peer, 15831 tid_conf->tids); 15832 if (err) 15833 return err; 15834 } else { 15835 return -EINVAL; 15836 } 15837 } 15838 15839 if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) { 15840 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK); 15841 tid_conf->noack = 15842 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]); 15843 } 15844 15845 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) { 15846 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT); 15847 tid_conf->retry_short = 15848 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]); 15849 15850 if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count) 15851 return -EINVAL; 15852 } 15853 15854 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) { 15855 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG); 15856 tid_conf->retry_long = 15857 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]); 15858 15859 if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count) 15860 return -EINVAL; 15861 } 15862 15863 if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) { 15864 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL); 15865 tid_conf->ampdu = 15866 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]); 15867 } 15868 15869 if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) { 15870 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL); 15871 tid_conf->rtscts = 15872 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]); 15873 } 15874 15875 if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) { 15876 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL); 15877 tid_conf->amsdu = 15878 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]); 15879 } 15880 15881 if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) { 15882 u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr; 15883 15884 tid_conf->txrate_type = nla_get_u8(attrs[idx]); 15885 15886 if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) { 15887 attr = NL80211_TID_CONFIG_ATTR_TX_RATE; 15888 err = nl80211_parse_tx_bitrate_mask(info, attrs, attr, 15889 &tid_conf->txrate_mask, dev, 15890 true, link_id); 15891 if (err) 15892 return err; 15893 15894 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE); 15895 } 15896 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE); 15897 } 15898 15899 if (peer) 15900 mask = rdev->wiphy.tid_config_support.peer; 15901 else 15902 mask = rdev->wiphy.tid_config_support.vif; 15903 15904 if (tid_conf->mask & ~mask) { 15905 NL_SET_ERR_MSG(extack, "unsupported TID configuration"); 15906 return -EOPNOTSUPP; 15907 } 15908 15909 return 0; 15910 } 15911 15912 static int nl80211_set_tid_config(struct sk_buff *skb, 15913 struct genl_info *info) 15914 { 15915 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15916 struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1]; 15917 unsigned int link_id = nl80211_link_id(info->attrs); 15918 struct net_device *dev = info->user_ptr[1]; 15919 struct cfg80211_tid_config *tid_config; 15920 struct nlattr *tid; 15921 int conf_idx = 0, rem_conf; 15922 int ret = -EINVAL; 15923 u32 num_conf = 0; 15924 15925 if (!info->attrs[NL80211_ATTR_TID_CONFIG]) 15926 return -EINVAL; 15927 15928 if (!rdev->ops->set_tid_config) 15929 return -EOPNOTSUPP; 15930 15931 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 15932 rem_conf) 15933 num_conf++; 15934 15935 tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf), 15936 GFP_KERNEL); 15937 if (!tid_config) 15938 return -ENOMEM; 15939 15940 tid_config->n_tid_conf = num_conf; 15941 15942 if (info->attrs[NL80211_ATTR_MAC]) 15943 tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15944 15945 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 15946 rem_conf) { 15947 ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX, 15948 tid, NULL, NULL); 15949 15950 if (ret) 15951 goto bad_tid_conf; 15952 15953 ret = parse_tid_conf(rdev, attrs, dev, 15954 &tid_config->tid_conf[conf_idx], 15955 info, tid_config->peer, link_id); 15956 if (ret) 15957 goto bad_tid_conf; 15958 15959 conf_idx++; 15960 } 15961 15962 ret = rdev_set_tid_config(rdev, dev, tid_config); 15963 15964 bad_tid_conf: 15965 kfree(tid_config); 15966 return ret; 15967 } 15968 15969 static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info) 15970 { 15971 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15972 struct cfg80211_color_change_settings params = {}; 15973 struct net_device *dev = info->user_ptr[1]; 15974 struct wireless_dev *wdev = dev->ieee80211_ptr; 15975 struct nlattr **tb; 15976 u16 offset; 15977 int err; 15978 15979 if (!rdev->ops->color_change) 15980 return -EOPNOTSUPP; 15981 15982 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15983 NL80211_EXT_FEATURE_BSS_COLOR)) 15984 return -EOPNOTSUPP; 15985 15986 if (wdev->iftype != NL80211_IFTYPE_AP) 15987 return -EOPNOTSUPP; 15988 15989 if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] || 15990 !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] || 15991 !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS]) 15992 return -EINVAL; 15993 15994 params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]); 15995 params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]); 15996 15997 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_next, 15998 info->extack); 15999 if (err) 16000 return err; 16001 16002 tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL); 16003 if (!tb) 16004 return -ENOMEM; 16005 16006 err = nla_parse_nested(tb, NL80211_ATTR_MAX, 16007 info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS], 16008 nl80211_policy, info->extack); 16009 if (err) 16010 goto out; 16011 16012 err = nl80211_parse_beacon(rdev, tb, ¶ms.beacon_color_change, 16013 info->extack); 16014 if (err) 16015 goto out; 16016 16017 if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 16018 err = -EINVAL; 16019 goto out; 16020 } 16021 16022 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) { 16023 err = -EINVAL; 16024 goto out; 16025 } 16026 16027 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 16028 if (offset >= params.beacon_color_change.tail_len) { 16029 err = -EINVAL; 16030 goto out; 16031 } 16032 16033 if (params.beacon_color_change.tail[offset] != params.count) { 16034 err = -EINVAL; 16035 goto out; 16036 } 16037 16038 params.counter_offset_beacon = offset; 16039 16040 if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 16041 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) != 16042 sizeof(u16)) { 16043 err = -EINVAL; 16044 goto out; 16045 } 16046 16047 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 16048 if (offset >= params.beacon_color_change.probe_resp_len) { 16049 err = -EINVAL; 16050 goto out; 16051 } 16052 16053 if (params.beacon_color_change.probe_resp[offset] != 16054 params.count) { 16055 err = -EINVAL; 16056 goto out; 16057 } 16058 16059 params.counter_offset_presp = offset; 16060 } 16061 16062 params.link_id = nl80211_link_id(info->attrs); 16063 err = rdev_color_change(rdev, dev, ¶ms); 16064 16065 out: 16066 kfree(params.beacon_next.mbssid_ies); 16067 kfree(params.beacon_color_change.mbssid_ies); 16068 kfree(params.beacon_next.rnr_ies); 16069 kfree(params.beacon_color_change.rnr_ies); 16070 kfree(tb); 16071 return err; 16072 } 16073 16074 static int nl80211_set_fils_aad(struct sk_buff *skb, 16075 struct genl_info *info) 16076 { 16077 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16078 struct net_device *dev = info->user_ptr[1]; 16079 struct cfg80211_fils_aad fils_aad = {}; 16080 u8 *nonces; 16081 16082 if (!info->attrs[NL80211_ATTR_MAC] || 16083 !info->attrs[NL80211_ATTR_FILS_KEK] || 16084 !info->attrs[NL80211_ATTR_FILS_NONCES]) 16085 return -EINVAL; 16086 16087 fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16088 fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 16089 fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 16090 nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 16091 fils_aad.snonce = nonces; 16092 fils_aad.anonce = nonces + FILS_NONCE_LEN; 16093 16094 return rdev_set_fils_aad(rdev, dev, &fils_aad); 16095 } 16096 16097 static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info) 16098 { 16099 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16100 unsigned int link_id = nl80211_link_id(info->attrs); 16101 struct net_device *dev = info->user_ptr[1]; 16102 struct wireless_dev *wdev = dev->ieee80211_ptr; 16103 int ret; 16104 16105 if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO)) 16106 return -EINVAL; 16107 16108 switch (wdev->iftype) { 16109 case NL80211_IFTYPE_AP: 16110 break; 16111 default: 16112 return -EINVAL; 16113 } 16114 16115 if (!info->attrs[NL80211_ATTR_MAC] || 16116 !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC]))) 16117 return -EINVAL; 16118 16119 wdev->valid_links |= BIT(link_id); 16120 ether_addr_copy(wdev->links[link_id].addr, 16121 nla_data(info->attrs[NL80211_ATTR_MAC])); 16122 16123 ret = rdev_add_intf_link(rdev, wdev, link_id); 16124 if (ret) { 16125 wdev->valid_links &= ~BIT(link_id); 16126 eth_zero_addr(wdev->links[link_id].addr); 16127 } 16128 16129 return ret; 16130 } 16131 16132 static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info) 16133 { 16134 unsigned int link_id = nl80211_link_id(info->attrs); 16135 struct net_device *dev = info->user_ptr[1]; 16136 struct wireless_dev *wdev = dev->ieee80211_ptr; 16137 16138 /* cannot remove if there's no link */ 16139 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16140 return -EINVAL; 16141 16142 switch (wdev->iftype) { 16143 case NL80211_IFTYPE_AP: 16144 break; 16145 default: 16146 return -EINVAL; 16147 } 16148 16149 cfg80211_remove_link(wdev, link_id); 16150 16151 return 0; 16152 } 16153 16154 static int 16155 nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info, 16156 bool add) 16157 { 16158 struct link_station_parameters params = {}; 16159 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16160 struct net_device *dev = info->user_ptr[1]; 16161 int err; 16162 16163 if ((add && !rdev->ops->add_link_station) || 16164 (!add && !rdev->ops->mod_link_station)) 16165 return -EOPNOTSUPP; 16166 16167 if (add && !info->attrs[NL80211_ATTR_MAC]) 16168 return -EINVAL; 16169 16170 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 16171 return -EINVAL; 16172 16173 if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 16174 return -EINVAL; 16175 16176 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16177 16178 if (info->attrs[NL80211_ATTR_MAC]) { 16179 params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 16180 if (!is_valid_ether_addr(params.link_mac)) 16181 return -EINVAL; 16182 } 16183 16184 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16185 return -EINVAL; 16186 16187 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16188 16189 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 16190 params.supported_rates = 16191 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16192 params.supported_rates_len = 16193 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16194 } 16195 16196 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 16197 params.ht_capa = 16198 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 16199 16200 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 16201 params.vht_capa = 16202 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 16203 16204 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 16205 params.he_capa = 16206 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16207 params.he_capa_len = 16208 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16209 16210 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 16211 params.eht_capa = 16212 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16213 params.eht_capa_len = 16214 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16215 16216 if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa, 16217 (const u8 *)params.eht_capa, 16218 params.eht_capa_len, 16219 false)) 16220 return -EINVAL; 16221 } 16222 } 16223 16224 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 16225 params.he_6ghz_capa = 16226 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 16227 16228 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 16229 params.opmode_notif_used = true; 16230 params.opmode_notif = 16231 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 16232 } 16233 16234 err = nl80211_parse_sta_txpower_setting(info, ¶ms.txpwr, 16235 ¶ms.txpwr_set); 16236 if (err) 16237 return err; 16238 16239 if (add) 16240 return rdev_add_link_station(rdev, dev, ¶ms); 16241 16242 return rdev_mod_link_station(rdev, dev, ¶ms); 16243 } 16244 16245 static int 16246 nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info) 16247 { 16248 return nl80211_add_mod_link_station(skb, info, true); 16249 } 16250 16251 static int 16252 nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info) 16253 { 16254 return nl80211_add_mod_link_station(skb, info, false); 16255 } 16256 16257 static int 16258 nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info) 16259 { 16260 struct link_station_del_parameters params = {}; 16261 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16262 struct net_device *dev = info->user_ptr[1]; 16263 16264 if (!rdev->ops->del_link_station) 16265 return -EOPNOTSUPP; 16266 16267 if (!info->attrs[NL80211_ATTR_MLD_ADDR] || 16268 !info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16269 return -EINVAL; 16270 16271 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16272 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16273 16274 return rdev_del_link_station(rdev, dev, ¶ms); 16275 } 16276 16277 static int nl80211_set_hw_timestamp(struct sk_buff *skb, 16278 struct genl_info *info) 16279 { 16280 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16281 struct net_device *dev = info->user_ptr[1]; 16282 struct cfg80211_set_hw_timestamp hwts = {}; 16283 16284 if (!rdev->wiphy.hw_timestamp_max_peers) 16285 return -EOPNOTSUPP; 16286 16287 if (!info->attrs[NL80211_ATTR_MAC] && 16288 rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS) 16289 return -EOPNOTSUPP; 16290 16291 if (info->attrs[NL80211_ATTR_MAC]) 16292 hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16293 16294 hwts.enable = 16295 nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]); 16296 16297 return rdev_set_hw_timestamp(rdev, dev, &hwts); 16298 } 16299 16300 static int 16301 nl80211_set_ttlm(struct sk_buff *skb, struct genl_info *info) 16302 { 16303 struct cfg80211_ttlm_params params = {}; 16304 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16305 struct net_device *dev = info->user_ptr[1]; 16306 struct wireless_dev *wdev = dev->ieee80211_ptr; 16307 16308 if (wdev->iftype != NL80211_IFTYPE_STATION && 16309 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16310 return -EOPNOTSUPP; 16311 16312 if (!wdev->connected) 16313 return -ENOLINK; 16314 16315 if (!info->attrs[NL80211_ATTR_MLO_TTLM_DLINK] || 16316 !info->attrs[NL80211_ATTR_MLO_TTLM_ULINK]) 16317 return -EINVAL; 16318 16319 nla_memcpy(params.dlink, 16320 info->attrs[NL80211_ATTR_MLO_TTLM_DLINK], 16321 sizeof(params.dlink)); 16322 nla_memcpy(params.ulink, 16323 info->attrs[NL80211_ATTR_MLO_TTLM_ULINK], 16324 sizeof(params.ulink)); 16325 16326 return rdev_set_ttlm(rdev, dev, ¶ms); 16327 } 16328 16329 #define NL80211_FLAG_NEED_WIPHY 0x01 16330 #define NL80211_FLAG_NEED_NETDEV 0x02 16331 #define NL80211_FLAG_NEED_RTNL 0x04 16332 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08 16333 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\ 16334 NL80211_FLAG_CHECK_NETDEV_UP) 16335 #define NL80211_FLAG_NEED_WDEV 0x10 16336 /* If a netdev is associated, it must be UP, P2P must be started */ 16337 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\ 16338 NL80211_FLAG_CHECK_NETDEV_UP) 16339 #define NL80211_FLAG_CLEAR_SKB 0x20 16340 #define NL80211_FLAG_NO_WIPHY_MTX 0x40 16341 #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80 16342 #define NL80211_FLAG_MLO_UNSUPPORTED 0x100 16343 16344 #define INTERNAL_FLAG_SELECTORS(__sel) \ 16345 SELECTOR(__sel, NONE, 0) /* must be first */ \ 16346 SELECTOR(__sel, WIPHY, \ 16347 NL80211_FLAG_NEED_WIPHY) \ 16348 SELECTOR(__sel, WDEV, \ 16349 NL80211_FLAG_NEED_WDEV) \ 16350 SELECTOR(__sel, NETDEV, \ 16351 NL80211_FLAG_NEED_NETDEV) \ 16352 SELECTOR(__sel, NETDEV_LINK, \ 16353 NL80211_FLAG_NEED_NETDEV | \ 16354 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16355 SELECTOR(__sel, NETDEV_NO_MLO, \ 16356 NL80211_FLAG_NEED_NETDEV | \ 16357 NL80211_FLAG_MLO_UNSUPPORTED) \ 16358 SELECTOR(__sel, WIPHY_RTNL, \ 16359 NL80211_FLAG_NEED_WIPHY | \ 16360 NL80211_FLAG_NEED_RTNL) \ 16361 SELECTOR(__sel, WIPHY_RTNL_NOMTX, \ 16362 NL80211_FLAG_NEED_WIPHY | \ 16363 NL80211_FLAG_NEED_RTNL | \ 16364 NL80211_FLAG_NO_WIPHY_MTX) \ 16365 SELECTOR(__sel, WDEV_RTNL, \ 16366 NL80211_FLAG_NEED_WDEV | \ 16367 NL80211_FLAG_NEED_RTNL) \ 16368 SELECTOR(__sel, NETDEV_RTNL, \ 16369 NL80211_FLAG_NEED_NETDEV | \ 16370 NL80211_FLAG_NEED_RTNL) \ 16371 SELECTOR(__sel, NETDEV_UP, \ 16372 NL80211_FLAG_NEED_NETDEV_UP) \ 16373 SELECTOR(__sel, NETDEV_UP_LINK, \ 16374 NL80211_FLAG_NEED_NETDEV_UP | \ 16375 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16376 SELECTOR(__sel, NETDEV_UP_NO_MLO, \ 16377 NL80211_FLAG_NEED_NETDEV_UP | \ 16378 NL80211_FLAG_MLO_UNSUPPORTED) \ 16379 SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \ 16380 NL80211_FLAG_NEED_NETDEV_UP | \ 16381 NL80211_FLAG_CLEAR_SKB | \ 16382 NL80211_FLAG_MLO_UNSUPPORTED) \ 16383 SELECTOR(__sel, NETDEV_UP_NOTMX, \ 16384 NL80211_FLAG_NEED_NETDEV_UP | \ 16385 NL80211_FLAG_NO_WIPHY_MTX) \ 16386 SELECTOR(__sel, NETDEV_UP_NOTMX_NOMLO, \ 16387 NL80211_FLAG_NEED_NETDEV_UP | \ 16388 NL80211_FLAG_NO_WIPHY_MTX | \ 16389 NL80211_FLAG_MLO_UNSUPPORTED) \ 16390 SELECTOR(__sel, NETDEV_UP_CLEAR, \ 16391 NL80211_FLAG_NEED_NETDEV_UP | \ 16392 NL80211_FLAG_CLEAR_SKB) \ 16393 SELECTOR(__sel, WDEV_UP, \ 16394 NL80211_FLAG_NEED_WDEV_UP) \ 16395 SELECTOR(__sel, WDEV_UP_LINK, \ 16396 NL80211_FLAG_NEED_WDEV_UP | \ 16397 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16398 SELECTOR(__sel, WDEV_UP_RTNL, \ 16399 NL80211_FLAG_NEED_WDEV_UP | \ 16400 NL80211_FLAG_NEED_RTNL) \ 16401 SELECTOR(__sel, WIPHY_CLEAR, \ 16402 NL80211_FLAG_NEED_WIPHY | \ 16403 NL80211_FLAG_CLEAR_SKB) 16404 16405 enum nl80211_internal_flags_selector { 16406 #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name, 16407 INTERNAL_FLAG_SELECTORS(_) 16408 #undef SELECTOR 16409 }; 16410 16411 static u32 nl80211_internal_flags[] = { 16412 #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value, 16413 INTERNAL_FLAG_SELECTORS(_) 16414 #undef SELECTOR 16415 }; 16416 16417 static int nl80211_pre_doit(const struct genl_split_ops *ops, 16418 struct sk_buff *skb, 16419 struct genl_info *info) 16420 { 16421 struct cfg80211_registered_device *rdev = NULL; 16422 struct wireless_dev *wdev = NULL; 16423 struct net_device *dev = NULL; 16424 u32 internal_flags; 16425 int err; 16426 16427 if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags))) 16428 return -EINVAL; 16429 16430 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16431 16432 rtnl_lock(); 16433 if (internal_flags & NL80211_FLAG_NEED_WIPHY) { 16434 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 16435 if (IS_ERR(rdev)) { 16436 err = PTR_ERR(rdev); 16437 goto out_unlock; 16438 } 16439 info->user_ptr[0] = rdev; 16440 } else if (internal_flags & NL80211_FLAG_NEED_NETDEV || 16441 internal_flags & NL80211_FLAG_NEED_WDEV) { 16442 wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info), 16443 info->attrs); 16444 if (IS_ERR(wdev)) { 16445 err = PTR_ERR(wdev); 16446 goto out_unlock; 16447 } 16448 16449 dev = wdev->netdev; 16450 dev_hold(dev); 16451 rdev = wiphy_to_rdev(wdev->wiphy); 16452 16453 if (internal_flags & NL80211_FLAG_NEED_NETDEV) { 16454 if (!dev) { 16455 err = -EINVAL; 16456 goto out_unlock; 16457 } 16458 16459 info->user_ptr[1] = dev; 16460 } else { 16461 info->user_ptr[1] = wdev; 16462 } 16463 16464 if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP && 16465 !wdev_running(wdev)) { 16466 err = -ENETDOWN; 16467 goto out_unlock; 16468 } 16469 16470 info->user_ptr[0] = rdev; 16471 } 16472 16473 if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) { 16474 struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID]; 16475 16476 if (!wdev) { 16477 err = -EINVAL; 16478 goto out_unlock; 16479 } 16480 16481 /* MLO -> require valid link ID */ 16482 if (wdev->valid_links && 16483 (!link_id || 16484 !(wdev->valid_links & BIT(nla_get_u8(link_id))))) { 16485 err = -EINVAL; 16486 goto out_unlock; 16487 } 16488 16489 /* non-MLO -> no link ID attribute accepted */ 16490 if (!wdev->valid_links && link_id) { 16491 err = -EINVAL; 16492 goto out_unlock; 16493 } 16494 } 16495 16496 if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) { 16497 if (info->attrs[NL80211_ATTR_MLO_LINK_ID] || 16498 (wdev && wdev->valid_links)) { 16499 err = -EINVAL; 16500 goto out_unlock; 16501 } 16502 } 16503 16504 if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16505 wiphy_lock(&rdev->wiphy); 16506 /* we keep the mutex locked until post_doit */ 16507 __release(&rdev->wiphy.mtx); 16508 } 16509 if (!(internal_flags & NL80211_FLAG_NEED_RTNL)) 16510 rtnl_unlock(); 16511 16512 return 0; 16513 out_unlock: 16514 rtnl_unlock(); 16515 dev_put(dev); 16516 return err; 16517 } 16518 16519 static void nl80211_post_doit(const struct genl_split_ops *ops, 16520 struct sk_buff *skb, 16521 struct genl_info *info) 16522 { 16523 u32 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16524 16525 if (info->user_ptr[1]) { 16526 if (internal_flags & NL80211_FLAG_NEED_WDEV) { 16527 struct wireless_dev *wdev = info->user_ptr[1]; 16528 16529 dev_put(wdev->netdev); 16530 } else { 16531 dev_put(info->user_ptr[1]); 16532 } 16533 } 16534 16535 if (info->user_ptr[0] && 16536 !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16537 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16538 16539 /* we kept the mutex locked since pre_doit */ 16540 __acquire(&rdev->wiphy.mtx); 16541 wiphy_unlock(&rdev->wiphy); 16542 } 16543 16544 if (internal_flags & NL80211_FLAG_NEED_RTNL) 16545 rtnl_unlock(); 16546 16547 /* If needed, clear the netlink message payload from the SKB 16548 * as it might contain key data that shouldn't stick around on 16549 * the heap after the SKB is freed. The netlink message header 16550 * is still needed for further processing, so leave it intact. 16551 */ 16552 if (internal_flags & NL80211_FLAG_CLEAR_SKB) { 16553 struct nlmsghdr *nlh = nlmsg_hdr(skb); 16554 16555 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh)); 16556 } 16557 } 16558 16559 static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev, 16560 struct cfg80211_sar_specs *sar_specs, 16561 struct nlattr *spec[], int index) 16562 { 16563 u32 range_index, i; 16564 16565 if (!sar_specs || !spec) 16566 return -EINVAL; 16567 16568 if (!spec[NL80211_SAR_ATTR_SPECS_POWER] || 16569 !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]) 16570 return -EINVAL; 16571 16572 range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]); 16573 16574 /* check if range_index exceeds num_freq_ranges */ 16575 if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges) 16576 return -EINVAL; 16577 16578 /* check if range_index duplicates */ 16579 for (i = 0; i < index; i++) { 16580 if (sar_specs->sub_specs[i].freq_range_index == range_index) 16581 return -EINVAL; 16582 } 16583 16584 sar_specs->sub_specs[index].power = 16585 nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]); 16586 16587 sar_specs->sub_specs[index].freq_range_index = range_index; 16588 16589 return 0; 16590 } 16591 16592 static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info) 16593 { 16594 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16595 struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1]; 16596 struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1]; 16597 struct cfg80211_sar_specs *sar_spec; 16598 enum nl80211_sar_type type; 16599 struct nlattr *spec_list; 16600 u32 specs; 16601 int rem, err; 16602 16603 if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs) 16604 return -EOPNOTSUPP; 16605 16606 if (!info->attrs[NL80211_ATTR_SAR_SPEC]) 16607 return -EINVAL; 16608 16609 nla_parse_nested(tb, NL80211_SAR_ATTR_MAX, 16610 info->attrs[NL80211_ATTR_SAR_SPEC], 16611 NULL, NULL); 16612 16613 if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS]) 16614 return -EINVAL; 16615 16616 type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]); 16617 if (type != rdev->wiphy.sar_capa->type) 16618 return -EINVAL; 16619 16620 specs = 0; 16621 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) 16622 specs++; 16623 16624 if (specs > rdev->wiphy.sar_capa->num_freq_ranges) 16625 return -EINVAL; 16626 16627 sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL); 16628 if (!sar_spec) 16629 return -ENOMEM; 16630 16631 sar_spec->type = type; 16632 specs = 0; 16633 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) { 16634 nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX, 16635 spec_list, NULL, NULL); 16636 16637 switch (type) { 16638 case NL80211_SAR_TYPE_POWER: 16639 if (nl80211_set_sar_sub_specs(rdev, sar_spec, 16640 spec, specs)) { 16641 err = -EINVAL; 16642 goto error; 16643 } 16644 break; 16645 default: 16646 err = -EINVAL; 16647 goto error; 16648 } 16649 specs++; 16650 } 16651 16652 sar_spec->num_sub_specs = specs; 16653 16654 rdev->cur_cmd_info = info; 16655 err = rdev_set_sar_specs(rdev, sar_spec); 16656 rdev->cur_cmd_info = NULL; 16657 error: 16658 kfree(sar_spec); 16659 return err; 16660 } 16661 16662 #define SELECTOR(__sel, name, value) \ 16663 ((__sel) == (value)) ? NL80211_IFL_SEL_##name : 16664 int __missing_selector(void); 16665 #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector() 16666 16667 static const struct genl_ops nl80211_ops[] = { 16668 { 16669 .cmd = NL80211_CMD_GET_WIPHY, 16670 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16671 .doit = nl80211_get_wiphy, 16672 .dumpit = nl80211_dump_wiphy, 16673 .done = nl80211_dump_wiphy_done, 16674 /* can be retrieved by unprivileged users */ 16675 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 16676 }, 16677 }; 16678 16679 static const struct genl_small_ops nl80211_small_ops[] = { 16680 { 16681 .cmd = NL80211_CMD_SET_WIPHY, 16682 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16683 .doit = nl80211_set_wiphy, 16684 .flags = GENL_UNS_ADMIN_PERM, 16685 }, 16686 { 16687 .cmd = NL80211_CMD_GET_INTERFACE, 16688 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16689 .doit = nl80211_get_interface, 16690 .dumpit = nl80211_dump_interface, 16691 /* can be retrieved by unprivileged users */ 16692 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 16693 }, 16694 { 16695 .cmd = NL80211_CMD_SET_INTERFACE, 16696 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16697 .doit = nl80211_set_interface, 16698 .flags = GENL_UNS_ADMIN_PERM, 16699 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 16700 NL80211_FLAG_NEED_RTNL), 16701 }, 16702 { 16703 .cmd = NL80211_CMD_NEW_INTERFACE, 16704 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16705 .doit = nl80211_new_interface, 16706 .flags = GENL_UNS_ADMIN_PERM, 16707 .internal_flags = 16708 IFLAGS(NL80211_FLAG_NEED_WIPHY | 16709 NL80211_FLAG_NEED_RTNL | 16710 /* we take the wiphy mutex later ourselves */ 16711 NL80211_FLAG_NO_WIPHY_MTX), 16712 }, 16713 { 16714 .cmd = NL80211_CMD_DEL_INTERFACE, 16715 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16716 .doit = nl80211_del_interface, 16717 .flags = GENL_UNS_ADMIN_PERM, 16718 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 16719 NL80211_FLAG_NEED_RTNL), 16720 }, 16721 { 16722 .cmd = NL80211_CMD_GET_KEY, 16723 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16724 .doit = nl80211_get_key, 16725 .flags = GENL_UNS_ADMIN_PERM, 16726 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16727 }, 16728 { 16729 .cmd = NL80211_CMD_SET_KEY, 16730 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16731 .doit = nl80211_set_key, 16732 .flags = GENL_UNS_ADMIN_PERM, 16733 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */ 16734 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16735 NL80211_FLAG_CLEAR_SKB), 16736 }, 16737 { 16738 .cmd = NL80211_CMD_NEW_KEY, 16739 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16740 .doit = nl80211_new_key, 16741 .flags = GENL_UNS_ADMIN_PERM, 16742 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16743 NL80211_FLAG_CLEAR_SKB), 16744 }, 16745 { 16746 .cmd = NL80211_CMD_DEL_KEY, 16747 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16748 .doit = nl80211_del_key, 16749 .flags = GENL_UNS_ADMIN_PERM, 16750 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16751 }, 16752 { 16753 .cmd = NL80211_CMD_SET_BEACON, 16754 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16755 .flags = GENL_UNS_ADMIN_PERM, 16756 .doit = nl80211_set_beacon, 16757 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16758 NL80211_FLAG_MLO_VALID_LINK_ID), 16759 }, 16760 { 16761 .cmd = NL80211_CMD_START_AP, 16762 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16763 .flags = GENL_UNS_ADMIN_PERM, 16764 .doit = nl80211_start_ap, 16765 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16766 NL80211_FLAG_MLO_VALID_LINK_ID), 16767 }, 16768 { 16769 .cmd = NL80211_CMD_STOP_AP, 16770 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16771 .flags = GENL_UNS_ADMIN_PERM, 16772 .doit = nl80211_stop_ap, 16773 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16774 NL80211_FLAG_MLO_VALID_LINK_ID), 16775 }, 16776 { 16777 .cmd = NL80211_CMD_GET_STATION, 16778 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16779 .doit = nl80211_get_station, 16780 .dumpit = nl80211_dump_station, 16781 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 16782 }, 16783 { 16784 .cmd = NL80211_CMD_SET_STATION, 16785 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16786 .doit = nl80211_set_station, 16787 .flags = GENL_UNS_ADMIN_PERM, 16788 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16789 }, 16790 { 16791 .cmd = NL80211_CMD_NEW_STATION, 16792 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16793 .doit = nl80211_new_station, 16794 .flags = GENL_UNS_ADMIN_PERM, 16795 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16796 }, 16797 { 16798 .cmd = NL80211_CMD_DEL_STATION, 16799 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16800 .doit = nl80211_del_station, 16801 .flags = GENL_UNS_ADMIN_PERM, 16802 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on 16803 * whether MAC address is passed or not. If MAC address is 16804 * passed, then even during MLO, link ID is not required. 16805 */ 16806 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16807 }, 16808 { 16809 .cmd = NL80211_CMD_GET_MPATH, 16810 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16811 .doit = nl80211_get_mpath, 16812 .dumpit = nl80211_dump_mpath, 16813 .flags = GENL_UNS_ADMIN_PERM, 16814 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16815 }, 16816 { 16817 .cmd = NL80211_CMD_GET_MPP, 16818 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16819 .doit = nl80211_get_mpp, 16820 .dumpit = nl80211_dump_mpp, 16821 .flags = GENL_UNS_ADMIN_PERM, 16822 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16823 }, 16824 { 16825 .cmd = NL80211_CMD_SET_MPATH, 16826 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16827 .doit = nl80211_set_mpath, 16828 .flags = GENL_UNS_ADMIN_PERM, 16829 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16830 }, 16831 { 16832 .cmd = NL80211_CMD_NEW_MPATH, 16833 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16834 .doit = nl80211_new_mpath, 16835 .flags = GENL_UNS_ADMIN_PERM, 16836 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16837 }, 16838 { 16839 .cmd = NL80211_CMD_DEL_MPATH, 16840 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16841 .doit = nl80211_del_mpath, 16842 .flags = GENL_UNS_ADMIN_PERM, 16843 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16844 }, 16845 { 16846 .cmd = NL80211_CMD_SET_BSS, 16847 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16848 .doit = nl80211_set_bss, 16849 .flags = GENL_UNS_ADMIN_PERM, 16850 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16851 NL80211_FLAG_MLO_VALID_LINK_ID), 16852 }, 16853 { 16854 .cmd = NL80211_CMD_GET_REG, 16855 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16856 .doit = nl80211_get_reg_do, 16857 .dumpit = nl80211_get_reg_dump, 16858 /* can be retrieved by unprivileged users */ 16859 }, 16860 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 16861 { 16862 .cmd = NL80211_CMD_SET_REG, 16863 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16864 .doit = nl80211_set_reg, 16865 .flags = GENL_ADMIN_PERM, 16866 }, 16867 #endif 16868 { 16869 .cmd = NL80211_CMD_REQ_SET_REG, 16870 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16871 .doit = nl80211_req_set_reg, 16872 .flags = GENL_ADMIN_PERM, 16873 }, 16874 { 16875 .cmd = NL80211_CMD_RELOAD_REGDB, 16876 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16877 .doit = nl80211_reload_regdb, 16878 .flags = GENL_ADMIN_PERM, 16879 }, 16880 { 16881 .cmd = NL80211_CMD_GET_MESH_CONFIG, 16882 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16883 .doit = nl80211_get_mesh_config, 16884 /* can be retrieved by unprivileged users */ 16885 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16886 }, 16887 { 16888 .cmd = NL80211_CMD_SET_MESH_CONFIG, 16889 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16890 .doit = nl80211_update_mesh_config, 16891 .flags = GENL_UNS_ADMIN_PERM, 16892 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16893 }, 16894 { 16895 .cmd = NL80211_CMD_TRIGGER_SCAN, 16896 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16897 .doit = nl80211_trigger_scan, 16898 .flags = GENL_UNS_ADMIN_PERM, 16899 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 16900 }, 16901 { 16902 .cmd = NL80211_CMD_ABORT_SCAN, 16903 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16904 .doit = nl80211_abort_scan, 16905 .flags = GENL_UNS_ADMIN_PERM, 16906 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 16907 }, 16908 { 16909 .cmd = NL80211_CMD_GET_SCAN, 16910 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16911 .dumpit = nl80211_dump_scan, 16912 }, 16913 { 16914 .cmd = NL80211_CMD_START_SCHED_SCAN, 16915 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16916 .doit = nl80211_start_sched_scan, 16917 .flags = GENL_UNS_ADMIN_PERM, 16918 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16919 }, 16920 { 16921 .cmd = NL80211_CMD_STOP_SCHED_SCAN, 16922 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16923 .doit = nl80211_stop_sched_scan, 16924 .flags = GENL_UNS_ADMIN_PERM, 16925 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16926 }, 16927 { 16928 .cmd = NL80211_CMD_AUTHENTICATE, 16929 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16930 .doit = nl80211_authenticate, 16931 .flags = GENL_UNS_ADMIN_PERM, 16932 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16933 NL80211_FLAG_CLEAR_SKB), 16934 }, 16935 { 16936 .cmd = NL80211_CMD_ASSOCIATE, 16937 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16938 .doit = nl80211_associate, 16939 .flags = GENL_UNS_ADMIN_PERM, 16940 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16941 NL80211_FLAG_CLEAR_SKB), 16942 }, 16943 { 16944 .cmd = NL80211_CMD_DEAUTHENTICATE, 16945 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16946 .doit = nl80211_deauthenticate, 16947 .flags = GENL_UNS_ADMIN_PERM, 16948 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16949 }, 16950 { 16951 .cmd = NL80211_CMD_DISASSOCIATE, 16952 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16953 .doit = nl80211_disassociate, 16954 .flags = GENL_UNS_ADMIN_PERM, 16955 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16956 }, 16957 { 16958 .cmd = NL80211_CMD_JOIN_IBSS, 16959 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16960 .doit = nl80211_join_ibss, 16961 .flags = GENL_UNS_ADMIN_PERM, 16962 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16963 }, 16964 { 16965 .cmd = NL80211_CMD_LEAVE_IBSS, 16966 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16967 .doit = nl80211_leave_ibss, 16968 .flags = GENL_UNS_ADMIN_PERM, 16969 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16970 }, 16971 #ifdef CONFIG_NL80211_TESTMODE 16972 { 16973 .cmd = NL80211_CMD_TESTMODE, 16974 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16975 .doit = nl80211_testmode_do, 16976 .dumpit = nl80211_testmode_dump, 16977 .flags = GENL_UNS_ADMIN_PERM, 16978 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 16979 }, 16980 #endif 16981 { 16982 .cmd = NL80211_CMD_CONNECT, 16983 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16984 .doit = nl80211_connect, 16985 .flags = GENL_UNS_ADMIN_PERM, 16986 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16987 NL80211_FLAG_CLEAR_SKB), 16988 }, 16989 { 16990 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS, 16991 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16992 .doit = nl80211_update_connect_params, 16993 .flags = GENL_ADMIN_PERM, 16994 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16995 NL80211_FLAG_CLEAR_SKB), 16996 }, 16997 { 16998 .cmd = NL80211_CMD_DISCONNECT, 16999 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17000 .doit = nl80211_disconnect, 17001 .flags = GENL_UNS_ADMIN_PERM, 17002 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17003 }, 17004 { 17005 .cmd = NL80211_CMD_SET_WIPHY_NETNS, 17006 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17007 .doit = nl80211_wiphy_netns, 17008 .flags = GENL_UNS_ADMIN_PERM, 17009 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17010 NL80211_FLAG_NEED_RTNL | 17011 NL80211_FLAG_NO_WIPHY_MTX), 17012 }, 17013 { 17014 .cmd = NL80211_CMD_GET_SURVEY, 17015 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17016 .dumpit = nl80211_dump_survey, 17017 }, 17018 { 17019 .cmd = NL80211_CMD_SET_PMKSA, 17020 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17021 .doit = nl80211_set_pmksa, 17022 .flags = GENL_UNS_ADMIN_PERM, 17023 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17024 NL80211_FLAG_CLEAR_SKB), 17025 }, 17026 { 17027 .cmd = NL80211_CMD_DEL_PMKSA, 17028 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17029 .doit = nl80211_del_pmksa, 17030 .flags = GENL_UNS_ADMIN_PERM, 17031 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17032 }, 17033 { 17034 .cmd = NL80211_CMD_FLUSH_PMKSA, 17035 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17036 .doit = nl80211_flush_pmksa, 17037 .flags = GENL_UNS_ADMIN_PERM, 17038 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17039 }, 17040 { 17041 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL, 17042 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17043 .doit = nl80211_remain_on_channel, 17044 .flags = GENL_UNS_ADMIN_PERM, 17045 /* FIXME: requiring a link ID here is probably not good */ 17046 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17047 NL80211_FLAG_MLO_VALID_LINK_ID), 17048 }, 17049 { 17050 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 17051 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17052 .doit = nl80211_cancel_remain_on_channel, 17053 .flags = GENL_UNS_ADMIN_PERM, 17054 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17055 }, 17056 { 17057 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK, 17058 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17059 .doit = nl80211_set_tx_bitrate_mask, 17060 .flags = GENL_UNS_ADMIN_PERM, 17061 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17062 NL80211_FLAG_MLO_VALID_LINK_ID), 17063 }, 17064 { 17065 .cmd = NL80211_CMD_REGISTER_FRAME, 17066 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17067 .doit = nl80211_register_mgmt, 17068 .flags = GENL_UNS_ADMIN_PERM, 17069 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 17070 }, 17071 { 17072 .cmd = NL80211_CMD_FRAME, 17073 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17074 .doit = nl80211_tx_mgmt, 17075 .flags = GENL_UNS_ADMIN_PERM, 17076 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17077 }, 17078 { 17079 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL, 17080 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17081 .doit = nl80211_tx_mgmt_cancel_wait, 17082 .flags = GENL_UNS_ADMIN_PERM, 17083 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17084 }, 17085 { 17086 .cmd = NL80211_CMD_SET_POWER_SAVE, 17087 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17088 .doit = nl80211_set_power_save, 17089 .flags = GENL_UNS_ADMIN_PERM, 17090 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17091 }, 17092 { 17093 .cmd = NL80211_CMD_GET_POWER_SAVE, 17094 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17095 .doit = nl80211_get_power_save, 17096 /* can be retrieved by unprivileged users */ 17097 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17098 }, 17099 { 17100 .cmd = NL80211_CMD_SET_CQM, 17101 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17102 .doit = nl80211_set_cqm, 17103 .flags = GENL_UNS_ADMIN_PERM, 17104 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17105 }, 17106 { 17107 .cmd = NL80211_CMD_SET_CHANNEL, 17108 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17109 .doit = nl80211_set_channel, 17110 .flags = GENL_UNS_ADMIN_PERM, 17111 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17112 NL80211_FLAG_MLO_VALID_LINK_ID), 17113 }, 17114 { 17115 .cmd = NL80211_CMD_JOIN_MESH, 17116 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17117 .doit = nl80211_join_mesh, 17118 .flags = GENL_UNS_ADMIN_PERM, 17119 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17120 }, 17121 { 17122 .cmd = NL80211_CMD_LEAVE_MESH, 17123 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17124 .doit = nl80211_leave_mesh, 17125 .flags = GENL_UNS_ADMIN_PERM, 17126 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17127 }, 17128 { 17129 .cmd = NL80211_CMD_JOIN_OCB, 17130 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17131 .doit = nl80211_join_ocb, 17132 .flags = GENL_UNS_ADMIN_PERM, 17133 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17134 }, 17135 { 17136 .cmd = NL80211_CMD_LEAVE_OCB, 17137 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17138 .doit = nl80211_leave_ocb, 17139 .flags = GENL_UNS_ADMIN_PERM, 17140 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17141 }, 17142 #ifdef CONFIG_PM 17143 { 17144 .cmd = NL80211_CMD_GET_WOWLAN, 17145 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17146 .doit = nl80211_get_wowlan, 17147 /* can be retrieved by unprivileged users */ 17148 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17149 }, 17150 { 17151 .cmd = NL80211_CMD_SET_WOWLAN, 17152 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17153 .doit = nl80211_set_wowlan, 17154 .flags = GENL_UNS_ADMIN_PERM, 17155 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17156 }, 17157 #endif 17158 { 17159 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD, 17160 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17161 .doit = nl80211_set_rekey_data, 17162 .flags = GENL_UNS_ADMIN_PERM, 17163 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17164 NL80211_FLAG_CLEAR_SKB), 17165 }, 17166 { 17167 .cmd = NL80211_CMD_TDLS_MGMT, 17168 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17169 .doit = nl80211_tdls_mgmt, 17170 .flags = GENL_UNS_ADMIN_PERM, 17171 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17172 NL80211_FLAG_MLO_VALID_LINK_ID), 17173 }, 17174 { 17175 .cmd = NL80211_CMD_TDLS_OPER, 17176 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17177 .doit = nl80211_tdls_oper, 17178 .flags = GENL_UNS_ADMIN_PERM, 17179 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17180 }, 17181 { 17182 .cmd = NL80211_CMD_UNEXPECTED_FRAME, 17183 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17184 .doit = nl80211_register_unexpected_frame, 17185 .flags = GENL_UNS_ADMIN_PERM, 17186 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17187 }, 17188 { 17189 .cmd = NL80211_CMD_PROBE_CLIENT, 17190 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17191 .doit = nl80211_probe_client, 17192 .flags = GENL_UNS_ADMIN_PERM, 17193 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17194 }, 17195 { 17196 .cmd = NL80211_CMD_REGISTER_BEACONS, 17197 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17198 .doit = nl80211_register_beacons, 17199 .flags = GENL_UNS_ADMIN_PERM, 17200 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17201 }, 17202 { 17203 .cmd = NL80211_CMD_SET_NOACK_MAP, 17204 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17205 .doit = nl80211_set_noack_map, 17206 .flags = GENL_UNS_ADMIN_PERM, 17207 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17208 }, 17209 { 17210 .cmd = NL80211_CMD_START_P2P_DEVICE, 17211 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17212 .doit = nl80211_start_p2p_device, 17213 .flags = GENL_UNS_ADMIN_PERM, 17214 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17215 NL80211_FLAG_NEED_RTNL), 17216 }, 17217 { 17218 .cmd = NL80211_CMD_STOP_P2P_DEVICE, 17219 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17220 .doit = nl80211_stop_p2p_device, 17221 .flags = GENL_UNS_ADMIN_PERM, 17222 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17223 NL80211_FLAG_NEED_RTNL), 17224 }, 17225 { 17226 .cmd = NL80211_CMD_START_NAN, 17227 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17228 .doit = nl80211_start_nan, 17229 .flags = GENL_ADMIN_PERM, 17230 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17231 NL80211_FLAG_NEED_RTNL), 17232 }, 17233 { 17234 .cmd = NL80211_CMD_STOP_NAN, 17235 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17236 .doit = nl80211_stop_nan, 17237 .flags = GENL_ADMIN_PERM, 17238 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17239 NL80211_FLAG_NEED_RTNL), 17240 }, 17241 { 17242 .cmd = NL80211_CMD_ADD_NAN_FUNCTION, 17243 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17244 .doit = nl80211_nan_add_func, 17245 .flags = GENL_ADMIN_PERM, 17246 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17247 }, 17248 { 17249 .cmd = NL80211_CMD_DEL_NAN_FUNCTION, 17250 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17251 .doit = nl80211_nan_del_func, 17252 .flags = GENL_ADMIN_PERM, 17253 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17254 }, 17255 { 17256 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG, 17257 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17258 .doit = nl80211_nan_change_config, 17259 .flags = GENL_ADMIN_PERM, 17260 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17261 }, 17262 { 17263 .cmd = NL80211_CMD_SET_MCAST_RATE, 17264 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17265 .doit = nl80211_set_mcast_rate, 17266 .flags = GENL_UNS_ADMIN_PERM, 17267 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17268 }, 17269 { 17270 .cmd = NL80211_CMD_SET_MAC_ACL, 17271 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17272 .doit = nl80211_set_mac_acl, 17273 .flags = GENL_UNS_ADMIN_PERM, 17274 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17275 NL80211_FLAG_MLO_UNSUPPORTED), 17276 }, 17277 { 17278 .cmd = NL80211_CMD_RADAR_DETECT, 17279 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17280 .doit = nl80211_start_radar_detection, 17281 .flags = GENL_UNS_ADMIN_PERM, 17282 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17283 NL80211_FLAG_NO_WIPHY_MTX | 17284 NL80211_FLAG_MLO_UNSUPPORTED), 17285 }, 17286 { 17287 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES, 17288 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17289 .doit = nl80211_get_protocol_features, 17290 }, 17291 { 17292 .cmd = NL80211_CMD_UPDATE_FT_IES, 17293 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17294 .doit = nl80211_update_ft_ies, 17295 .flags = GENL_UNS_ADMIN_PERM, 17296 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17297 }, 17298 { 17299 .cmd = NL80211_CMD_CRIT_PROTOCOL_START, 17300 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17301 .doit = nl80211_crit_protocol_start, 17302 .flags = GENL_UNS_ADMIN_PERM, 17303 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17304 }, 17305 { 17306 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP, 17307 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17308 .doit = nl80211_crit_protocol_stop, 17309 .flags = GENL_UNS_ADMIN_PERM, 17310 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17311 }, 17312 { 17313 .cmd = NL80211_CMD_GET_COALESCE, 17314 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17315 .doit = nl80211_get_coalesce, 17316 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17317 }, 17318 { 17319 .cmd = NL80211_CMD_SET_COALESCE, 17320 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17321 .doit = nl80211_set_coalesce, 17322 .flags = GENL_UNS_ADMIN_PERM, 17323 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17324 }, 17325 { 17326 .cmd = NL80211_CMD_CHANNEL_SWITCH, 17327 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17328 .doit = nl80211_channel_switch, 17329 .flags = GENL_UNS_ADMIN_PERM, 17330 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17331 NL80211_FLAG_MLO_VALID_LINK_ID), 17332 }, 17333 { 17334 .cmd = NL80211_CMD_VENDOR, 17335 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17336 .doit = nl80211_vendor_cmd, 17337 .dumpit = nl80211_vendor_cmd_dump, 17338 .flags = GENL_UNS_ADMIN_PERM, 17339 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17340 NL80211_FLAG_CLEAR_SKB), 17341 }, 17342 { 17343 .cmd = NL80211_CMD_SET_QOS_MAP, 17344 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17345 .doit = nl80211_set_qos_map, 17346 .flags = GENL_UNS_ADMIN_PERM, 17347 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17348 }, 17349 { 17350 .cmd = NL80211_CMD_ADD_TX_TS, 17351 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17352 .doit = nl80211_add_tx_ts, 17353 .flags = GENL_UNS_ADMIN_PERM, 17354 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17355 NL80211_FLAG_MLO_UNSUPPORTED), 17356 }, 17357 { 17358 .cmd = NL80211_CMD_DEL_TX_TS, 17359 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17360 .doit = nl80211_del_tx_ts, 17361 .flags = GENL_UNS_ADMIN_PERM, 17362 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17363 }, 17364 { 17365 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH, 17366 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17367 .doit = nl80211_tdls_channel_switch, 17368 .flags = GENL_UNS_ADMIN_PERM, 17369 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17370 }, 17371 { 17372 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH, 17373 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17374 .doit = nl80211_tdls_cancel_channel_switch, 17375 .flags = GENL_UNS_ADMIN_PERM, 17376 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17377 }, 17378 { 17379 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST, 17380 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17381 .doit = nl80211_set_multicast_to_unicast, 17382 .flags = GENL_UNS_ADMIN_PERM, 17383 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17384 }, 17385 { 17386 .cmd = NL80211_CMD_SET_PMK, 17387 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17388 .doit = nl80211_set_pmk, 17389 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17390 NL80211_FLAG_CLEAR_SKB), 17391 }, 17392 { 17393 .cmd = NL80211_CMD_DEL_PMK, 17394 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17395 .doit = nl80211_del_pmk, 17396 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17397 }, 17398 { 17399 .cmd = NL80211_CMD_EXTERNAL_AUTH, 17400 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17401 .doit = nl80211_external_auth, 17402 .flags = GENL_ADMIN_PERM, 17403 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17404 }, 17405 { 17406 .cmd = NL80211_CMD_CONTROL_PORT_FRAME, 17407 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17408 .doit = nl80211_tx_control_port, 17409 .flags = GENL_UNS_ADMIN_PERM, 17410 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17411 }, 17412 { 17413 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS, 17414 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17415 .doit = nl80211_get_ftm_responder_stats, 17416 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17417 NL80211_FLAG_MLO_VALID_LINK_ID), 17418 }, 17419 { 17420 .cmd = NL80211_CMD_PEER_MEASUREMENT_START, 17421 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17422 .doit = nl80211_pmsr_start, 17423 .flags = GENL_UNS_ADMIN_PERM, 17424 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17425 }, 17426 { 17427 .cmd = NL80211_CMD_NOTIFY_RADAR, 17428 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17429 .doit = nl80211_notify_radar_detection, 17430 .flags = GENL_UNS_ADMIN_PERM, 17431 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17432 }, 17433 { 17434 .cmd = NL80211_CMD_UPDATE_OWE_INFO, 17435 .doit = nl80211_update_owe_info, 17436 .flags = GENL_ADMIN_PERM, 17437 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17438 }, 17439 { 17440 .cmd = NL80211_CMD_PROBE_MESH_LINK, 17441 .doit = nl80211_probe_mesh_link, 17442 .flags = GENL_UNS_ADMIN_PERM, 17443 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17444 }, 17445 { 17446 .cmd = NL80211_CMD_SET_TID_CONFIG, 17447 .doit = nl80211_set_tid_config, 17448 .flags = GENL_UNS_ADMIN_PERM, 17449 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17450 NL80211_FLAG_MLO_VALID_LINK_ID), 17451 }, 17452 { 17453 .cmd = NL80211_CMD_SET_SAR_SPECS, 17454 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17455 .doit = nl80211_set_sar_specs, 17456 .flags = GENL_UNS_ADMIN_PERM, 17457 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17458 NL80211_FLAG_NEED_RTNL), 17459 }, 17460 { 17461 .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST, 17462 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17463 .doit = nl80211_color_change, 17464 .flags = GENL_UNS_ADMIN_PERM, 17465 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17466 NL80211_FLAG_MLO_VALID_LINK_ID), 17467 }, 17468 { 17469 .cmd = NL80211_CMD_SET_FILS_AAD, 17470 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17471 .doit = nl80211_set_fils_aad, 17472 .flags = GENL_UNS_ADMIN_PERM, 17473 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17474 }, 17475 { 17476 .cmd = NL80211_CMD_ADD_LINK, 17477 .doit = nl80211_add_link, 17478 .flags = GENL_UNS_ADMIN_PERM, 17479 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17480 }, 17481 { 17482 .cmd = NL80211_CMD_REMOVE_LINK, 17483 .doit = nl80211_remove_link, 17484 .flags = GENL_UNS_ADMIN_PERM, 17485 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17486 NL80211_FLAG_MLO_VALID_LINK_ID), 17487 }, 17488 { 17489 .cmd = NL80211_CMD_ADD_LINK_STA, 17490 .doit = nl80211_add_link_station, 17491 .flags = GENL_UNS_ADMIN_PERM, 17492 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17493 NL80211_FLAG_MLO_VALID_LINK_ID), 17494 }, 17495 { 17496 .cmd = NL80211_CMD_MODIFY_LINK_STA, 17497 .doit = nl80211_modify_link_station, 17498 .flags = GENL_UNS_ADMIN_PERM, 17499 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17500 NL80211_FLAG_MLO_VALID_LINK_ID), 17501 }, 17502 { 17503 .cmd = NL80211_CMD_REMOVE_LINK_STA, 17504 .doit = nl80211_remove_link_station, 17505 .flags = GENL_UNS_ADMIN_PERM, 17506 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17507 NL80211_FLAG_MLO_VALID_LINK_ID), 17508 }, 17509 { 17510 .cmd = NL80211_CMD_SET_HW_TIMESTAMP, 17511 .doit = nl80211_set_hw_timestamp, 17512 .flags = GENL_UNS_ADMIN_PERM, 17513 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17514 }, 17515 { 17516 .cmd = NL80211_CMD_SET_TID_TO_LINK_MAPPING, 17517 .doit = nl80211_set_ttlm, 17518 .flags = GENL_UNS_ADMIN_PERM, 17519 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17520 }, 17521 }; 17522 17523 static struct genl_family nl80211_fam __ro_after_init = { 17524 .name = NL80211_GENL_NAME, /* have users key off the name instead */ 17525 .hdrsize = 0, /* no private header */ 17526 .version = 1, /* no particular meaning now */ 17527 .maxattr = NL80211_ATTR_MAX, 17528 .policy = nl80211_policy, 17529 .netnsok = true, 17530 .pre_doit = nl80211_pre_doit, 17531 .post_doit = nl80211_post_doit, 17532 .module = THIS_MODULE, 17533 .ops = nl80211_ops, 17534 .n_ops = ARRAY_SIZE(nl80211_ops), 17535 .small_ops = nl80211_small_ops, 17536 .n_small_ops = ARRAY_SIZE(nl80211_small_ops), 17537 .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1, 17538 .mcgrps = nl80211_mcgrps, 17539 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps), 17540 .parallel_ops = true, 17541 }; 17542 17543 /* notification functions */ 17544 17545 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev, 17546 enum nl80211_commands cmd) 17547 { 17548 struct sk_buff *msg; 17549 struct nl80211_dump_wiphy_state state = {}; 17550 17551 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY && 17552 cmd != NL80211_CMD_DEL_WIPHY); 17553 17554 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17555 if (!msg) 17556 return; 17557 17558 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) { 17559 nlmsg_free(msg); 17560 return; 17561 } 17562 17563 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17564 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17565 } 17566 17567 void nl80211_notify_iface(struct cfg80211_registered_device *rdev, 17568 struct wireless_dev *wdev, 17569 enum nl80211_commands cmd) 17570 { 17571 struct sk_buff *msg; 17572 17573 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17574 if (!msg) 17575 return; 17576 17577 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) { 17578 nlmsg_free(msg); 17579 return; 17580 } 17581 17582 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17583 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17584 } 17585 17586 static int nl80211_add_scan_req(struct sk_buff *msg, 17587 struct cfg80211_registered_device *rdev) 17588 { 17589 struct cfg80211_scan_request *req = rdev->scan_req; 17590 struct nlattr *nest; 17591 int i; 17592 struct cfg80211_scan_info *info; 17593 17594 if (WARN_ON(!req)) 17595 return 0; 17596 17597 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS); 17598 if (!nest) 17599 goto nla_put_failure; 17600 for (i = 0; i < req->n_ssids; i++) { 17601 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid)) 17602 goto nla_put_failure; 17603 } 17604 nla_nest_end(msg, nest); 17605 17606 if (req->flags & NL80211_SCAN_FLAG_FREQ_KHZ) { 17607 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ); 17608 if (!nest) 17609 goto nla_put_failure; 17610 for (i = 0; i < req->n_channels; i++) { 17611 if (nla_put_u32(msg, i, 17612 ieee80211_channel_to_khz(req->channels[i]))) 17613 goto nla_put_failure; 17614 } 17615 nla_nest_end(msg, nest); 17616 } else { 17617 nest = nla_nest_start_noflag(msg, 17618 NL80211_ATTR_SCAN_FREQUENCIES); 17619 if (!nest) 17620 goto nla_put_failure; 17621 for (i = 0; i < req->n_channels; i++) { 17622 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 17623 goto nla_put_failure; 17624 } 17625 nla_nest_end(msg, nest); 17626 } 17627 17628 if (req->ie && 17629 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie)) 17630 goto nla_put_failure; 17631 17632 if (req->flags && 17633 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags)) 17634 goto nla_put_failure; 17635 17636 info = rdev->int_scan_req ? &rdev->int_scan_req->info : 17637 &rdev->scan_req->info; 17638 if (info->scan_start_tsf && 17639 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF, 17640 info->scan_start_tsf, NL80211_BSS_PAD) || 17641 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN, 17642 info->tsf_bssid))) 17643 goto nla_put_failure; 17644 17645 return 0; 17646 nla_put_failure: 17647 return -ENOBUFS; 17648 } 17649 17650 static int nl80211_prep_scan_msg(struct sk_buff *msg, 17651 struct cfg80211_registered_device *rdev, 17652 struct wireless_dev *wdev, 17653 u32 portid, u32 seq, int flags, 17654 u32 cmd) 17655 { 17656 void *hdr; 17657 17658 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 17659 if (!hdr) 17660 return -1; 17661 17662 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17663 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 17664 wdev->netdev->ifindex)) || 17665 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 17666 NL80211_ATTR_PAD)) 17667 goto nla_put_failure; 17668 17669 /* ignore errors and send incomplete event anyway */ 17670 nl80211_add_scan_req(msg, rdev); 17671 17672 genlmsg_end(msg, hdr); 17673 return 0; 17674 17675 nla_put_failure: 17676 genlmsg_cancel(msg, hdr); 17677 return -EMSGSIZE; 17678 } 17679 17680 static int 17681 nl80211_prep_sched_scan_msg(struct sk_buff *msg, 17682 struct cfg80211_sched_scan_request *req, u32 cmd) 17683 { 17684 void *hdr; 17685 17686 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 17687 if (!hdr) 17688 return -1; 17689 17690 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, 17691 wiphy_to_rdev(req->wiphy)->wiphy_idx) || 17692 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) || 17693 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid, 17694 NL80211_ATTR_PAD)) 17695 goto nla_put_failure; 17696 17697 genlmsg_end(msg, hdr); 17698 return 0; 17699 17700 nla_put_failure: 17701 genlmsg_cancel(msg, hdr); 17702 return -EMSGSIZE; 17703 } 17704 17705 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev, 17706 struct wireless_dev *wdev) 17707 { 17708 struct sk_buff *msg; 17709 17710 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17711 if (!msg) 17712 return; 17713 17714 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17715 NL80211_CMD_TRIGGER_SCAN) < 0) { 17716 nlmsg_free(msg); 17717 return; 17718 } 17719 17720 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17721 NL80211_MCGRP_SCAN, GFP_KERNEL); 17722 } 17723 17724 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev, 17725 struct wireless_dev *wdev, bool aborted) 17726 { 17727 struct sk_buff *msg; 17728 17729 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17730 if (!msg) 17731 return NULL; 17732 17733 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17734 aborted ? NL80211_CMD_SCAN_ABORTED : 17735 NL80211_CMD_NEW_SCAN_RESULTS) < 0) { 17736 nlmsg_free(msg); 17737 return NULL; 17738 } 17739 17740 return msg; 17741 } 17742 17743 /* send message created by nl80211_build_scan_msg() */ 17744 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev, 17745 struct sk_buff *msg) 17746 { 17747 if (!msg) 17748 return; 17749 17750 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17751 NL80211_MCGRP_SCAN, GFP_KERNEL); 17752 } 17753 17754 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd) 17755 { 17756 struct sk_buff *msg; 17757 17758 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17759 if (!msg) 17760 return; 17761 17762 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) { 17763 nlmsg_free(msg); 17764 return; 17765 } 17766 17767 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0, 17768 NL80211_MCGRP_SCAN, GFP_KERNEL); 17769 } 17770 17771 static bool nl80211_reg_change_event_fill(struct sk_buff *msg, 17772 struct regulatory_request *request) 17773 { 17774 /* Userspace can always count this one always being set */ 17775 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator)) 17776 goto nla_put_failure; 17777 17778 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') { 17779 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17780 NL80211_REGDOM_TYPE_WORLD)) 17781 goto nla_put_failure; 17782 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') { 17783 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17784 NL80211_REGDOM_TYPE_CUSTOM_WORLD)) 17785 goto nla_put_failure; 17786 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') || 17787 request->intersect) { 17788 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17789 NL80211_REGDOM_TYPE_INTERSECTION)) 17790 goto nla_put_failure; 17791 } else { 17792 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17793 NL80211_REGDOM_TYPE_COUNTRY) || 17794 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, 17795 request->alpha2)) 17796 goto nla_put_failure; 17797 } 17798 17799 if (request->wiphy_idx != WIPHY_IDX_INVALID) { 17800 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx); 17801 17802 if (wiphy && 17803 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx)) 17804 goto nla_put_failure; 17805 17806 if (wiphy && 17807 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 17808 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 17809 goto nla_put_failure; 17810 } 17811 17812 return true; 17813 17814 nla_put_failure: 17815 return false; 17816 } 17817 17818 /* 17819 * This can happen on global regulatory changes or device specific settings 17820 * based on custom regulatory domains. 17821 */ 17822 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id, 17823 struct regulatory_request *request) 17824 { 17825 struct sk_buff *msg; 17826 void *hdr; 17827 17828 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17829 if (!msg) 17830 return; 17831 17832 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id); 17833 if (!hdr) 17834 goto nla_put_failure; 17835 17836 if (!nl80211_reg_change_event_fill(msg, request)) 17837 goto nla_put_failure; 17838 17839 genlmsg_end(msg, hdr); 17840 17841 rcu_read_lock(); 17842 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 17843 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 17844 rcu_read_unlock(); 17845 17846 return; 17847 17848 nla_put_failure: 17849 nlmsg_free(msg); 17850 } 17851 17852 struct nl80211_mlme_event { 17853 enum nl80211_commands cmd; 17854 const u8 *buf; 17855 size_t buf_len; 17856 int uapsd_queues; 17857 const u8 *req_ies; 17858 size_t req_ies_len; 17859 bool reconnect; 17860 }; 17861 17862 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev, 17863 struct net_device *netdev, 17864 const struct nl80211_mlme_event *event, 17865 gfp_t gfp) 17866 { 17867 struct sk_buff *msg; 17868 void *hdr; 17869 17870 msg = nlmsg_new(100 + event->buf_len + event->req_ies_len, gfp); 17871 if (!msg) 17872 return; 17873 17874 hdr = nl80211hdr_put(msg, 0, 0, 0, event->cmd); 17875 if (!hdr) { 17876 nlmsg_free(msg); 17877 return; 17878 } 17879 17880 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17881 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 17882 nla_put(msg, NL80211_ATTR_FRAME, event->buf_len, event->buf) || 17883 (event->req_ies && 17884 nla_put(msg, NL80211_ATTR_REQ_IE, event->req_ies_len, 17885 event->req_ies))) 17886 goto nla_put_failure; 17887 17888 if (event->reconnect && 17889 nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED)) 17890 goto nla_put_failure; 17891 17892 if (event->uapsd_queues >= 0) { 17893 struct nlattr *nla_wmm = 17894 nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME); 17895 if (!nla_wmm) 17896 goto nla_put_failure; 17897 17898 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES, 17899 event->uapsd_queues)) 17900 goto nla_put_failure; 17901 17902 nla_nest_end(msg, nla_wmm); 17903 } 17904 17905 genlmsg_end(msg, hdr); 17906 17907 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17908 NL80211_MCGRP_MLME, gfp); 17909 return; 17910 17911 nla_put_failure: 17912 nlmsg_free(msg); 17913 } 17914 17915 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev, 17916 struct net_device *netdev, const u8 *buf, 17917 size_t len, gfp_t gfp) 17918 { 17919 struct nl80211_mlme_event event = { 17920 .cmd = NL80211_CMD_AUTHENTICATE, 17921 .buf = buf, 17922 .buf_len = len, 17923 .uapsd_queues = -1, 17924 }; 17925 17926 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 17927 } 17928 17929 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev, 17930 struct net_device *netdev, 17931 const struct cfg80211_rx_assoc_resp_data *data) 17932 { 17933 struct nl80211_mlme_event event = { 17934 .cmd = NL80211_CMD_ASSOCIATE, 17935 .buf = data->buf, 17936 .buf_len = data->len, 17937 .uapsd_queues = data->uapsd_queues, 17938 .req_ies = data->req_ies, 17939 .req_ies_len = data->req_ies_len, 17940 }; 17941 17942 nl80211_send_mlme_event(rdev, netdev, &event, GFP_KERNEL); 17943 } 17944 17945 void nl80211_send_deauth(struct cfg80211_registered_device *rdev, 17946 struct net_device *netdev, const u8 *buf, 17947 size_t len, bool reconnect, gfp_t gfp) 17948 { 17949 struct nl80211_mlme_event event = { 17950 .cmd = NL80211_CMD_DEAUTHENTICATE, 17951 .buf = buf, 17952 .buf_len = len, 17953 .reconnect = reconnect, 17954 .uapsd_queues = -1, 17955 }; 17956 17957 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 17958 } 17959 17960 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev, 17961 struct net_device *netdev, const u8 *buf, 17962 size_t len, bool reconnect, gfp_t gfp) 17963 { 17964 struct nl80211_mlme_event event = { 17965 .cmd = NL80211_CMD_DISASSOCIATE, 17966 .buf = buf, 17967 .buf_len = len, 17968 .reconnect = reconnect, 17969 .uapsd_queues = -1, 17970 }; 17971 17972 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 17973 } 17974 17975 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf, 17976 size_t len) 17977 { 17978 struct wireless_dev *wdev = dev->ieee80211_ptr; 17979 struct wiphy *wiphy = wdev->wiphy; 17980 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 17981 const struct ieee80211_mgmt *mgmt = (void *)buf; 17982 struct nl80211_mlme_event event = { 17983 .buf = buf, 17984 .buf_len = len, 17985 .uapsd_queues = -1, 17986 }; 17987 17988 if (WARN_ON(len < 2)) 17989 return; 17990 17991 if (ieee80211_is_deauth(mgmt->frame_control)) { 17992 event.cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE; 17993 } else if (ieee80211_is_disassoc(mgmt->frame_control)) { 17994 event.cmd = NL80211_CMD_UNPROT_DISASSOCIATE; 17995 } else if (ieee80211_is_beacon(mgmt->frame_control)) { 17996 if (wdev->unprot_beacon_reported && 17997 elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000) 17998 return; 17999 event.cmd = NL80211_CMD_UNPROT_BEACON; 18000 wdev->unprot_beacon_reported = jiffies; 18001 } else { 18002 return; 18003 } 18004 18005 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len); 18006 nl80211_send_mlme_event(rdev, dev, &event, GFP_ATOMIC); 18007 } 18008 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt); 18009 18010 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev, 18011 struct net_device *netdev, int cmd, 18012 const u8 *addr, gfp_t gfp) 18013 { 18014 struct sk_buff *msg; 18015 void *hdr; 18016 18017 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18018 if (!msg) 18019 return; 18020 18021 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18022 if (!hdr) { 18023 nlmsg_free(msg); 18024 return; 18025 } 18026 18027 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18028 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18029 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 18030 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 18031 goto nla_put_failure; 18032 18033 genlmsg_end(msg, hdr); 18034 18035 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18036 NL80211_MCGRP_MLME, gfp); 18037 return; 18038 18039 nla_put_failure: 18040 nlmsg_free(msg); 18041 } 18042 18043 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev, 18044 struct net_device *netdev, const u8 *addr, 18045 gfp_t gfp) 18046 { 18047 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE, 18048 addr, gfp); 18049 } 18050 18051 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev, 18052 struct net_device *netdev, const u8 *addr, 18053 gfp_t gfp) 18054 { 18055 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE, 18056 addr, gfp); 18057 } 18058 18059 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev, 18060 struct net_device *netdev, 18061 struct cfg80211_connect_resp_params *cr, 18062 gfp_t gfp) 18063 { 18064 struct sk_buff *msg; 18065 void *hdr; 18066 unsigned int link; 18067 size_t link_info_size = 0; 18068 const u8 *connected_addr = cr->valid_links ? 18069 cr->ap_mld_addr : cr->links[0].bssid; 18070 18071 if (cr->valid_links) { 18072 for_each_valid_link(cr, link) { 18073 /* Nested attribute header */ 18074 link_info_size += NLA_HDRLEN; 18075 /* Link ID */ 18076 link_info_size += nla_total_size(sizeof(u8)); 18077 link_info_size += cr->links[link].addr ? 18078 nla_total_size(ETH_ALEN) : 0; 18079 link_info_size += (cr->links[link].bssid || 18080 cr->links[link].bss) ? 18081 nla_total_size(ETH_ALEN) : 0; 18082 link_info_size += nla_total_size(sizeof(u16)); 18083 } 18084 } 18085 18086 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len + 18087 cr->fils.kek_len + cr->fils.pmk_len + 18088 (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size, 18089 gfp); 18090 if (!msg) 18091 return; 18092 18093 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT); 18094 if (!hdr) { 18095 nlmsg_free(msg); 18096 return; 18097 } 18098 18099 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18100 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18101 (connected_addr && 18102 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) || 18103 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18104 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE : 18105 cr->status) || 18106 (cr->status < 0 && 18107 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 18108 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON, 18109 cr->timeout_reason))) || 18110 (cr->req_ie && 18111 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) || 18112 (cr->resp_ie && 18113 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len, 18114 cr->resp_ie)) || 18115 (cr->fils.update_erp_next_seq_num && 18116 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18117 cr->fils.erp_next_seq_num)) || 18118 (cr->status == WLAN_STATUS_SUCCESS && 18119 ((cr->fils.kek && 18120 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len, 18121 cr->fils.kek)) || 18122 (cr->fils.pmk && 18123 nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) || 18124 (cr->fils.pmkid && 18125 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid))))) 18126 goto nla_put_failure; 18127 18128 if (cr->valid_links) { 18129 int i = 1; 18130 struct nlattr *nested; 18131 18132 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18133 if (!nested) 18134 goto nla_put_failure; 18135 18136 for_each_valid_link(cr, link) { 18137 struct nlattr *nested_mlo_links; 18138 const u8 *bssid = cr->links[link].bss ? 18139 cr->links[link].bss->bssid : 18140 cr->links[link].bssid; 18141 18142 nested_mlo_links = nla_nest_start(msg, i); 18143 if (!nested_mlo_links) 18144 goto nla_put_failure; 18145 18146 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18147 (bssid && 18148 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18149 (cr->links[link].addr && 18150 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18151 cr->links[link].addr)) || 18152 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18153 cr->links[link].status)) 18154 goto nla_put_failure; 18155 18156 nla_nest_end(msg, nested_mlo_links); 18157 i++; 18158 } 18159 nla_nest_end(msg, nested); 18160 } 18161 18162 genlmsg_end(msg, hdr); 18163 18164 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18165 NL80211_MCGRP_MLME, gfp); 18166 return; 18167 18168 nla_put_failure: 18169 nlmsg_free(msg); 18170 } 18171 18172 void nl80211_send_roamed(struct cfg80211_registered_device *rdev, 18173 struct net_device *netdev, 18174 struct cfg80211_roam_info *info, gfp_t gfp) 18175 { 18176 struct sk_buff *msg; 18177 void *hdr; 18178 size_t link_info_size = 0; 18179 unsigned int link; 18180 const u8 *connected_addr = info->ap_mld_addr ? 18181 info->ap_mld_addr : 18182 (info->links[0].bss ? 18183 info->links[0].bss->bssid : 18184 info->links[0].bssid); 18185 18186 if (info->valid_links) { 18187 for_each_valid_link(info, link) { 18188 /* Nested attribute header */ 18189 link_info_size += NLA_HDRLEN; 18190 /* Link ID */ 18191 link_info_size += nla_total_size(sizeof(u8)); 18192 link_info_size += info->links[link].addr ? 18193 nla_total_size(ETH_ALEN) : 0; 18194 link_info_size += (info->links[link].bssid || 18195 info->links[link].bss) ? 18196 nla_total_size(ETH_ALEN) : 0; 18197 } 18198 } 18199 18200 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len + 18201 info->fils.kek_len + info->fils.pmk_len + 18202 (info->fils.pmkid ? WLAN_PMKID_LEN : 0) + 18203 link_info_size, gfp); 18204 if (!msg) 18205 return; 18206 18207 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM); 18208 if (!hdr) { 18209 nlmsg_free(msg); 18210 return; 18211 } 18212 18213 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18214 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18215 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) || 18216 (info->req_ie && 18217 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len, 18218 info->req_ie)) || 18219 (info->resp_ie && 18220 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len, 18221 info->resp_ie)) || 18222 (info->fils.update_erp_next_seq_num && 18223 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18224 info->fils.erp_next_seq_num)) || 18225 (info->fils.kek && 18226 nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len, 18227 info->fils.kek)) || 18228 (info->fils.pmk && 18229 nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) || 18230 (info->fils.pmkid && 18231 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid))) 18232 goto nla_put_failure; 18233 18234 if (info->valid_links) { 18235 int i = 1; 18236 struct nlattr *nested; 18237 18238 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18239 if (!nested) 18240 goto nla_put_failure; 18241 18242 for_each_valid_link(info, link) { 18243 struct nlattr *nested_mlo_links; 18244 const u8 *bssid = info->links[link].bss ? 18245 info->links[link].bss->bssid : 18246 info->links[link].bssid; 18247 18248 nested_mlo_links = nla_nest_start(msg, i); 18249 if (!nested_mlo_links) 18250 goto nla_put_failure; 18251 18252 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18253 (bssid && 18254 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18255 (info->links[link].addr && 18256 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18257 info->links[link].addr))) 18258 goto nla_put_failure; 18259 18260 nla_nest_end(msg, nested_mlo_links); 18261 i++; 18262 } 18263 nla_nest_end(msg, nested); 18264 } 18265 18266 genlmsg_end(msg, hdr); 18267 18268 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18269 NL80211_MCGRP_MLME, gfp); 18270 return; 18271 18272 nla_put_failure: 18273 nlmsg_free(msg); 18274 } 18275 18276 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev, 18277 struct net_device *netdev, const u8 *peer_addr, 18278 const u8 *td_bitmap, u8 td_bitmap_len) 18279 { 18280 struct sk_buff *msg; 18281 void *hdr; 18282 18283 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18284 if (!msg) 18285 return; 18286 18287 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED); 18288 if (!hdr) { 18289 nlmsg_free(msg); 18290 return; 18291 } 18292 18293 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18294 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18295 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr)) 18296 goto nla_put_failure; 18297 18298 if ((td_bitmap_len > 0) && td_bitmap) 18299 if (nla_put(msg, NL80211_ATTR_TD_BITMAP, 18300 td_bitmap_len, td_bitmap)) 18301 goto nla_put_failure; 18302 18303 genlmsg_end(msg, hdr); 18304 18305 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18306 NL80211_MCGRP_MLME, GFP_KERNEL); 18307 return; 18308 18309 nla_put_failure: 18310 nlmsg_free(msg); 18311 } 18312 18313 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev, 18314 struct net_device *netdev, u16 reason, 18315 const u8 *ie, size_t ie_len, bool from_ap) 18316 { 18317 struct sk_buff *msg; 18318 void *hdr; 18319 18320 msg = nlmsg_new(100 + ie_len, GFP_KERNEL); 18321 if (!msg) 18322 return; 18323 18324 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT); 18325 if (!hdr) { 18326 nlmsg_free(msg); 18327 return; 18328 } 18329 18330 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18331 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18332 (reason && 18333 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) || 18334 (from_ap && 18335 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) || 18336 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie))) 18337 goto nla_put_failure; 18338 18339 genlmsg_end(msg, hdr); 18340 18341 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18342 NL80211_MCGRP_MLME, GFP_KERNEL); 18343 return; 18344 18345 nla_put_failure: 18346 nlmsg_free(msg); 18347 } 18348 18349 void cfg80211_links_removed(struct net_device *dev, u16 link_mask) 18350 { 18351 struct wireless_dev *wdev = dev->ieee80211_ptr; 18352 struct wiphy *wiphy = wdev->wiphy; 18353 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18354 struct sk_buff *msg; 18355 struct nlattr *links; 18356 void *hdr; 18357 18358 lockdep_assert_wiphy(wdev->wiphy); 18359 trace_cfg80211_links_removed(dev, link_mask); 18360 18361 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION && 18362 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)) 18363 return; 18364 18365 if (WARN_ON(!wdev->valid_links || !link_mask || 18366 (wdev->valid_links & link_mask) != link_mask || 18367 wdev->valid_links == link_mask)) 18368 return; 18369 18370 cfg80211_wdev_release_link_bsses(wdev, link_mask); 18371 wdev->valid_links &= ~link_mask; 18372 18373 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18374 if (!msg) 18375 return; 18376 18377 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_LINKS_REMOVED); 18378 if (!hdr) { 18379 nlmsg_free(msg); 18380 return; 18381 } 18382 18383 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18384 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 18385 goto nla_put_failure; 18386 18387 links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18388 if (!links) 18389 goto nla_put_failure; 18390 18391 while (link_mask) { 18392 struct nlattr *link; 18393 int link_id = __ffs(link_mask); 18394 18395 link = nla_nest_start(msg, link_id + 1); 18396 if (!link) 18397 goto nla_put_failure; 18398 18399 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 18400 goto nla_put_failure; 18401 18402 nla_nest_end(msg, link); 18403 link_mask &= ~(1 << link_id); 18404 } 18405 18406 nla_nest_end(msg, links); 18407 18408 genlmsg_end(msg, hdr); 18409 18410 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18411 NL80211_MCGRP_MLME, GFP_KERNEL); 18412 return; 18413 18414 nla_put_failure: 18415 nlmsg_free(msg); 18416 } 18417 EXPORT_SYMBOL(cfg80211_links_removed); 18418 18419 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev, 18420 struct net_device *netdev, const u8 *bssid, 18421 gfp_t gfp) 18422 { 18423 struct sk_buff *msg; 18424 void *hdr; 18425 18426 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18427 if (!msg) 18428 return; 18429 18430 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS); 18431 if (!hdr) { 18432 nlmsg_free(msg); 18433 return; 18434 } 18435 18436 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18437 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18438 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 18439 goto nla_put_failure; 18440 18441 genlmsg_end(msg, hdr); 18442 18443 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18444 NL80211_MCGRP_MLME, gfp); 18445 return; 18446 18447 nla_put_failure: 18448 nlmsg_free(msg); 18449 } 18450 18451 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr, 18452 const u8 *ie, u8 ie_len, 18453 int sig_dbm, gfp_t gfp) 18454 { 18455 struct wireless_dev *wdev = dev->ieee80211_ptr; 18456 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18457 struct sk_buff *msg; 18458 void *hdr; 18459 18460 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT)) 18461 return; 18462 18463 trace_cfg80211_notify_new_peer_candidate(dev, addr); 18464 18465 msg = nlmsg_new(100 + ie_len, gfp); 18466 if (!msg) 18467 return; 18468 18469 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE); 18470 if (!hdr) { 18471 nlmsg_free(msg); 18472 return; 18473 } 18474 18475 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18476 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18477 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 18478 (ie_len && ie && 18479 nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) || 18480 (sig_dbm && 18481 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm))) 18482 goto nla_put_failure; 18483 18484 genlmsg_end(msg, hdr); 18485 18486 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18487 NL80211_MCGRP_MLME, gfp); 18488 return; 18489 18490 nla_put_failure: 18491 nlmsg_free(msg); 18492 } 18493 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate); 18494 18495 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev, 18496 struct net_device *netdev, const u8 *addr, 18497 enum nl80211_key_type key_type, int key_id, 18498 const u8 *tsc, gfp_t gfp) 18499 { 18500 struct sk_buff *msg; 18501 void *hdr; 18502 18503 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18504 if (!msg) 18505 return; 18506 18507 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE); 18508 if (!hdr) { 18509 nlmsg_free(msg); 18510 return; 18511 } 18512 18513 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18514 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18515 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) || 18516 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) || 18517 (key_id != -1 && 18518 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) || 18519 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc))) 18520 goto nla_put_failure; 18521 18522 genlmsg_end(msg, hdr); 18523 18524 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18525 NL80211_MCGRP_MLME, gfp); 18526 return; 18527 18528 nla_put_failure: 18529 nlmsg_free(msg); 18530 } 18531 18532 void nl80211_send_beacon_hint_event(struct wiphy *wiphy, 18533 struct ieee80211_channel *channel_before, 18534 struct ieee80211_channel *channel_after) 18535 { 18536 struct sk_buff *msg; 18537 void *hdr; 18538 struct nlattr *nl_freq; 18539 18540 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC); 18541 if (!msg) 18542 return; 18543 18544 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT); 18545 if (!hdr) { 18546 nlmsg_free(msg); 18547 return; 18548 } 18549 18550 /* 18551 * Since we are applying the beacon hint to a wiphy we know its 18552 * wiphy_idx is valid 18553 */ 18554 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 18555 goto nla_put_failure; 18556 18557 /* Before */ 18558 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE); 18559 if (!nl_freq) 18560 goto nla_put_failure; 18561 18562 if (nl80211_msg_put_channel(msg, wiphy, channel_before, false)) 18563 goto nla_put_failure; 18564 nla_nest_end(msg, nl_freq); 18565 18566 /* After */ 18567 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER); 18568 if (!nl_freq) 18569 goto nla_put_failure; 18570 18571 if (nl80211_msg_put_channel(msg, wiphy, channel_after, false)) 18572 goto nla_put_failure; 18573 nla_nest_end(msg, nl_freq); 18574 18575 genlmsg_end(msg, hdr); 18576 18577 rcu_read_lock(); 18578 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 18579 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 18580 rcu_read_unlock(); 18581 18582 return; 18583 18584 nla_put_failure: 18585 nlmsg_free(msg); 18586 } 18587 18588 static void nl80211_send_remain_on_chan_event( 18589 int cmd, struct cfg80211_registered_device *rdev, 18590 struct wireless_dev *wdev, u64 cookie, 18591 struct ieee80211_channel *chan, 18592 unsigned int duration, gfp_t gfp) 18593 { 18594 struct sk_buff *msg; 18595 void *hdr; 18596 18597 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18598 if (!msg) 18599 return; 18600 18601 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18602 if (!hdr) { 18603 nlmsg_free(msg); 18604 return; 18605 } 18606 18607 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18608 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18609 wdev->netdev->ifindex)) || 18610 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18611 NL80211_ATTR_PAD) || 18612 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) || 18613 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 18614 NL80211_CHAN_NO_HT) || 18615 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 18616 NL80211_ATTR_PAD)) 18617 goto nla_put_failure; 18618 18619 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL && 18620 nla_put_u32(msg, NL80211_ATTR_DURATION, duration)) 18621 goto nla_put_failure; 18622 18623 genlmsg_end(msg, hdr); 18624 18625 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18626 NL80211_MCGRP_MLME, gfp); 18627 return; 18628 18629 nla_put_failure: 18630 nlmsg_free(msg); 18631 } 18632 18633 void cfg80211_assoc_comeback(struct net_device *netdev, 18634 const u8 *ap_addr, u32 timeout) 18635 { 18636 struct wireless_dev *wdev = netdev->ieee80211_ptr; 18637 struct wiphy *wiphy = wdev->wiphy; 18638 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18639 struct sk_buff *msg; 18640 void *hdr; 18641 18642 trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout); 18643 18644 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18645 if (!msg) 18646 return; 18647 18648 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK); 18649 if (!hdr) { 18650 nlmsg_free(msg); 18651 return; 18652 } 18653 18654 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18655 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18656 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) || 18657 nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout)) 18658 goto nla_put_failure; 18659 18660 genlmsg_end(msg, hdr); 18661 18662 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18663 NL80211_MCGRP_MLME, GFP_KERNEL); 18664 return; 18665 18666 nla_put_failure: 18667 nlmsg_free(msg); 18668 } 18669 EXPORT_SYMBOL(cfg80211_assoc_comeback); 18670 18671 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie, 18672 struct ieee80211_channel *chan, 18673 unsigned int duration, gfp_t gfp) 18674 { 18675 struct wiphy *wiphy = wdev->wiphy; 18676 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18677 18678 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration); 18679 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL, 18680 rdev, wdev, cookie, chan, 18681 duration, gfp); 18682 } 18683 EXPORT_SYMBOL(cfg80211_ready_on_channel); 18684 18685 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie, 18686 struct ieee80211_channel *chan, 18687 gfp_t gfp) 18688 { 18689 struct wiphy *wiphy = wdev->wiphy; 18690 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18691 18692 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan); 18693 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 18694 rdev, wdev, cookie, chan, 0, gfp); 18695 } 18696 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired); 18697 18698 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie, 18699 struct ieee80211_channel *chan, 18700 gfp_t gfp) 18701 { 18702 struct wiphy *wiphy = wdev->wiphy; 18703 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18704 18705 trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan); 18706 nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL, 18707 rdev, wdev, cookie, chan, 0, gfp); 18708 } 18709 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired); 18710 18711 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr, 18712 struct station_info *sinfo, gfp_t gfp) 18713 { 18714 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18715 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18716 struct sk_buff *msg; 18717 18718 trace_cfg80211_new_sta(dev, mac_addr, sinfo); 18719 18720 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18721 if (!msg) 18722 return; 18723 18724 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0, 18725 rdev, dev, mac_addr, sinfo) < 0) { 18726 nlmsg_free(msg); 18727 return; 18728 } 18729 18730 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18731 NL80211_MCGRP_MLME, gfp); 18732 } 18733 EXPORT_SYMBOL(cfg80211_new_sta); 18734 18735 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr, 18736 struct station_info *sinfo, gfp_t gfp) 18737 { 18738 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18739 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18740 struct sk_buff *msg; 18741 struct station_info empty_sinfo = {}; 18742 18743 if (!sinfo) 18744 sinfo = &empty_sinfo; 18745 18746 trace_cfg80211_del_sta(dev, mac_addr); 18747 18748 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18749 if (!msg) { 18750 cfg80211_sinfo_release_content(sinfo); 18751 return; 18752 } 18753 18754 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0, 18755 rdev, dev, mac_addr, sinfo) < 0) { 18756 nlmsg_free(msg); 18757 return; 18758 } 18759 18760 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18761 NL80211_MCGRP_MLME, gfp); 18762 } 18763 EXPORT_SYMBOL(cfg80211_del_sta_sinfo); 18764 18765 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr, 18766 enum nl80211_connect_failed_reason reason, 18767 gfp_t gfp) 18768 { 18769 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18770 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18771 struct sk_buff *msg; 18772 void *hdr; 18773 18774 msg = nlmsg_new(NLMSG_GOODSIZE, gfp); 18775 if (!msg) 18776 return; 18777 18778 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED); 18779 if (!hdr) { 18780 nlmsg_free(msg); 18781 return; 18782 } 18783 18784 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18785 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 18786 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason)) 18787 goto nla_put_failure; 18788 18789 genlmsg_end(msg, hdr); 18790 18791 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18792 NL80211_MCGRP_MLME, gfp); 18793 return; 18794 18795 nla_put_failure: 18796 nlmsg_free(msg); 18797 } 18798 EXPORT_SYMBOL(cfg80211_conn_failed); 18799 18800 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd, 18801 const u8 *addr, gfp_t gfp) 18802 { 18803 struct wireless_dev *wdev = dev->ieee80211_ptr; 18804 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18805 struct sk_buff *msg; 18806 void *hdr; 18807 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid); 18808 18809 if (!nlportid) 18810 return false; 18811 18812 msg = nlmsg_new(100, gfp); 18813 if (!msg) 18814 return true; 18815 18816 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18817 if (!hdr) { 18818 nlmsg_free(msg); 18819 return true; 18820 } 18821 18822 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18823 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18824 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 18825 goto nla_put_failure; 18826 18827 genlmsg_end(msg, hdr); 18828 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 18829 return true; 18830 18831 nla_put_failure: 18832 nlmsg_free(msg); 18833 return true; 18834 } 18835 18836 bool cfg80211_rx_spurious_frame(struct net_device *dev, 18837 const u8 *addr, gfp_t gfp) 18838 { 18839 struct wireless_dev *wdev = dev->ieee80211_ptr; 18840 bool ret; 18841 18842 trace_cfg80211_rx_spurious_frame(dev, addr); 18843 18844 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 18845 wdev->iftype != NL80211_IFTYPE_P2P_GO)) { 18846 trace_cfg80211_return_bool(false); 18847 return false; 18848 } 18849 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME, 18850 addr, gfp); 18851 trace_cfg80211_return_bool(ret); 18852 return ret; 18853 } 18854 EXPORT_SYMBOL(cfg80211_rx_spurious_frame); 18855 18856 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev, 18857 const u8 *addr, gfp_t gfp) 18858 { 18859 struct wireless_dev *wdev = dev->ieee80211_ptr; 18860 bool ret; 18861 18862 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr); 18863 18864 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 18865 wdev->iftype != NL80211_IFTYPE_P2P_GO && 18866 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) { 18867 trace_cfg80211_return_bool(false); 18868 return false; 18869 } 18870 ret = __nl80211_unexpected_frame(dev, 18871 NL80211_CMD_UNEXPECTED_4ADDR_FRAME, 18872 addr, gfp); 18873 trace_cfg80211_return_bool(ret); 18874 return ret; 18875 } 18876 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame); 18877 18878 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev, 18879 struct wireless_dev *wdev, u32 nlportid, 18880 struct cfg80211_rx_info *info, gfp_t gfp) 18881 { 18882 struct net_device *netdev = wdev->netdev; 18883 struct sk_buff *msg; 18884 void *hdr; 18885 18886 msg = nlmsg_new(100 + info->len, gfp); 18887 if (!msg) 18888 return -ENOMEM; 18889 18890 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 18891 if (!hdr) { 18892 nlmsg_free(msg); 18893 return -ENOMEM; 18894 } 18895 18896 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18897 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18898 netdev->ifindex)) || 18899 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18900 NL80211_ATTR_PAD) || 18901 (info->have_link_id && 18902 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) || 18903 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) || 18904 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) || 18905 (info->sig_dbm && 18906 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) || 18907 nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) || 18908 (info->flags && 18909 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) || 18910 (info->rx_tstamp && nla_put_u64_64bit(msg, 18911 NL80211_ATTR_RX_HW_TIMESTAMP, 18912 info->rx_tstamp, 18913 NL80211_ATTR_PAD)) || 18914 (info->ack_tstamp && nla_put_u64_64bit(msg, 18915 NL80211_ATTR_TX_HW_TIMESTAMP, 18916 info->ack_tstamp, 18917 NL80211_ATTR_PAD))) 18918 goto nla_put_failure; 18919 18920 genlmsg_end(msg, hdr); 18921 18922 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 18923 18924 nla_put_failure: 18925 nlmsg_free(msg); 18926 return -ENOBUFS; 18927 } 18928 18929 static void nl80211_frame_tx_status(struct wireless_dev *wdev, 18930 struct cfg80211_tx_status *status, 18931 gfp_t gfp, enum nl80211_commands command) 18932 { 18933 struct wiphy *wiphy = wdev->wiphy; 18934 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18935 struct net_device *netdev = wdev->netdev; 18936 struct sk_buff *msg; 18937 void *hdr; 18938 18939 if (command == NL80211_CMD_FRAME_TX_STATUS) 18940 trace_cfg80211_mgmt_tx_status(wdev, status->cookie, 18941 status->ack); 18942 else 18943 trace_cfg80211_control_port_tx_status(wdev, status->cookie, 18944 status->ack); 18945 18946 msg = nlmsg_new(100 + status->len, gfp); 18947 if (!msg) 18948 return; 18949 18950 hdr = nl80211hdr_put(msg, 0, 0, 0, command); 18951 if (!hdr) { 18952 nlmsg_free(msg); 18953 return; 18954 } 18955 18956 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18957 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18958 netdev->ifindex)) || 18959 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18960 NL80211_ATTR_PAD) || 18961 nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) || 18962 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie, 18963 NL80211_ATTR_PAD) || 18964 (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) || 18965 (status->tx_tstamp && 18966 nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP, 18967 status->tx_tstamp, NL80211_ATTR_PAD)) || 18968 (status->ack_tstamp && 18969 nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP, 18970 status->ack_tstamp, NL80211_ATTR_PAD))) 18971 goto nla_put_failure; 18972 18973 genlmsg_end(msg, hdr); 18974 18975 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18976 NL80211_MCGRP_MLME, gfp); 18977 return; 18978 18979 nla_put_failure: 18980 nlmsg_free(msg); 18981 } 18982 18983 void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie, 18984 const u8 *buf, size_t len, bool ack, 18985 gfp_t gfp) 18986 { 18987 struct cfg80211_tx_status status = { 18988 .cookie = cookie, 18989 .buf = buf, 18990 .len = len, 18991 .ack = ack 18992 }; 18993 18994 nl80211_frame_tx_status(wdev, &status, gfp, 18995 NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS); 18996 } 18997 EXPORT_SYMBOL(cfg80211_control_port_tx_status); 18998 18999 void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev, 19000 struct cfg80211_tx_status *status, gfp_t gfp) 19001 { 19002 nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS); 19003 } 19004 EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext); 19005 19006 static int __nl80211_rx_control_port(struct net_device *dev, 19007 struct sk_buff *skb, 19008 bool unencrypted, 19009 int link_id, 19010 gfp_t gfp) 19011 { 19012 struct wireless_dev *wdev = dev->ieee80211_ptr; 19013 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19014 struct ethhdr *ehdr = eth_hdr(skb); 19015 const u8 *addr = ehdr->h_source; 19016 u16 proto = be16_to_cpu(skb->protocol); 19017 struct sk_buff *msg; 19018 void *hdr; 19019 struct nlattr *frame; 19020 19021 u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid); 19022 19023 if (!nlportid) 19024 return -ENOENT; 19025 19026 msg = nlmsg_new(100 + skb->len, gfp); 19027 if (!msg) 19028 return -ENOMEM; 19029 19030 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME); 19031 if (!hdr) { 19032 nlmsg_free(msg); 19033 return -ENOBUFS; 19034 } 19035 19036 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19037 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19038 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19039 NL80211_ATTR_PAD) || 19040 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19041 nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) || 19042 (link_id >= 0 && 19043 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) || 19044 (unencrypted && nla_put_flag(msg, 19045 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT))) 19046 goto nla_put_failure; 19047 19048 frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len); 19049 if (!frame) 19050 goto nla_put_failure; 19051 19052 skb_copy_bits(skb, 0, nla_data(frame), skb->len); 19053 genlmsg_end(msg, hdr); 19054 19055 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 19056 19057 nla_put_failure: 19058 nlmsg_free(msg); 19059 return -ENOBUFS; 19060 } 19061 19062 bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb, 19063 bool unencrypted, int link_id) 19064 { 19065 int ret; 19066 19067 trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id); 19068 ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id, 19069 GFP_ATOMIC); 19070 trace_cfg80211_return_bool(ret == 0); 19071 return ret == 0; 19072 } 19073 EXPORT_SYMBOL(cfg80211_rx_control_port); 19074 19075 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev, 19076 const char *mac, gfp_t gfp) 19077 { 19078 struct wireless_dev *wdev = dev->ieee80211_ptr; 19079 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19080 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19081 void **cb; 19082 19083 if (!msg) 19084 return NULL; 19085 19086 cb = (void **)msg->cb; 19087 19088 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM); 19089 if (!cb[0]) { 19090 nlmsg_free(msg); 19091 return NULL; 19092 } 19093 19094 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19095 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19096 goto nla_put_failure; 19097 19098 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 19099 goto nla_put_failure; 19100 19101 cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM); 19102 if (!cb[1]) 19103 goto nla_put_failure; 19104 19105 cb[2] = rdev; 19106 19107 return msg; 19108 nla_put_failure: 19109 nlmsg_free(msg); 19110 return NULL; 19111 } 19112 19113 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp) 19114 { 19115 void **cb = (void **)msg->cb; 19116 struct cfg80211_registered_device *rdev = cb[2]; 19117 19118 nla_nest_end(msg, cb[1]); 19119 genlmsg_end(msg, cb[0]); 19120 19121 memset(msg->cb, 0, sizeof(msg->cb)); 19122 19123 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19124 NL80211_MCGRP_MLME, gfp); 19125 } 19126 19127 void cfg80211_cqm_rssi_notify(struct net_device *dev, 19128 enum nl80211_cqm_rssi_threshold_event rssi_event, 19129 s32 rssi_level, gfp_t gfp) 19130 { 19131 struct wireless_dev *wdev = dev->ieee80211_ptr; 19132 struct cfg80211_cqm_config *cqm_config; 19133 19134 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level); 19135 19136 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW && 19137 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH)) 19138 return; 19139 19140 rcu_read_lock(); 19141 cqm_config = rcu_dereference(wdev->cqm_config); 19142 if (cqm_config) { 19143 cqm_config->last_rssi_event_value = rssi_level; 19144 cqm_config->last_rssi_event_type = rssi_event; 19145 wiphy_work_queue(wdev->wiphy, &wdev->cqm_rssi_work); 19146 } 19147 rcu_read_unlock(); 19148 } 19149 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify); 19150 19151 void cfg80211_cqm_rssi_notify_work(struct wiphy *wiphy, struct wiphy_work *work) 19152 { 19153 struct wireless_dev *wdev = container_of(work, struct wireless_dev, 19154 cqm_rssi_work); 19155 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19156 enum nl80211_cqm_rssi_threshold_event rssi_event; 19157 struct cfg80211_cqm_config *cqm_config; 19158 struct sk_buff *msg; 19159 s32 rssi_level; 19160 19161 cqm_config = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 19162 if (!cqm_config) 19163 return; 19164 19165 if (cqm_config->use_range_api) 19166 cfg80211_cqm_rssi_update(rdev, wdev->netdev, cqm_config); 19167 19168 rssi_level = cqm_config->last_rssi_event_value; 19169 rssi_event = cqm_config->last_rssi_event_type; 19170 19171 msg = cfg80211_prepare_cqm(wdev->netdev, NULL, GFP_KERNEL); 19172 if (!msg) 19173 return; 19174 19175 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT, 19176 rssi_event)) 19177 goto nla_put_failure; 19178 19179 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL, 19180 rssi_level)) 19181 goto nla_put_failure; 19182 19183 cfg80211_send_cqm(msg, GFP_KERNEL); 19184 19185 return; 19186 19187 nla_put_failure: 19188 nlmsg_free(msg); 19189 } 19190 19191 void cfg80211_cqm_txe_notify(struct net_device *dev, 19192 const u8 *peer, u32 num_packets, 19193 u32 rate, u32 intvl, gfp_t gfp) 19194 { 19195 struct sk_buff *msg; 19196 19197 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19198 if (!msg) 19199 return; 19200 19201 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets)) 19202 goto nla_put_failure; 19203 19204 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate)) 19205 goto nla_put_failure; 19206 19207 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl)) 19208 goto nla_put_failure; 19209 19210 cfg80211_send_cqm(msg, gfp); 19211 return; 19212 19213 nla_put_failure: 19214 nlmsg_free(msg); 19215 } 19216 EXPORT_SYMBOL(cfg80211_cqm_txe_notify); 19217 19218 void cfg80211_cqm_pktloss_notify(struct net_device *dev, 19219 const u8 *peer, u32 num_packets, gfp_t gfp) 19220 { 19221 struct sk_buff *msg; 19222 19223 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets); 19224 19225 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19226 if (!msg) 19227 return; 19228 19229 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets)) 19230 goto nla_put_failure; 19231 19232 cfg80211_send_cqm(msg, gfp); 19233 return; 19234 19235 nla_put_failure: 19236 nlmsg_free(msg); 19237 } 19238 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify); 19239 19240 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp) 19241 { 19242 struct sk_buff *msg; 19243 19244 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 19245 if (!msg) 19246 return; 19247 19248 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT)) 19249 goto nla_put_failure; 19250 19251 cfg80211_send_cqm(msg, gfp); 19252 return; 19253 19254 nla_put_failure: 19255 nlmsg_free(msg); 19256 } 19257 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify); 19258 19259 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev, 19260 struct net_device *netdev, const u8 *bssid, 19261 const u8 *replay_ctr, gfp_t gfp) 19262 { 19263 struct sk_buff *msg; 19264 struct nlattr *rekey_attr; 19265 void *hdr; 19266 19267 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19268 if (!msg) 19269 return; 19270 19271 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD); 19272 if (!hdr) { 19273 nlmsg_free(msg); 19274 return; 19275 } 19276 19277 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19278 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19279 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 19280 goto nla_put_failure; 19281 19282 rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA); 19283 if (!rekey_attr) 19284 goto nla_put_failure; 19285 19286 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR, 19287 NL80211_REPLAY_CTR_LEN, replay_ctr)) 19288 goto nla_put_failure; 19289 19290 nla_nest_end(msg, rekey_attr); 19291 19292 genlmsg_end(msg, hdr); 19293 19294 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19295 NL80211_MCGRP_MLME, gfp); 19296 return; 19297 19298 nla_put_failure: 19299 nlmsg_free(msg); 19300 } 19301 19302 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid, 19303 const u8 *replay_ctr, gfp_t gfp) 19304 { 19305 struct wireless_dev *wdev = dev->ieee80211_ptr; 19306 struct wiphy *wiphy = wdev->wiphy; 19307 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19308 19309 trace_cfg80211_gtk_rekey_notify(dev, bssid); 19310 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp); 19311 } 19312 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify); 19313 19314 static void 19315 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev, 19316 struct net_device *netdev, int index, 19317 const u8 *bssid, bool preauth, gfp_t gfp) 19318 { 19319 struct sk_buff *msg; 19320 struct nlattr *attr; 19321 void *hdr; 19322 19323 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19324 if (!msg) 19325 return; 19326 19327 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE); 19328 if (!hdr) { 19329 nlmsg_free(msg); 19330 return; 19331 } 19332 19333 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19334 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19335 goto nla_put_failure; 19336 19337 attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE); 19338 if (!attr) 19339 goto nla_put_failure; 19340 19341 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) || 19342 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) || 19343 (preauth && 19344 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH))) 19345 goto nla_put_failure; 19346 19347 nla_nest_end(msg, attr); 19348 19349 genlmsg_end(msg, hdr); 19350 19351 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19352 NL80211_MCGRP_MLME, gfp); 19353 return; 19354 19355 nla_put_failure: 19356 nlmsg_free(msg); 19357 } 19358 19359 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index, 19360 const u8 *bssid, bool preauth, gfp_t gfp) 19361 { 19362 struct wireless_dev *wdev = dev->ieee80211_ptr; 19363 struct wiphy *wiphy = wdev->wiphy; 19364 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19365 19366 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth); 19367 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp); 19368 } 19369 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify); 19370 19371 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev, 19372 struct net_device *netdev, 19373 unsigned int link_id, 19374 struct cfg80211_chan_def *chandef, 19375 gfp_t gfp, 19376 enum nl80211_commands notif, 19377 u8 count, bool quiet) 19378 { 19379 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19380 struct sk_buff *msg; 19381 void *hdr; 19382 19383 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19384 if (!msg) 19385 return; 19386 19387 hdr = nl80211hdr_put(msg, 0, 0, 0, notif); 19388 if (!hdr) { 19389 nlmsg_free(msg); 19390 return; 19391 } 19392 19393 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19394 goto nla_put_failure; 19395 19396 if (wdev->valid_links && 19397 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19398 goto nla_put_failure; 19399 19400 if (nl80211_send_chandef(msg, chandef)) 19401 goto nla_put_failure; 19402 19403 if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) { 19404 if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)) 19405 goto nla_put_failure; 19406 if (quiet && 19407 nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX)) 19408 goto nla_put_failure; 19409 } 19410 19411 genlmsg_end(msg, hdr); 19412 19413 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19414 NL80211_MCGRP_MLME, gfp); 19415 return; 19416 19417 nla_put_failure: 19418 nlmsg_free(msg); 19419 } 19420 19421 void cfg80211_ch_switch_notify(struct net_device *dev, 19422 struct cfg80211_chan_def *chandef, 19423 unsigned int link_id) 19424 { 19425 struct wireless_dev *wdev = dev->ieee80211_ptr; 19426 struct wiphy *wiphy = wdev->wiphy; 19427 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19428 19429 lockdep_assert_wiphy(wdev->wiphy); 19430 WARN_INVALID_LINK_ID(wdev, link_id); 19431 19432 trace_cfg80211_ch_switch_notify(dev, chandef, link_id); 19433 19434 switch (wdev->iftype) { 19435 case NL80211_IFTYPE_STATION: 19436 case NL80211_IFTYPE_P2P_CLIENT: 19437 if (!WARN_ON(!wdev->links[link_id].client.current_bss)) 19438 cfg80211_update_assoc_bss_entry(wdev, link_id, 19439 chandef->chan); 19440 break; 19441 case NL80211_IFTYPE_MESH_POINT: 19442 wdev->u.mesh.chandef = *chandef; 19443 wdev->u.mesh.preset_chandef = *chandef; 19444 break; 19445 case NL80211_IFTYPE_AP: 19446 case NL80211_IFTYPE_P2P_GO: 19447 wdev->links[link_id].ap.chandef = *chandef; 19448 break; 19449 case NL80211_IFTYPE_ADHOC: 19450 wdev->u.ibss.chandef = *chandef; 19451 break; 19452 default: 19453 WARN_ON(1); 19454 break; 19455 } 19456 19457 cfg80211_schedule_channels_check(wdev); 19458 cfg80211_sched_dfs_chan_update(rdev); 19459 19460 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19461 NL80211_CMD_CH_SWITCH_NOTIFY, 0, false); 19462 } 19463 EXPORT_SYMBOL(cfg80211_ch_switch_notify); 19464 19465 void cfg80211_ch_switch_started_notify(struct net_device *dev, 19466 struct cfg80211_chan_def *chandef, 19467 unsigned int link_id, u8 count, 19468 bool quiet) 19469 { 19470 struct wireless_dev *wdev = dev->ieee80211_ptr; 19471 struct wiphy *wiphy = wdev->wiphy; 19472 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19473 19474 lockdep_assert_wiphy(wdev->wiphy); 19475 WARN_INVALID_LINK_ID(wdev, link_id); 19476 19477 trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id); 19478 19479 19480 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19481 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, 19482 count, quiet); 19483 } 19484 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify); 19485 19486 int cfg80211_bss_color_notify(struct net_device *dev, 19487 enum nl80211_commands cmd, u8 count, 19488 u64 color_bitmap, u8 link_id) 19489 { 19490 struct wireless_dev *wdev = dev->ieee80211_ptr; 19491 struct wiphy *wiphy = wdev->wiphy; 19492 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19493 struct sk_buff *msg; 19494 void *hdr; 19495 19496 lockdep_assert_wiphy(wdev->wiphy); 19497 19498 trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap); 19499 19500 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19501 if (!msg) 19502 return -ENOMEM; 19503 19504 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19505 if (!hdr) 19506 goto nla_put_failure; 19507 19508 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19509 goto nla_put_failure; 19510 19511 if (wdev->valid_links && 19512 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19513 goto nla_put_failure; 19514 19515 if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED && 19516 nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count)) 19517 goto nla_put_failure; 19518 19519 if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION && 19520 nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP, 19521 color_bitmap, NL80211_ATTR_PAD)) 19522 goto nla_put_failure; 19523 19524 genlmsg_end(msg, hdr); 19525 19526 return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 19527 msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL); 19528 19529 nla_put_failure: 19530 nlmsg_free(msg); 19531 return -EINVAL; 19532 } 19533 EXPORT_SYMBOL(cfg80211_bss_color_notify); 19534 19535 void 19536 nl80211_radar_notify(struct cfg80211_registered_device *rdev, 19537 const struct cfg80211_chan_def *chandef, 19538 enum nl80211_radar_event event, 19539 struct net_device *netdev, gfp_t gfp) 19540 { 19541 struct sk_buff *msg; 19542 void *hdr; 19543 19544 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19545 if (!msg) 19546 return; 19547 19548 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT); 19549 if (!hdr) { 19550 nlmsg_free(msg); 19551 return; 19552 } 19553 19554 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19555 goto nla_put_failure; 19556 19557 /* NOP and radar events don't need a netdev parameter */ 19558 if (netdev) { 19559 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19560 19561 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19562 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19563 NL80211_ATTR_PAD)) 19564 goto nla_put_failure; 19565 } 19566 19567 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event)) 19568 goto nla_put_failure; 19569 19570 if (nl80211_send_chandef(msg, chandef)) 19571 goto nla_put_failure; 19572 19573 genlmsg_end(msg, hdr); 19574 19575 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19576 NL80211_MCGRP_MLME, gfp); 19577 return; 19578 19579 nla_put_failure: 19580 nlmsg_free(msg); 19581 } 19582 19583 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac, 19584 struct sta_opmode_info *sta_opmode, 19585 gfp_t gfp) 19586 { 19587 struct sk_buff *msg; 19588 struct wireless_dev *wdev = dev->ieee80211_ptr; 19589 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19590 void *hdr; 19591 19592 if (WARN_ON(!mac)) 19593 return; 19594 19595 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19596 if (!msg) 19597 return; 19598 19599 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED); 19600 if (!hdr) { 19601 nlmsg_free(msg); 19602 return; 19603 } 19604 19605 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19606 goto nla_put_failure; 19607 19608 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19609 goto nla_put_failure; 19610 19611 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 19612 goto nla_put_failure; 19613 19614 if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) && 19615 nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode)) 19616 goto nla_put_failure; 19617 19618 if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) && 19619 nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw)) 19620 goto nla_put_failure; 19621 19622 if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) && 19623 nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss)) 19624 goto nla_put_failure; 19625 19626 genlmsg_end(msg, hdr); 19627 19628 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19629 NL80211_MCGRP_MLME, gfp); 19630 19631 return; 19632 19633 nla_put_failure: 19634 nlmsg_free(msg); 19635 } 19636 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify); 19637 19638 void cfg80211_probe_status(struct net_device *dev, const u8 *addr, 19639 u64 cookie, bool acked, s32 ack_signal, 19640 bool is_valid_ack_signal, gfp_t gfp) 19641 { 19642 struct wireless_dev *wdev = dev->ieee80211_ptr; 19643 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19644 struct sk_buff *msg; 19645 void *hdr; 19646 19647 trace_cfg80211_probe_status(dev, addr, cookie, acked); 19648 19649 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19650 19651 if (!msg) 19652 return; 19653 19654 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT); 19655 if (!hdr) { 19656 nlmsg_free(msg); 19657 return; 19658 } 19659 19660 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19661 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19662 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19663 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 19664 NL80211_ATTR_PAD) || 19665 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) || 19666 (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL, 19667 ack_signal))) 19668 goto nla_put_failure; 19669 19670 genlmsg_end(msg, hdr); 19671 19672 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19673 NL80211_MCGRP_MLME, gfp); 19674 return; 19675 19676 nla_put_failure: 19677 nlmsg_free(msg); 19678 } 19679 EXPORT_SYMBOL(cfg80211_probe_status); 19680 19681 void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame, 19682 size_t len, int freq, int sig_dbm) 19683 { 19684 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19685 struct sk_buff *msg; 19686 void *hdr; 19687 struct cfg80211_beacon_registration *reg; 19688 19689 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm); 19690 19691 spin_lock_bh(&rdev->beacon_registrations_lock); 19692 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 19693 msg = nlmsg_new(len + 100, GFP_ATOMIC); 19694 if (!msg) { 19695 spin_unlock_bh(&rdev->beacon_registrations_lock); 19696 return; 19697 } 19698 19699 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 19700 if (!hdr) 19701 goto nla_put_failure; 19702 19703 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19704 (freq && 19705 (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 19706 KHZ_TO_MHZ(freq)) || 19707 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 19708 freq % 1000))) || 19709 (sig_dbm && 19710 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 19711 nla_put(msg, NL80211_ATTR_FRAME, len, frame)) 19712 goto nla_put_failure; 19713 19714 genlmsg_end(msg, hdr); 19715 19716 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid); 19717 } 19718 spin_unlock_bh(&rdev->beacon_registrations_lock); 19719 return; 19720 19721 nla_put_failure: 19722 spin_unlock_bh(&rdev->beacon_registrations_lock); 19723 nlmsg_free(msg); 19724 } 19725 EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz); 19726 19727 #ifdef CONFIG_PM 19728 static int cfg80211_net_detect_results(struct sk_buff *msg, 19729 struct cfg80211_wowlan_wakeup *wakeup) 19730 { 19731 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect; 19732 struct nlattr *nl_results, *nl_match, *nl_freqs; 19733 int i, j; 19734 19735 nl_results = nla_nest_start_noflag(msg, 19736 NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS); 19737 if (!nl_results) 19738 return -EMSGSIZE; 19739 19740 for (i = 0; i < nd->n_matches; i++) { 19741 struct cfg80211_wowlan_nd_match *match = nd->matches[i]; 19742 19743 nl_match = nla_nest_start_noflag(msg, i); 19744 if (!nl_match) 19745 break; 19746 19747 /* The SSID attribute is optional in nl80211, but for 19748 * simplicity reasons it's always present in the 19749 * cfg80211 structure. If a driver can't pass the 19750 * SSID, that needs to be changed. A zero length SSID 19751 * is still a valid SSID (wildcard), so it cannot be 19752 * used for this purpose. 19753 */ 19754 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len, 19755 match->ssid.ssid)) { 19756 nla_nest_cancel(msg, nl_match); 19757 goto out; 19758 } 19759 19760 if (match->n_channels) { 19761 nl_freqs = nla_nest_start_noflag(msg, 19762 NL80211_ATTR_SCAN_FREQUENCIES); 19763 if (!nl_freqs) { 19764 nla_nest_cancel(msg, nl_match); 19765 goto out; 19766 } 19767 19768 for (j = 0; j < match->n_channels; j++) { 19769 if (nla_put_u32(msg, j, match->channels[j])) { 19770 nla_nest_cancel(msg, nl_freqs); 19771 nla_nest_cancel(msg, nl_match); 19772 goto out; 19773 } 19774 } 19775 19776 nla_nest_end(msg, nl_freqs); 19777 } 19778 19779 nla_nest_end(msg, nl_match); 19780 } 19781 19782 out: 19783 nla_nest_end(msg, nl_results); 19784 return 0; 19785 } 19786 19787 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev, 19788 struct cfg80211_wowlan_wakeup *wakeup, 19789 gfp_t gfp) 19790 { 19791 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19792 struct sk_buff *msg; 19793 void *hdr; 19794 int size = 200; 19795 19796 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup); 19797 19798 if (wakeup) 19799 size += wakeup->packet_present_len; 19800 19801 msg = nlmsg_new(size, gfp); 19802 if (!msg) 19803 return; 19804 19805 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN); 19806 if (!hdr) 19807 goto free_msg; 19808 19809 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19810 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19811 NL80211_ATTR_PAD)) 19812 goto free_msg; 19813 19814 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 19815 wdev->netdev->ifindex)) 19816 goto free_msg; 19817 19818 if (wakeup) { 19819 struct nlattr *reasons; 19820 19821 reasons = nla_nest_start_noflag(msg, 19822 NL80211_ATTR_WOWLAN_TRIGGERS); 19823 if (!reasons) 19824 goto free_msg; 19825 19826 if (wakeup->disconnect && 19827 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) 19828 goto free_msg; 19829 if (wakeup->magic_pkt && 19830 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) 19831 goto free_msg; 19832 if (wakeup->gtk_rekey_failure && 19833 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) 19834 goto free_msg; 19835 if (wakeup->eap_identity_req && 19836 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) 19837 goto free_msg; 19838 if (wakeup->four_way_handshake && 19839 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) 19840 goto free_msg; 19841 if (wakeup->rfkill_release && 19842 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)) 19843 goto free_msg; 19844 19845 if (wakeup->pattern_idx >= 0 && 19846 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 19847 wakeup->pattern_idx)) 19848 goto free_msg; 19849 19850 if (wakeup->tcp_match && 19851 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH)) 19852 goto free_msg; 19853 19854 if (wakeup->tcp_connlost && 19855 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST)) 19856 goto free_msg; 19857 19858 if (wakeup->tcp_nomoretokens && 19859 nla_put_flag(msg, 19860 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS)) 19861 goto free_msg; 19862 19863 if (wakeup->unprot_deauth_disassoc && 19864 nla_put_flag(msg, 19865 NL80211_WOWLAN_TRIG_UNPROTECTED_DEAUTH_DISASSOC)) 19866 goto free_msg; 19867 19868 if (wakeup->packet) { 19869 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211; 19870 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN; 19871 19872 if (!wakeup->packet_80211) { 19873 pkt_attr = 19874 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023; 19875 len_attr = 19876 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN; 19877 } 19878 19879 if (wakeup->packet_len && 19880 nla_put_u32(msg, len_attr, wakeup->packet_len)) 19881 goto free_msg; 19882 19883 if (nla_put(msg, pkt_attr, wakeup->packet_present_len, 19884 wakeup->packet)) 19885 goto free_msg; 19886 } 19887 19888 if (wakeup->net_detect && 19889 cfg80211_net_detect_results(msg, wakeup)) 19890 goto free_msg; 19891 19892 nla_nest_end(msg, reasons); 19893 } 19894 19895 genlmsg_end(msg, hdr); 19896 19897 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19898 NL80211_MCGRP_MLME, gfp); 19899 return; 19900 19901 free_msg: 19902 nlmsg_free(msg); 19903 } 19904 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup); 19905 #endif 19906 19907 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer, 19908 enum nl80211_tdls_operation oper, 19909 u16 reason_code, gfp_t gfp) 19910 { 19911 struct wireless_dev *wdev = dev->ieee80211_ptr; 19912 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19913 struct sk_buff *msg; 19914 void *hdr; 19915 19916 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper, 19917 reason_code); 19918 19919 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19920 if (!msg) 19921 return; 19922 19923 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER); 19924 if (!hdr) { 19925 nlmsg_free(msg); 19926 return; 19927 } 19928 19929 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19930 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19931 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) || 19932 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) || 19933 (reason_code > 0 && 19934 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code))) 19935 goto nla_put_failure; 19936 19937 genlmsg_end(msg, hdr); 19938 19939 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19940 NL80211_MCGRP_MLME, gfp); 19941 return; 19942 19943 nla_put_failure: 19944 nlmsg_free(msg); 19945 } 19946 EXPORT_SYMBOL(cfg80211_tdls_oper_request); 19947 19948 static int nl80211_netlink_notify(struct notifier_block * nb, 19949 unsigned long state, 19950 void *_notify) 19951 { 19952 struct netlink_notify *notify = _notify; 19953 struct cfg80211_registered_device *rdev; 19954 struct wireless_dev *wdev; 19955 struct cfg80211_beacon_registration *reg, *tmp; 19956 19957 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC) 19958 return NOTIFY_DONE; 19959 19960 rcu_read_lock(); 19961 19962 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 19963 struct cfg80211_sched_scan_request *sched_scan_req; 19964 19965 list_for_each_entry_rcu(sched_scan_req, 19966 &rdev->sched_scan_req_list, 19967 list) { 19968 if (sched_scan_req->owner_nlportid == notify->portid) { 19969 sched_scan_req->nl_owner_dead = true; 19970 wiphy_work_queue(&rdev->wiphy, 19971 &rdev->sched_scan_stop_wk); 19972 } 19973 } 19974 19975 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) { 19976 cfg80211_mlme_unregister_socket(wdev, notify->portid); 19977 19978 if (wdev->owner_nlportid == notify->portid) { 19979 wdev->nl_owner_dead = true; 19980 schedule_work(&rdev->destroy_work); 19981 } else if (wdev->conn_owner_nlportid == notify->portid) { 19982 schedule_work(&wdev->disconnect_wk); 19983 } 19984 19985 cfg80211_release_pmsr(wdev, notify->portid); 19986 } 19987 19988 spin_lock_bh(&rdev->beacon_registrations_lock); 19989 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations, 19990 list) { 19991 if (reg->nlportid == notify->portid) { 19992 list_del(®->list); 19993 kfree(reg); 19994 break; 19995 } 19996 } 19997 spin_unlock_bh(&rdev->beacon_registrations_lock); 19998 } 19999 20000 rcu_read_unlock(); 20001 20002 /* 20003 * It is possible that the user space process that is controlling the 20004 * indoor setting disappeared, so notify the regulatory core. 20005 */ 20006 regulatory_netlink_notify(notify->portid); 20007 return NOTIFY_OK; 20008 } 20009 20010 static struct notifier_block nl80211_netlink_notifier = { 20011 .notifier_call = nl80211_netlink_notify, 20012 }; 20013 20014 void cfg80211_ft_event(struct net_device *netdev, 20015 struct cfg80211_ft_event_params *ft_event) 20016 { 20017 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 20018 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20019 struct sk_buff *msg; 20020 void *hdr; 20021 20022 trace_cfg80211_ft_event(wiphy, netdev, ft_event); 20023 20024 if (!ft_event->target_ap) 20025 return; 20026 20027 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len, 20028 GFP_KERNEL); 20029 if (!msg) 20030 return; 20031 20032 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT); 20033 if (!hdr) 20034 goto out; 20035 20036 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20037 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20038 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap)) 20039 goto out; 20040 20041 if (ft_event->ies && 20042 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies)) 20043 goto out; 20044 if (ft_event->ric_ies && 20045 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len, 20046 ft_event->ric_ies)) 20047 goto out; 20048 20049 genlmsg_end(msg, hdr); 20050 20051 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20052 NL80211_MCGRP_MLME, GFP_KERNEL); 20053 return; 20054 out: 20055 nlmsg_free(msg); 20056 } 20057 EXPORT_SYMBOL(cfg80211_ft_event); 20058 20059 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp) 20060 { 20061 struct cfg80211_registered_device *rdev; 20062 struct sk_buff *msg; 20063 void *hdr; 20064 u32 nlportid; 20065 20066 rdev = wiphy_to_rdev(wdev->wiphy); 20067 if (!rdev->crit_proto_nlportid) 20068 return; 20069 20070 nlportid = rdev->crit_proto_nlportid; 20071 rdev->crit_proto_nlportid = 0; 20072 20073 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20074 if (!msg) 20075 return; 20076 20077 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP); 20078 if (!hdr) 20079 goto nla_put_failure; 20080 20081 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20082 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20083 NL80211_ATTR_PAD)) 20084 goto nla_put_failure; 20085 20086 genlmsg_end(msg, hdr); 20087 20088 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20089 return; 20090 20091 nla_put_failure: 20092 nlmsg_free(msg); 20093 } 20094 EXPORT_SYMBOL(cfg80211_crit_proto_stopped); 20095 20096 void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id) 20097 { 20098 struct wiphy *wiphy = wdev->wiphy; 20099 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20100 struct sk_buff *msg; 20101 void *hdr; 20102 20103 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 20104 if (!msg) 20105 return; 20106 20107 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP); 20108 if (!hdr) 20109 goto out; 20110 20111 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20112 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 20113 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20114 NL80211_ATTR_PAD) || 20115 (wdev->valid_links && 20116 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 20117 goto out; 20118 20119 genlmsg_end(msg, hdr); 20120 20121 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 20122 NL80211_MCGRP_MLME, GFP_KERNEL); 20123 return; 20124 out: 20125 nlmsg_free(msg); 20126 } 20127 20128 int cfg80211_external_auth_request(struct net_device *dev, 20129 struct cfg80211_external_auth_params *params, 20130 gfp_t gfp) 20131 { 20132 struct wireless_dev *wdev = dev->ieee80211_ptr; 20133 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20134 struct sk_buff *msg; 20135 void *hdr; 20136 20137 if (!wdev->conn_owner_nlportid) 20138 return -EINVAL; 20139 20140 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20141 if (!msg) 20142 return -ENOMEM; 20143 20144 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH); 20145 if (!hdr) 20146 goto nla_put_failure; 20147 20148 /* Some historical mistakes in drivers <-> userspace interface (notably 20149 * between drivers and wpa_supplicant) led to a big-endian conversion 20150 * being needed on NL80211_ATTR_AKM_SUITES _only_ when its value is 20151 * WLAN_AKM_SUITE_SAE. This is now fixed on userspace side, but for the 20152 * benefit of older wpa_supplicant versions, send this particular value 20153 * in big-endian. Note that newer wpa_supplicant will also detect this 20154 * particular value in big endian still, so it all continues to work. 20155 */ 20156 if (params->key_mgmt_suite == WLAN_AKM_SUITE_SAE) { 20157 if (nla_put_be32(msg, NL80211_ATTR_AKM_SUITES, 20158 cpu_to_be32(WLAN_AKM_SUITE_SAE))) 20159 goto nla_put_failure; 20160 } else { 20161 if (nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, 20162 params->key_mgmt_suite)) 20163 goto nla_put_failure; 20164 } 20165 20166 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20167 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20168 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION, 20169 params->action) || 20170 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) || 20171 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len, 20172 params->ssid.ssid) || 20173 (!is_zero_ether_addr(params->mld_addr) && 20174 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr))) 20175 goto nla_put_failure; 20176 20177 genlmsg_end(msg, hdr); 20178 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 20179 wdev->conn_owner_nlportid); 20180 return 0; 20181 20182 nla_put_failure: 20183 nlmsg_free(msg); 20184 return -ENOBUFS; 20185 } 20186 EXPORT_SYMBOL(cfg80211_external_auth_request); 20187 20188 void cfg80211_update_owe_info_event(struct net_device *netdev, 20189 struct cfg80211_update_owe_info *owe_info, 20190 gfp_t gfp) 20191 { 20192 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 20193 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20194 struct sk_buff *msg; 20195 void *hdr; 20196 20197 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info); 20198 20199 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20200 if (!msg) 20201 return; 20202 20203 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO); 20204 if (!hdr) 20205 goto nla_put_failure; 20206 20207 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20208 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20209 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer)) 20210 goto nla_put_failure; 20211 20212 if (!owe_info->ie_len || 20213 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie)) 20214 goto nla_put_failure; 20215 20216 if (owe_info->assoc_link_id != -1) { 20217 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 20218 owe_info->assoc_link_id)) 20219 goto nla_put_failure; 20220 20221 if (!is_zero_ether_addr(owe_info->peer_mld_addr) && 20222 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 20223 owe_info->peer_mld_addr)) 20224 goto nla_put_failure; 20225 } 20226 20227 genlmsg_end(msg, hdr); 20228 20229 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20230 NL80211_MCGRP_MLME, gfp); 20231 return; 20232 20233 nla_put_failure: 20234 genlmsg_cancel(msg, hdr); 20235 nlmsg_free(msg); 20236 } 20237 EXPORT_SYMBOL(cfg80211_update_owe_info_event); 20238 20239 void cfg80211_schedule_channels_check(struct wireless_dev *wdev) 20240 { 20241 struct wiphy *wiphy = wdev->wiphy; 20242 20243 /* Schedule channels check if NO_IR or DFS relaxations are supported */ 20244 if (wdev->iftype == NL80211_IFTYPE_STATION && 20245 (wiphy_ext_feature_isset(wiphy, 20246 NL80211_EXT_FEATURE_DFS_CONCURRENT) || 20247 (IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) && 20248 wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR))) 20249 reg_check_channels(); 20250 } 20251 EXPORT_SYMBOL(cfg80211_schedule_channels_check); 20252 20253 /* initialisation/exit functions */ 20254 20255 int __init nl80211_init(void) 20256 { 20257 int err; 20258 20259 err = genl_register_family(&nl80211_fam); 20260 if (err) 20261 return err; 20262 20263 err = netlink_register_notifier(&nl80211_netlink_notifier); 20264 if (err) 20265 goto err_out; 20266 20267 return 0; 20268 err_out: 20269 genl_unregister_family(&nl80211_fam); 20270 return err; 20271 } 20272 20273 void nl80211_exit(void) 20274 { 20275 netlink_unregister_notifier(&nl80211_netlink_notifier); 20276 genl_unregister_family(&nl80211_fam); 20277 } 20278