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 result = rdev_set_ap_chanwidth(rdev, dev, link_id, 3419 &chandef); 3420 if (result) 3421 return result; 3422 wdev->links[link_id].ap.chandef = chandef; 3423 } else { 3424 wdev->u.ap.preset_chandef = chandef; 3425 } 3426 return 0; 3427 case NL80211_IFTYPE_MESH_POINT: 3428 return cfg80211_set_mesh_channel(rdev, wdev, &chandef); 3429 case NL80211_IFTYPE_MONITOR: 3430 return cfg80211_set_monitor_channel(rdev, &chandef); 3431 default: 3432 break; 3433 } 3434 3435 return -EINVAL; 3436 } 3437 3438 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info) 3439 { 3440 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3441 int link_id = nl80211_link_id_or_invalid(info->attrs); 3442 struct net_device *netdev = info->user_ptr[1]; 3443 3444 return __nl80211_set_channel(rdev, netdev, info, link_id); 3445 } 3446 3447 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info) 3448 { 3449 struct cfg80211_registered_device *rdev = NULL; 3450 struct net_device *netdev = NULL; 3451 struct wireless_dev *wdev; 3452 int result = 0, rem_txq_params = 0; 3453 struct nlattr *nl_txq_params; 3454 u32 changed; 3455 u8 retry_short = 0, retry_long = 0; 3456 u32 frag_threshold = 0, rts_threshold = 0; 3457 u8 coverage_class = 0; 3458 u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0; 3459 3460 rtnl_lock(); 3461 /* 3462 * Try to find the wiphy and netdev. Normally this 3463 * function shouldn't need the netdev, but this is 3464 * done for backward compatibility -- previously 3465 * setting the channel was done per wiphy, but now 3466 * it is per netdev. Previous userland like hostapd 3467 * also passed a netdev to set_wiphy, so that it is 3468 * possible to let that go to the right netdev! 3469 */ 3470 3471 if (info->attrs[NL80211_ATTR_IFINDEX]) { 3472 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]); 3473 3474 netdev = __dev_get_by_index(genl_info_net(info), ifindex); 3475 if (netdev && netdev->ieee80211_ptr) 3476 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy); 3477 else 3478 netdev = NULL; 3479 } 3480 3481 if (!netdev) { 3482 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info), 3483 info->attrs); 3484 if (IS_ERR(rdev)) { 3485 rtnl_unlock(); 3486 return PTR_ERR(rdev); 3487 } 3488 wdev = NULL; 3489 netdev = NULL; 3490 result = 0; 3491 } else 3492 wdev = netdev->ieee80211_ptr; 3493 3494 wiphy_lock(&rdev->wiphy); 3495 3496 /* 3497 * end workaround code, by now the rdev is available 3498 * and locked, and wdev may or may not be NULL. 3499 */ 3500 3501 if (info->attrs[NL80211_ATTR_WIPHY_NAME]) 3502 result = cfg80211_dev_rename( 3503 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME])); 3504 rtnl_unlock(); 3505 3506 if (result) 3507 goto out; 3508 3509 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) { 3510 struct ieee80211_txq_params txq_params; 3511 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1]; 3512 3513 if (!rdev->ops->set_txq_params) { 3514 result = -EOPNOTSUPP; 3515 goto out; 3516 } 3517 3518 if (!netdev) { 3519 result = -EINVAL; 3520 goto out; 3521 } 3522 3523 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 3524 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 3525 result = -EINVAL; 3526 goto out; 3527 } 3528 3529 if (!netif_running(netdev)) { 3530 result = -ENETDOWN; 3531 goto out; 3532 } 3533 3534 nla_for_each_nested(nl_txq_params, 3535 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS], 3536 rem_txq_params) { 3537 result = nla_parse_nested_deprecated(tb, 3538 NL80211_TXQ_ATTR_MAX, 3539 nl_txq_params, 3540 txq_params_policy, 3541 info->extack); 3542 if (result) 3543 goto out; 3544 result = parse_txq_params(tb, &txq_params); 3545 if (result) 3546 goto out; 3547 3548 txq_params.link_id = 3549 nl80211_link_id_or_invalid(info->attrs); 3550 3551 if (txq_params.link_id >= 0 && 3552 !(netdev->ieee80211_ptr->valid_links & 3553 BIT(txq_params.link_id))) 3554 result = -ENOLINK; 3555 else if (txq_params.link_id >= 0 && 3556 !netdev->ieee80211_ptr->valid_links) 3557 result = -EINVAL; 3558 else 3559 result = rdev_set_txq_params(rdev, netdev, 3560 &txq_params); 3561 if (result) 3562 goto out; 3563 } 3564 } 3565 3566 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 3567 int link_id = nl80211_link_id_or_invalid(info->attrs); 3568 3569 if (wdev) { 3570 result = __nl80211_set_channel( 3571 rdev, 3572 nl80211_can_set_dev_channel(wdev) ? netdev : NULL, 3573 info, link_id); 3574 } else { 3575 result = __nl80211_set_channel(rdev, netdev, info, link_id); 3576 } 3577 3578 if (result) 3579 goto out; 3580 } 3581 3582 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) { 3583 struct wireless_dev *txp_wdev = wdev; 3584 enum nl80211_tx_power_setting type; 3585 int idx, mbm = 0; 3586 3587 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER)) 3588 txp_wdev = NULL; 3589 3590 if (!rdev->ops->set_tx_power) { 3591 result = -EOPNOTSUPP; 3592 goto out; 3593 } 3594 3595 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING; 3596 type = nla_get_u32(info->attrs[idx]); 3597 3598 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] && 3599 (type != NL80211_TX_POWER_AUTOMATIC)) { 3600 result = -EINVAL; 3601 goto out; 3602 } 3603 3604 if (type != NL80211_TX_POWER_AUTOMATIC) { 3605 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL; 3606 mbm = nla_get_u32(info->attrs[idx]); 3607 } 3608 3609 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm); 3610 if (result) 3611 goto out; 3612 } 3613 3614 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] && 3615 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) { 3616 u32 tx_ant, rx_ant; 3617 3618 if ((!rdev->wiphy.available_antennas_tx && 3619 !rdev->wiphy.available_antennas_rx) || 3620 !rdev->ops->set_antenna) { 3621 result = -EOPNOTSUPP; 3622 goto out; 3623 } 3624 3625 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]); 3626 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]); 3627 3628 /* reject antenna configurations which don't match the 3629 * available antenna masks, except for the "all" mask */ 3630 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) || 3631 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) { 3632 result = -EINVAL; 3633 goto out; 3634 } 3635 3636 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx; 3637 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx; 3638 3639 result = rdev_set_antenna(rdev, tx_ant, rx_ant); 3640 if (result) 3641 goto out; 3642 } 3643 3644 changed = 0; 3645 3646 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) { 3647 retry_short = nla_get_u8( 3648 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]); 3649 3650 changed |= WIPHY_PARAM_RETRY_SHORT; 3651 } 3652 3653 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) { 3654 retry_long = nla_get_u8( 3655 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]); 3656 3657 changed |= WIPHY_PARAM_RETRY_LONG; 3658 } 3659 3660 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) { 3661 frag_threshold = nla_get_u32( 3662 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]); 3663 if (frag_threshold < 256) { 3664 result = -EINVAL; 3665 goto out; 3666 } 3667 3668 if (frag_threshold != (u32) -1) { 3669 /* 3670 * Fragments (apart from the last one) are required to 3671 * have even length. Make the fragmentation code 3672 * simpler by stripping LSB should someone try to use 3673 * odd threshold value. 3674 */ 3675 frag_threshold &= ~0x1; 3676 } 3677 changed |= WIPHY_PARAM_FRAG_THRESHOLD; 3678 } 3679 3680 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3681 rts_threshold = nla_get_u32( 3682 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3683 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3684 } 3685 3686 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) { 3687 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3688 result = -EINVAL; 3689 goto out; 3690 } 3691 3692 coverage_class = nla_get_u8( 3693 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]); 3694 changed |= WIPHY_PARAM_COVERAGE_CLASS; 3695 } 3696 3697 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3698 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) { 3699 result = -EOPNOTSUPP; 3700 goto out; 3701 } 3702 3703 changed |= WIPHY_PARAM_DYN_ACK; 3704 } 3705 3706 if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) { 3707 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3708 NL80211_EXT_FEATURE_TXQS)) { 3709 result = -EOPNOTSUPP; 3710 goto out; 3711 } 3712 txq_limit = nla_get_u32( 3713 info->attrs[NL80211_ATTR_TXQ_LIMIT]); 3714 changed |= WIPHY_PARAM_TXQ_LIMIT; 3715 } 3716 3717 if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) { 3718 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3719 NL80211_EXT_FEATURE_TXQS)) { 3720 result = -EOPNOTSUPP; 3721 goto out; 3722 } 3723 txq_memory_limit = nla_get_u32( 3724 info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]); 3725 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT; 3726 } 3727 3728 if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) { 3729 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3730 NL80211_EXT_FEATURE_TXQS)) { 3731 result = -EOPNOTSUPP; 3732 goto out; 3733 } 3734 txq_quantum = nla_get_u32( 3735 info->attrs[NL80211_ATTR_TXQ_QUANTUM]); 3736 changed |= WIPHY_PARAM_TXQ_QUANTUM; 3737 } 3738 3739 if (changed) { 3740 u8 old_retry_short, old_retry_long; 3741 u32 old_frag_threshold, old_rts_threshold; 3742 u8 old_coverage_class; 3743 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum; 3744 3745 if (!rdev->ops->set_wiphy_params) { 3746 result = -EOPNOTSUPP; 3747 goto out; 3748 } 3749 3750 old_retry_short = rdev->wiphy.retry_short; 3751 old_retry_long = rdev->wiphy.retry_long; 3752 old_frag_threshold = rdev->wiphy.frag_threshold; 3753 old_rts_threshold = rdev->wiphy.rts_threshold; 3754 old_coverage_class = rdev->wiphy.coverage_class; 3755 old_txq_limit = rdev->wiphy.txq_limit; 3756 old_txq_memory_limit = rdev->wiphy.txq_memory_limit; 3757 old_txq_quantum = rdev->wiphy.txq_quantum; 3758 3759 if (changed & WIPHY_PARAM_RETRY_SHORT) 3760 rdev->wiphy.retry_short = retry_short; 3761 if (changed & WIPHY_PARAM_RETRY_LONG) 3762 rdev->wiphy.retry_long = retry_long; 3763 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) 3764 rdev->wiphy.frag_threshold = frag_threshold; 3765 if (changed & WIPHY_PARAM_RTS_THRESHOLD) 3766 rdev->wiphy.rts_threshold = rts_threshold; 3767 if (changed & WIPHY_PARAM_COVERAGE_CLASS) 3768 rdev->wiphy.coverage_class = coverage_class; 3769 if (changed & WIPHY_PARAM_TXQ_LIMIT) 3770 rdev->wiphy.txq_limit = txq_limit; 3771 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT) 3772 rdev->wiphy.txq_memory_limit = txq_memory_limit; 3773 if (changed & WIPHY_PARAM_TXQ_QUANTUM) 3774 rdev->wiphy.txq_quantum = txq_quantum; 3775 3776 result = rdev_set_wiphy_params(rdev, changed); 3777 if (result) { 3778 rdev->wiphy.retry_short = old_retry_short; 3779 rdev->wiphy.retry_long = old_retry_long; 3780 rdev->wiphy.frag_threshold = old_frag_threshold; 3781 rdev->wiphy.rts_threshold = old_rts_threshold; 3782 rdev->wiphy.coverage_class = old_coverage_class; 3783 rdev->wiphy.txq_limit = old_txq_limit; 3784 rdev->wiphy.txq_memory_limit = old_txq_memory_limit; 3785 rdev->wiphy.txq_quantum = old_txq_quantum; 3786 goto out; 3787 } 3788 } 3789 3790 result = 0; 3791 3792 out: 3793 wiphy_unlock(&rdev->wiphy); 3794 return result; 3795 } 3796 3797 int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef) 3798 { 3799 if (WARN_ON(!cfg80211_chandef_valid(chandef))) 3800 return -EINVAL; 3801 3802 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 3803 chandef->chan->center_freq)) 3804 return -ENOBUFS; 3805 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 3806 chandef->chan->freq_offset)) 3807 return -ENOBUFS; 3808 switch (chandef->width) { 3809 case NL80211_CHAN_WIDTH_20_NOHT: 3810 case NL80211_CHAN_WIDTH_20: 3811 case NL80211_CHAN_WIDTH_40: 3812 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 3813 cfg80211_get_chandef_type(chandef))) 3814 return -ENOBUFS; 3815 break; 3816 default: 3817 break; 3818 } 3819 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width)) 3820 return -ENOBUFS; 3821 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1)) 3822 return -ENOBUFS; 3823 if (chandef->center_freq2 && 3824 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2)) 3825 return -ENOBUFS; 3826 if (chandef->punctured && 3827 nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, chandef->punctured)) 3828 return -ENOBUFS; 3829 3830 return 0; 3831 } 3832 EXPORT_SYMBOL(nl80211_send_chandef); 3833 3834 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags, 3835 struct cfg80211_registered_device *rdev, 3836 struct wireless_dev *wdev, 3837 enum nl80211_commands cmd) 3838 { 3839 struct net_device *dev = wdev->netdev; 3840 void *hdr; 3841 3842 lockdep_assert_wiphy(&rdev->wiphy); 3843 3844 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE && 3845 cmd != NL80211_CMD_DEL_INTERFACE && 3846 cmd != NL80211_CMD_SET_INTERFACE); 3847 3848 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 3849 if (!hdr) 3850 return -1; 3851 3852 if (dev && 3853 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 3854 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name))) 3855 goto nla_put_failure; 3856 3857 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 3858 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) || 3859 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 3860 NL80211_ATTR_PAD) || 3861 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) || 3862 nla_put_u32(msg, NL80211_ATTR_GENERATION, 3863 rdev->devlist_generation ^ 3864 (cfg80211_rdev_list_generation << 2)) || 3865 nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr)) 3866 goto nla_put_failure; 3867 3868 if (rdev->ops->get_channel && !wdev->valid_links) { 3869 struct cfg80211_chan_def chandef = {}; 3870 int ret; 3871 3872 ret = rdev_get_channel(rdev, wdev, 0, &chandef); 3873 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 3874 goto nla_put_failure; 3875 } 3876 3877 if (rdev->ops->get_tx_power) { 3878 int dbm, ret; 3879 3880 ret = rdev_get_tx_power(rdev, wdev, &dbm); 3881 if (ret == 0 && 3882 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 3883 DBM_TO_MBM(dbm))) 3884 goto nla_put_failure; 3885 } 3886 3887 switch (wdev->iftype) { 3888 case NL80211_IFTYPE_AP: 3889 case NL80211_IFTYPE_P2P_GO: 3890 if (wdev->u.ap.ssid_len && 3891 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 3892 wdev->u.ap.ssid)) 3893 goto nla_put_failure; 3894 break; 3895 case NL80211_IFTYPE_STATION: 3896 case NL80211_IFTYPE_P2P_CLIENT: 3897 if (wdev->u.client.ssid_len && 3898 nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len, 3899 wdev->u.client.ssid)) 3900 goto nla_put_failure; 3901 break; 3902 case NL80211_IFTYPE_ADHOC: 3903 if (wdev->u.ibss.ssid_len && 3904 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len, 3905 wdev->u.ibss.ssid)) 3906 goto nla_put_failure; 3907 break; 3908 default: 3909 /* nothing */ 3910 break; 3911 } 3912 3913 if (rdev->ops->get_txq_stats) { 3914 struct cfg80211_txq_stats txqstats = {}; 3915 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats); 3916 3917 if (ret == 0 && 3918 !nl80211_put_txq_stats(msg, &txqstats, 3919 NL80211_ATTR_TXQ_STATS)) 3920 goto nla_put_failure; 3921 } 3922 3923 if (wdev->valid_links) { 3924 unsigned int link_id; 3925 struct nlattr *links = nla_nest_start(msg, 3926 NL80211_ATTR_MLO_LINKS); 3927 3928 if (!links) 3929 goto nla_put_failure; 3930 3931 for_each_valid_link(wdev, link_id) { 3932 struct nlattr *link = nla_nest_start(msg, link_id + 1); 3933 struct cfg80211_chan_def chandef = {}; 3934 int ret; 3935 3936 if (!link) 3937 goto nla_put_failure; 3938 3939 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 3940 goto nla_put_failure; 3941 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 3942 wdev->links[link_id].addr)) 3943 goto nla_put_failure; 3944 3945 ret = rdev_get_channel(rdev, wdev, link_id, &chandef); 3946 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 3947 goto nla_put_failure; 3948 3949 nla_nest_end(msg, link); 3950 } 3951 3952 nla_nest_end(msg, links); 3953 } 3954 3955 genlmsg_end(msg, hdr); 3956 return 0; 3957 3958 nla_put_failure: 3959 genlmsg_cancel(msg, hdr); 3960 return -EMSGSIZE; 3961 } 3962 3963 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb) 3964 { 3965 int wp_idx = 0; 3966 int if_idx = 0; 3967 int wp_start = cb->args[0]; 3968 int if_start = cb->args[1]; 3969 int filter_wiphy = -1; 3970 struct cfg80211_registered_device *rdev; 3971 struct wireless_dev *wdev; 3972 int ret; 3973 3974 rtnl_lock(); 3975 if (!cb->args[2]) { 3976 struct nl80211_dump_wiphy_state state = { 3977 .filter_wiphy = -1, 3978 }; 3979 3980 ret = nl80211_dump_wiphy_parse(skb, cb, &state); 3981 if (ret) 3982 goto out_unlock; 3983 3984 filter_wiphy = state.filter_wiphy; 3985 3986 /* 3987 * if filtering, set cb->args[2] to +1 since 0 is the default 3988 * value needed to determine that parsing is necessary. 3989 */ 3990 if (filter_wiphy >= 0) 3991 cb->args[2] = filter_wiphy + 1; 3992 else 3993 cb->args[2] = -1; 3994 } else if (cb->args[2] > 0) { 3995 filter_wiphy = cb->args[2] - 1; 3996 } 3997 3998 for_each_rdev(rdev) { 3999 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 4000 continue; 4001 if (wp_idx < wp_start) { 4002 wp_idx++; 4003 continue; 4004 } 4005 4006 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx) 4007 continue; 4008 4009 if_idx = 0; 4010 4011 wiphy_lock(&rdev->wiphy); 4012 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 4013 if (if_idx < if_start) { 4014 if_idx++; 4015 continue; 4016 } 4017 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid, 4018 cb->nlh->nlmsg_seq, NLM_F_MULTI, 4019 rdev, wdev, 4020 NL80211_CMD_NEW_INTERFACE) < 0) { 4021 wiphy_unlock(&rdev->wiphy); 4022 goto out; 4023 } 4024 if_idx++; 4025 } 4026 wiphy_unlock(&rdev->wiphy); 4027 4028 if_start = 0; 4029 wp_idx++; 4030 } 4031 out: 4032 cb->args[0] = wp_idx; 4033 cb->args[1] = if_idx; 4034 4035 ret = skb->len; 4036 out_unlock: 4037 rtnl_unlock(); 4038 4039 return ret; 4040 } 4041 4042 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info) 4043 { 4044 struct sk_buff *msg; 4045 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4046 struct wireless_dev *wdev = info->user_ptr[1]; 4047 4048 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4049 if (!msg) 4050 return -ENOMEM; 4051 4052 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4053 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4054 nlmsg_free(msg); 4055 return -ENOBUFS; 4056 } 4057 4058 return genlmsg_reply(msg, info); 4059 } 4060 4061 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = { 4062 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG }, 4063 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG }, 4064 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG }, 4065 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG }, 4066 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG }, 4067 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG }, 4068 }; 4069 4070 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags) 4071 { 4072 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1]; 4073 int flag; 4074 4075 *mntrflags = 0; 4076 4077 if (!nla) 4078 return -EINVAL; 4079 4080 if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL)) 4081 return -EINVAL; 4082 4083 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++) 4084 if (flags[flag]) 4085 *mntrflags |= (1<<flag); 4086 4087 *mntrflags |= MONITOR_FLAG_CHANGED; 4088 4089 return 0; 4090 } 4091 4092 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev, 4093 enum nl80211_iftype type, 4094 struct genl_info *info, 4095 struct vif_params *params) 4096 { 4097 bool change = false; 4098 int err; 4099 4100 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) { 4101 if (type != NL80211_IFTYPE_MONITOR) 4102 return -EINVAL; 4103 4104 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS], 4105 ¶ms->flags); 4106 if (err) 4107 return err; 4108 4109 change = true; 4110 } 4111 4112 if (params->flags & MONITOR_FLAG_ACTIVE && 4113 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR)) 4114 return -EOPNOTSUPP; 4115 4116 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) { 4117 const u8 *mumimo_groups; 4118 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4119 4120 if (type != NL80211_IFTYPE_MONITOR) 4121 return -EINVAL; 4122 4123 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4124 return -EOPNOTSUPP; 4125 4126 mumimo_groups = 4127 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]); 4128 4129 /* bits 0 and 63 are reserved and must be zero */ 4130 if ((mumimo_groups[0] & BIT(0)) || 4131 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7))) 4132 return -EINVAL; 4133 4134 params->vht_mumimo_groups = mumimo_groups; 4135 change = true; 4136 } 4137 4138 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) { 4139 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4140 4141 if (type != NL80211_IFTYPE_MONITOR) 4142 return -EINVAL; 4143 4144 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4145 return -EOPNOTSUPP; 4146 4147 params->vht_mumimo_follow_addr = 4148 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]); 4149 change = true; 4150 } 4151 4152 return change ? 1 : 0; 4153 } 4154 4155 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev, 4156 struct net_device *netdev, u8 use_4addr, 4157 enum nl80211_iftype iftype) 4158 { 4159 if (!use_4addr) { 4160 if (netdev && netif_is_bridge_port(netdev)) 4161 return -EBUSY; 4162 return 0; 4163 } 4164 4165 switch (iftype) { 4166 case NL80211_IFTYPE_AP_VLAN: 4167 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP) 4168 return 0; 4169 break; 4170 case NL80211_IFTYPE_STATION: 4171 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION) 4172 return 0; 4173 break; 4174 default: 4175 break; 4176 } 4177 4178 return -EOPNOTSUPP; 4179 } 4180 4181 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info) 4182 { 4183 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4184 struct vif_params params; 4185 int err; 4186 enum nl80211_iftype otype, ntype; 4187 struct net_device *dev = info->user_ptr[1]; 4188 bool change = false; 4189 4190 memset(¶ms, 0, sizeof(params)); 4191 4192 otype = ntype = dev->ieee80211_ptr->iftype; 4193 4194 if (info->attrs[NL80211_ATTR_IFTYPE]) { 4195 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4196 if (otype != ntype) 4197 change = true; 4198 } 4199 4200 if (info->attrs[NL80211_ATTR_MESH_ID]) { 4201 struct wireless_dev *wdev = dev->ieee80211_ptr; 4202 4203 if (ntype != NL80211_IFTYPE_MESH_POINT) 4204 return -EINVAL; 4205 if (netif_running(dev)) 4206 return -EBUSY; 4207 4208 wdev->u.mesh.id_up_len = 4209 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4210 memcpy(wdev->u.mesh.id, 4211 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4212 wdev->u.mesh.id_up_len); 4213 } 4214 4215 if (info->attrs[NL80211_ATTR_4ADDR]) { 4216 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4217 change = true; 4218 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype); 4219 if (err) 4220 return err; 4221 } else { 4222 params.use_4addr = -1; 4223 } 4224 4225 err = nl80211_parse_mon_options(rdev, ntype, info, ¶ms); 4226 if (err < 0) 4227 return err; 4228 if (err > 0) 4229 change = true; 4230 4231 if (change) 4232 err = cfg80211_change_iface(rdev, dev, ntype, ¶ms); 4233 else 4234 err = 0; 4235 4236 if (!err && params.use_4addr != -1) 4237 dev->ieee80211_ptr->use_4addr = params.use_4addr; 4238 4239 if (change && !err) { 4240 struct wireless_dev *wdev = dev->ieee80211_ptr; 4241 4242 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE); 4243 } 4244 4245 return err; 4246 } 4247 4248 static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4249 { 4250 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4251 struct vif_params params; 4252 struct wireless_dev *wdev; 4253 struct sk_buff *msg; 4254 int err; 4255 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED; 4256 4257 memset(¶ms, 0, sizeof(params)); 4258 4259 if (!info->attrs[NL80211_ATTR_IFNAME]) 4260 return -EINVAL; 4261 4262 if (info->attrs[NL80211_ATTR_IFTYPE]) 4263 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4264 4265 if (!rdev->ops->add_virtual_intf) 4266 return -EOPNOTSUPP; 4267 4268 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN || 4269 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) && 4270 info->attrs[NL80211_ATTR_MAC]) { 4271 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC], 4272 ETH_ALEN); 4273 if (!is_valid_ether_addr(params.macaddr)) 4274 return -EADDRNOTAVAIL; 4275 } 4276 4277 if (info->attrs[NL80211_ATTR_4ADDR]) { 4278 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4279 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type); 4280 if (err) 4281 return err; 4282 } 4283 4284 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0)) 4285 return -EOPNOTSUPP; 4286 4287 err = nl80211_parse_mon_options(rdev, type, info, ¶ms); 4288 if (err < 0) 4289 return err; 4290 4291 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4292 if (!msg) 4293 return -ENOMEM; 4294 4295 wdev = rdev_add_virtual_intf(rdev, 4296 nla_data(info->attrs[NL80211_ATTR_IFNAME]), 4297 NET_NAME_USER, type, ¶ms); 4298 if (WARN_ON(!wdev)) { 4299 nlmsg_free(msg); 4300 return -EPROTO; 4301 } else if (IS_ERR(wdev)) { 4302 nlmsg_free(msg); 4303 return PTR_ERR(wdev); 4304 } 4305 4306 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 4307 wdev->owner_nlportid = info->snd_portid; 4308 4309 switch (type) { 4310 case NL80211_IFTYPE_MESH_POINT: 4311 if (!info->attrs[NL80211_ATTR_MESH_ID]) 4312 break; 4313 wdev->u.mesh.id_up_len = 4314 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4315 memcpy(wdev->u.mesh.id, 4316 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4317 wdev->u.mesh.id_up_len); 4318 break; 4319 case NL80211_IFTYPE_NAN: 4320 case NL80211_IFTYPE_P2P_DEVICE: 4321 /* 4322 * P2P Device and NAN do not have a netdev, so don't go 4323 * through the netdev notifier and must be added here 4324 */ 4325 cfg80211_init_wdev(wdev); 4326 cfg80211_register_wdev(rdev, wdev); 4327 break; 4328 default: 4329 break; 4330 } 4331 4332 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4333 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4334 nlmsg_free(msg); 4335 return -ENOBUFS; 4336 } 4337 4338 return genlmsg_reply(msg, info); 4339 } 4340 4341 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4342 { 4343 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4344 int ret; 4345 4346 /* to avoid failing a new interface creation due to pending removal */ 4347 cfg80211_destroy_ifaces(rdev); 4348 4349 wiphy_lock(&rdev->wiphy); 4350 ret = _nl80211_new_interface(skb, info); 4351 wiphy_unlock(&rdev->wiphy); 4352 4353 return ret; 4354 } 4355 4356 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info) 4357 { 4358 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4359 struct wireless_dev *wdev = info->user_ptr[1]; 4360 4361 if (!rdev->ops->del_virtual_intf) 4362 return -EOPNOTSUPP; 4363 4364 /* 4365 * We hold RTNL, so this is safe, without RTNL opencount cannot 4366 * reach 0, and thus the rdev cannot be deleted. 4367 * 4368 * We need to do it for the dev_close(), since that will call 4369 * the netdev notifiers, and we need to acquire the mutex there 4370 * but don't know if we get there from here or from some other 4371 * place (e.g. "ip link set ... down"). 4372 */ 4373 mutex_unlock(&rdev->wiphy.mtx); 4374 4375 /* 4376 * If we remove a wireless device without a netdev then clear 4377 * user_ptr[1] so that nl80211_post_doit won't dereference it 4378 * to check if it needs to do dev_put(). Otherwise it crashes 4379 * since the wdev has been freed, unlike with a netdev where 4380 * we need the dev_put() for the netdev to really be freed. 4381 */ 4382 if (!wdev->netdev) 4383 info->user_ptr[1] = NULL; 4384 else 4385 dev_close(wdev->netdev); 4386 4387 mutex_lock(&rdev->wiphy.mtx); 4388 4389 return cfg80211_remove_virtual_intf(rdev, wdev); 4390 } 4391 4392 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info) 4393 { 4394 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4395 struct net_device *dev = info->user_ptr[1]; 4396 u16 noack_map; 4397 4398 if (!info->attrs[NL80211_ATTR_NOACK_MAP]) 4399 return -EINVAL; 4400 4401 if (!rdev->ops->set_noack_map) 4402 return -EOPNOTSUPP; 4403 4404 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]); 4405 4406 return rdev_set_noack_map(rdev, dev, noack_map); 4407 } 4408 4409 static int nl80211_validate_key_link_id(struct genl_info *info, 4410 struct wireless_dev *wdev, 4411 int link_id, bool pairwise) 4412 { 4413 if (pairwise) { 4414 if (link_id != -1) { 4415 GENL_SET_ERR_MSG(info, 4416 "link ID not allowed for pairwise key"); 4417 return -EINVAL; 4418 } 4419 4420 return 0; 4421 } 4422 4423 if (wdev->valid_links) { 4424 if (link_id == -1) { 4425 GENL_SET_ERR_MSG(info, 4426 "link ID must for MLO group key"); 4427 return -EINVAL; 4428 } 4429 if (!(wdev->valid_links & BIT(link_id))) { 4430 GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key"); 4431 return -EINVAL; 4432 } 4433 } else if (link_id != -1) { 4434 GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key"); 4435 return -EINVAL; 4436 } 4437 4438 return 0; 4439 } 4440 4441 struct get_key_cookie { 4442 struct sk_buff *msg; 4443 int error; 4444 int idx; 4445 }; 4446 4447 static void get_key_callback(void *c, struct key_params *params) 4448 { 4449 struct nlattr *key; 4450 struct get_key_cookie *cookie = c; 4451 4452 if ((params->key && 4453 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA, 4454 params->key_len, params->key)) || 4455 (params->seq && 4456 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ, 4457 params->seq_len, params->seq)) || 4458 (params->cipher && 4459 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER, 4460 params->cipher))) 4461 goto nla_put_failure; 4462 4463 key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY); 4464 if (!key) 4465 goto nla_put_failure; 4466 4467 if ((params->key && 4468 nla_put(cookie->msg, NL80211_KEY_DATA, 4469 params->key_len, params->key)) || 4470 (params->seq && 4471 nla_put(cookie->msg, NL80211_KEY_SEQ, 4472 params->seq_len, params->seq)) || 4473 (params->cipher && 4474 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER, 4475 params->cipher))) 4476 goto nla_put_failure; 4477 4478 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx)) 4479 goto nla_put_failure; 4480 4481 nla_nest_end(cookie->msg, key); 4482 4483 return; 4484 nla_put_failure: 4485 cookie->error = 1; 4486 } 4487 4488 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info) 4489 { 4490 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4491 int err; 4492 struct net_device *dev = info->user_ptr[1]; 4493 u8 key_idx = 0; 4494 const u8 *mac_addr = NULL; 4495 bool pairwise; 4496 struct get_key_cookie cookie = { 4497 .error = 0, 4498 }; 4499 void *hdr; 4500 struct sk_buff *msg; 4501 bool bigtk_support = false; 4502 int link_id = nl80211_link_id_or_invalid(info->attrs); 4503 struct wireless_dev *wdev = dev->ieee80211_ptr; 4504 4505 if (wiphy_ext_feature_isset(&rdev->wiphy, 4506 NL80211_EXT_FEATURE_BEACON_PROTECTION)) 4507 bigtk_support = true; 4508 4509 if ((wdev->iftype == NL80211_IFTYPE_STATION || 4510 wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) && 4511 wiphy_ext_feature_isset(&rdev->wiphy, 4512 NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT)) 4513 bigtk_support = true; 4514 4515 if (info->attrs[NL80211_ATTR_KEY_IDX]) { 4516 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 4517 4518 if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) { 4519 GENL_SET_ERR_MSG(info, "BIGTK not supported"); 4520 return -EINVAL; 4521 } 4522 } 4523 4524 if (info->attrs[NL80211_ATTR_MAC]) 4525 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4526 4527 pairwise = !!mac_addr; 4528 if (info->attrs[NL80211_ATTR_KEY_TYPE]) { 4529 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 4530 4531 if (kt != NL80211_KEYTYPE_GROUP && 4532 kt != NL80211_KEYTYPE_PAIRWISE) 4533 return -EINVAL; 4534 pairwise = kt == NL80211_KEYTYPE_PAIRWISE; 4535 } 4536 4537 if (!rdev->ops->get_key) 4538 return -EOPNOTSUPP; 4539 4540 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4541 return -ENOENT; 4542 4543 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4544 if (!msg) 4545 return -ENOMEM; 4546 4547 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 4548 NL80211_CMD_NEW_KEY); 4549 if (!hdr) 4550 goto nla_put_failure; 4551 4552 cookie.msg = msg; 4553 cookie.idx = key_idx; 4554 4555 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4556 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx)) 4557 goto nla_put_failure; 4558 if (mac_addr && 4559 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr)) 4560 goto nla_put_failure; 4561 4562 err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise); 4563 if (err) 4564 goto free_msg; 4565 4566 err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr, 4567 &cookie, get_key_callback); 4568 4569 if (err) 4570 goto free_msg; 4571 4572 if (cookie.error) 4573 goto nla_put_failure; 4574 4575 genlmsg_end(msg, hdr); 4576 return genlmsg_reply(msg, info); 4577 4578 nla_put_failure: 4579 err = -ENOBUFS; 4580 free_msg: 4581 nlmsg_free(msg); 4582 return err; 4583 } 4584 4585 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info) 4586 { 4587 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4588 struct key_parse key; 4589 int err; 4590 struct net_device *dev = info->user_ptr[1]; 4591 int link_id = nl80211_link_id_or_invalid(info->attrs); 4592 struct wireless_dev *wdev = dev->ieee80211_ptr; 4593 4594 err = nl80211_parse_key(info, &key); 4595 if (err) 4596 return err; 4597 4598 if (key.idx < 0) 4599 return -EINVAL; 4600 4601 /* Only support setting default key and 4602 * Extended Key ID action NL80211_KEY_SET_TX. 4603 */ 4604 if (!key.def && !key.defmgmt && !key.defbeacon && 4605 !(key.p.mode == NL80211_KEY_SET_TX)) 4606 return -EINVAL; 4607 4608 if (key.def) { 4609 if (!rdev->ops->set_default_key) 4610 return -EOPNOTSUPP; 4611 4612 err = nl80211_key_allowed(wdev); 4613 if (err) 4614 return err; 4615 4616 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4617 if (err) 4618 return err; 4619 4620 err = rdev_set_default_key(rdev, dev, link_id, key.idx, 4621 key.def_uni, key.def_multi); 4622 4623 if (err) 4624 return err; 4625 4626 #ifdef CONFIG_CFG80211_WEXT 4627 wdev->wext.default_key = key.idx; 4628 #endif 4629 return 0; 4630 } else if (key.defmgmt) { 4631 if (key.def_uni || !key.def_multi) 4632 return -EINVAL; 4633 4634 if (!rdev->ops->set_default_mgmt_key) 4635 return -EOPNOTSUPP; 4636 4637 err = nl80211_key_allowed(wdev); 4638 if (err) 4639 return err; 4640 4641 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4642 if (err) 4643 return err; 4644 4645 err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx); 4646 if (err) 4647 return err; 4648 4649 #ifdef CONFIG_CFG80211_WEXT 4650 wdev->wext.default_mgmt_key = key.idx; 4651 #endif 4652 return 0; 4653 } else if (key.defbeacon) { 4654 if (key.def_uni || !key.def_multi) 4655 return -EINVAL; 4656 4657 if (!rdev->ops->set_default_beacon_key) 4658 return -EOPNOTSUPP; 4659 4660 err = nl80211_key_allowed(wdev); 4661 if (err) 4662 return err; 4663 4664 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4665 if (err) 4666 return err; 4667 4668 return rdev_set_default_beacon_key(rdev, dev, link_id, key.idx); 4669 } else if (key.p.mode == NL80211_KEY_SET_TX && 4670 wiphy_ext_feature_isset(&rdev->wiphy, 4671 NL80211_EXT_FEATURE_EXT_KEY_ID)) { 4672 u8 *mac_addr = NULL; 4673 4674 if (info->attrs[NL80211_ATTR_MAC]) 4675 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4676 4677 if (!mac_addr || key.idx < 0 || key.idx > 1) 4678 return -EINVAL; 4679 4680 err = nl80211_validate_key_link_id(info, wdev, link_id, true); 4681 if (err) 4682 return err; 4683 4684 return rdev_add_key(rdev, dev, link_id, key.idx, 4685 NL80211_KEYTYPE_PAIRWISE, 4686 mac_addr, &key.p); 4687 } 4688 4689 return -EINVAL; 4690 } 4691 4692 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info) 4693 { 4694 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4695 int err; 4696 struct net_device *dev = info->user_ptr[1]; 4697 struct key_parse key; 4698 const u8 *mac_addr = NULL; 4699 int link_id = nl80211_link_id_or_invalid(info->attrs); 4700 struct wireless_dev *wdev = dev->ieee80211_ptr; 4701 4702 err = nl80211_parse_key(info, &key); 4703 if (err) 4704 return err; 4705 4706 if (!key.p.key) { 4707 GENL_SET_ERR_MSG(info, "no key"); 4708 return -EINVAL; 4709 } 4710 4711 if (info->attrs[NL80211_ATTR_MAC]) 4712 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4713 4714 if (key.type == -1) { 4715 if (mac_addr) 4716 key.type = NL80211_KEYTYPE_PAIRWISE; 4717 else 4718 key.type = NL80211_KEYTYPE_GROUP; 4719 } 4720 4721 /* for now */ 4722 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4723 key.type != NL80211_KEYTYPE_GROUP) { 4724 GENL_SET_ERR_MSG(info, "key type not pairwise or group"); 4725 return -EINVAL; 4726 } 4727 4728 if (key.type == NL80211_KEYTYPE_GROUP && 4729 info->attrs[NL80211_ATTR_VLAN_ID]) 4730 key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 4731 4732 if (!rdev->ops->add_key) 4733 return -EOPNOTSUPP; 4734 4735 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, 4736 key.type == NL80211_KEYTYPE_PAIRWISE, 4737 mac_addr)) { 4738 GENL_SET_ERR_MSG(info, "key setting validation failed"); 4739 return -EINVAL; 4740 } 4741 4742 err = nl80211_key_allowed(wdev); 4743 if (err) 4744 GENL_SET_ERR_MSG(info, "key not allowed"); 4745 4746 if (!err) 4747 err = nl80211_validate_key_link_id(info, wdev, link_id, 4748 key.type == NL80211_KEYTYPE_PAIRWISE); 4749 4750 if (!err) { 4751 err = rdev_add_key(rdev, dev, link_id, key.idx, 4752 key.type == NL80211_KEYTYPE_PAIRWISE, 4753 mac_addr, &key.p); 4754 if (err) 4755 GENL_SET_ERR_MSG(info, "key addition failed"); 4756 } 4757 4758 return err; 4759 } 4760 4761 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info) 4762 { 4763 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4764 int err; 4765 struct net_device *dev = info->user_ptr[1]; 4766 u8 *mac_addr = NULL; 4767 struct key_parse key; 4768 int link_id = nl80211_link_id_or_invalid(info->attrs); 4769 struct wireless_dev *wdev = dev->ieee80211_ptr; 4770 4771 err = nl80211_parse_key(info, &key); 4772 if (err) 4773 return err; 4774 4775 if (info->attrs[NL80211_ATTR_MAC]) 4776 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4777 4778 if (key.type == -1) { 4779 if (mac_addr) 4780 key.type = NL80211_KEYTYPE_PAIRWISE; 4781 else 4782 key.type = NL80211_KEYTYPE_GROUP; 4783 } 4784 4785 /* for now */ 4786 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4787 key.type != NL80211_KEYTYPE_GROUP) 4788 return -EINVAL; 4789 4790 if (!cfg80211_valid_key_idx(rdev, key.idx, 4791 key.type == NL80211_KEYTYPE_PAIRWISE)) 4792 return -EINVAL; 4793 4794 if (!rdev->ops->del_key) 4795 return -EOPNOTSUPP; 4796 4797 err = nl80211_key_allowed(wdev); 4798 4799 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr && 4800 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4801 err = -ENOENT; 4802 4803 if (!err) 4804 err = nl80211_validate_key_link_id(info, wdev, link_id, 4805 key.type == NL80211_KEYTYPE_PAIRWISE); 4806 4807 if (!err) 4808 err = rdev_del_key(rdev, dev, link_id, key.idx, 4809 key.type == NL80211_KEYTYPE_PAIRWISE, 4810 mac_addr); 4811 4812 #ifdef CONFIG_CFG80211_WEXT 4813 if (!err) { 4814 if (key.idx == wdev->wext.default_key) 4815 wdev->wext.default_key = -1; 4816 else if (key.idx == wdev->wext.default_mgmt_key) 4817 wdev->wext.default_mgmt_key = -1; 4818 } 4819 #endif 4820 4821 return err; 4822 } 4823 4824 /* This function returns an error or the number of nested attributes */ 4825 static int validate_acl_mac_addrs(struct nlattr *nl_attr) 4826 { 4827 struct nlattr *attr; 4828 int n_entries = 0, tmp; 4829 4830 nla_for_each_nested(attr, nl_attr, tmp) { 4831 if (nla_len(attr) != ETH_ALEN) 4832 return -EINVAL; 4833 4834 n_entries++; 4835 } 4836 4837 return n_entries; 4838 } 4839 4840 /* 4841 * This function parses ACL information and allocates memory for ACL data. 4842 * On successful return, the calling function is responsible to free the 4843 * ACL buffer returned by this function. 4844 */ 4845 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy, 4846 struct genl_info *info) 4847 { 4848 enum nl80211_acl_policy acl_policy; 4849 struct nlattr *attr; 4850 struct cfg80211_acl_data *acl; 4851 int i = 0, n_entries, tmp; 4852 4853 if (!wiphy->max_acl_mac_addrs) 4854 return ERR_PTR(-EOPNOTSUPP); 4855 4856 if (!info->attrs[NL80211_ATTR_ACL_POLICY]) 4857 return ERR_PTR(-EINVAL); 4858 4859 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]); 4860 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED && 4861 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED) 4862 return ERR_PTR(-EINVAL); 4863 4864 if (!info->attrs[NL80211_ATTR_MAC_ADDRS]) 4865 return ERR_PTR(-EINVAL); 4866 4867 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]); 4868 if (n_entries < 0) 4869 return ERR_PTR(n_entries); 4870 4871 if (n_entries > wiphy->max_acl_mac_addrs) 4872 return ERR_PTR(-EOPNOTSUPP); 4873 4874 acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL); 4875 if (!acl) 4876 return ERR_PTR(-ENOMEM); 4877 acl->n_acl_entries = n_entries; 4878 4879 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) { 4880 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN); 4881 i++; 4882 } 4883 acl->acl_policy = acl_policy; 4884 4885 return acl; 4886 } 4887 4888 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info) 4889 { 4890 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4891 struct net_device *dev = info->user_ptr[1]; 4892 struct cfg80211_acl_data *acl; 4893 int err; 4894 4895 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 4896 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4897 return -EOPNOTSUPP; 4898 4899 if (!dev->ieee80211_ptr->links[0].ap.beacon_interval) 4900 return -EINVAL; 4901 4902 acl = parse_acl_data(&rdev->wiphy, info); 4903 if (IS_ERR(acl)) 4904 return PTR_ERR(acl); 4905 4906 err = rdev_set_mac_acl(rdev, dev, acl); 4907 4908 kfree(acl); 4909 4910 return err; 4911 } 4912 4913 static u32 rateset_to_mask(struct ieee80211_supported_band *sband, 4914 u8 *rates, u8 rates_len) 4915 { 4916 u8 i; 4917 u32 mask = 0; 4918 4919 for (i = 0; i < rates_len; i++) { 4920 int rate = (rates[i] & 0x7f) * 5; 4921 int ridx; 4922 4923 for (ridx = 0; ridx < sband->n_bitrates; ridx++) { 4924 struct ieee80211_rate *srate = 4925 &sband->bitrates[ridx]; 4926 if (rate == srate->bitrate) { 4927 mask |= 1 << ridx; 4928 break; 4929 } 4930 } 4931 if (ridx == sband->n_bitrates) 4932 return 0; /* rate not found */ 4933 } 4934 4935 return mask; 4936 } 4937 4938 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband, 4939 u8 *rates, u8 rates_len, 4940 u8 mcs[IEEE80211_HT_MCS_MASK_LEN]) 4941 { 4942 u8 i; 4943 4944 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN); 4945 4946 for (i = 0; i < rates_len; i++) { 4947 int ridx, rbit; 4948 4949 ridx = rates[i] / 8; 4950 rbit = BIT(rates[i] % 8); 4951 4952 /* check validity */ 4953 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN)) 4954 return false; 4955 4956 /* check availability */ 4957 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN); 4958 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit) 4959 mcs[ridx] |= rbit; 4960 else 4961 return false; 4962 } 4963 4964 return true; 4965 } 4966 4967 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map) 4968 { 4969 u16 mcs_mask = 0; 4970 4971 switch (vht_mcs_map) { 4972 case IEEE80211_VHT_MCS_NOT_SUPPORTED: 4973 break; 4974 case IEEE80211_VHT_MCS_SUPPORT_0_7: 4975 mcs_mask = 0x00FF; 4976 break; 4977 case IEEE80211_VHT_MCS_SUPPORT_0_8: 4978 mcs_mask = 0x01FF; 4979 break; 4980 case IEEE80211_VHT_MCS_SUPPORT_0_9: 4981 mcs_mask = 0x03FF; 4982 break; 4983 default: 4984 break; 4985 } 4986 4987 return mcs_mask; 4988 } 4989 4990 static void vht_build_mcs_mask(u16 vht_mcs_map, 4991 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX]) 4992 { 4993 u8 nss; 4994 4995 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) { 4996 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03); 4997 vht_mcs_map >>= 2; 4998 } 4999 } 5000 5001 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband, 5002 struct nl80211_txrate_vht *txrate, 5003 u16 mcs[NL80211_VHT_NSS_MAX]) 5004 { 5005 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5006 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {}; 5007 u8 i; 5008 5009 if (!sband->vht_cap.vht_supported) 5010 return false; 5011 5012 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX); 5013 5014 /* Build vht_mcs_mask from VHT capabilities */ 5015 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5016 5017 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5018 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5019 mcs[i] = txrate->mcs[i]; 5020 else 5021 return false; 5022 } 5023 5024 return true; 5025 } 5026 5027 static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map) 5028 { 5029 switch (he_mcs_map) { 5030 case IEEE80211_HE_MCS_NOT_SUPPORTED: 5031 return 0; 5032 case IEEE80211_HE_MCS_SUPPORT_0_7: 5033 return 0x00FF; 5034 case IEEE80211_HE_MCS_SUPPORT_0_9: 5035 return 0x03FF; 5036 case IEEE80211_HE_MCS_SUPPORT_0_11: 5037 return 0xFFF; 5038 default: 5039 break; 5040 } 5041 return 0; 5042 } 5043 5044 static void he_build_mcs_mask(u16 he_mcs_map, 5045 u16 he_mcs_mask[NL80211_HE_NSS_MAX]) 5046 { 5047 u8 nss; 5048 5049 for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) { 5050 he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03); 5051 he_mcs_map >>= 2; 5052 } 5053 } 5054 5055 static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id, 5056 const struct ieee80211_sta_he_cap *he_cap) 5057 { 5058 struct net_device *dev = info->user_ptr[1]; 5059 struct wireless_dev *wdev = dev->ieee80211_ptr; 5060 struct cfg80211_chan_def *chandef; 5061 __le16 tx_mcs; 5062 5063 chandef = wdev_chandef(wdev, link_id); 5064 if (!chandef) { 5065 /* 5066 * This is probably broken, but we never maintained 5067 * a chandef in these cases, so it always was. 5068 */ 5069 return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80); 5070 } 5071 5072 switch (chandef->width) { 5073 case NL80211_CHAN_WIDTH_80P80: 5074 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80; 5075 break; 5076 case NL80211_CHAN_WIDTH_160: 5077 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160; 5078 break; 5079 default: 5080 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80; 5081 break; 5082 } 5083 5084 return le16_to_cpu(tx_mcs); 5085 } 5086 5087 static bool he_set_mcs_mask(struct genl_info *info, 5088 struct wireless_dev *wdev, 5089 struct ieee80211_supported_band *sband, 5090 struct nl80211_txrate_he *txrate, 5091 u16 mcs[NL80211_HE_NSS_MAX], 5092 unsigned int link_id) 5093 { 5094 const struct ieee80211_sta_he_cap *he_cap; 5095 u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {}; 5096 u16 tx_mcs_map = 0; 5097 u8 i; 5098 5099 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5100 if (!he_cap) 5101 return false; 5102 5103 memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX); 5104 5105 tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5106 5107 /* Build he_mcs_mask from HE capabilities */ 5108 he_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5109 5110 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5111 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5112 mcs[i] = txrate->mcs[i]; 5113 else 5114 return false; 5115 } 5116 5117 return true; 5118 } 5119 5120 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info, 5121 struct nlattr *attrs[], 5122 enum nl80211_attrs attr, 5123 struct cfg80211_bitrate_mask *mask, 5124 struct net_device *dev, 5125 bool default_all_enabled, 5126 unsigned int link_id) 5127 { 5128 struct nlattr *tb[NL80211_TXRATE_MAX + 1]; 5129 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5130 struct wireless_dev *wdev = dev->ieee80211_ptr; 5131 int rem, i; 5132 struct nlattr *tx_rates; 5133 struct ieee80211_supported_band *sband; 5134 u16 vht_tx_mcs_map, he_tx_mcs_map; 5135 5136 memset(mask, 0, sizeof(*mask)); 5137 /* Default to all rates enabled */ 5138 for (i = 0; i < NUM_NL80211_BANDS; i++) { 5139 const struct ieee80211_sta_he_cap *he_cap; 5140 5141 if (!default_all_enabled) 5142 break; 5143 5144 sband = rdev->wiphy.bands[i]; 5145 5146 if (!sband) 5147 continue; 5148 5149 mask->control[i].legacy = (1 << sband->n_bitrates) - 1; 5150 memcpy(mask->control[i].ht_mcs, 5151 sband->ht_cap.mcs.rx_mask, 5152 sizeof(mask->control[i].ht_mcs)); 5153 5154 if (sband->vht_cap.vht_supported) { 5155 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5156 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs); 5157 } 5158 5159 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5160 if (!he_cap) 5161 continue; 5162 5163 he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5164 he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs); 5165 5166 mask->control[i].he_gi = 0xFF; 5167 mask->control[i].he_ltf = 0xFF; 5168 } 5169 5170 /* if no rates are given set it back to the defaults */ 5171 if (!attrs[attr]) 5172 goto out; 5173 5174 /* The nested attribute uses enum nl80211_band as the index. This maps 5175 * directly to the enum nl80211_band values used in cfg80211. 5176 */ 5177 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8); 5178 nla_for_each_nested(tx_rates, attrs[attr], rem) { 5179 enum nl80211_band band = nla_type(tx_rates); 5180 int err; 5181 5182 if (band < 0 || band >= NUM_NL80211_BANDS) 5183 return -EINVAL; 5184 sband = rdev->wiphy.bands[band]; 5185 if (sband == NULL) 5186 return -EINVAL; 5187 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX, 5188 tx_rates, 5189 nl80211_txattr_policy, 5190 info->extack); 5191 if (err) 5192 return err; 5193 if (tb[NL80211_TXRATE_LEGACY]) { 5194 mask->control[band].legacy = rateset_to_mask( 5195 sband, 5196 nla_data(tb[NL80211_TXRATE_LEGACY]), 5197 nla_len(tb[NL80211_TXRATE_LEGACY])); 5198 if ((mask->control[band].legacy == 0) && 5199 nla_len(tb[NL80211_TXRATE_LEGACY])) 5200 return -EINVAL; 5201 } 5202 if (tb[NL80211_TXRATE_HT]) { 5203 if (!ht_rateset_to_mask( 5204 sband, 5205 nla_data(tb[NL80211_TXRATE_HT]), 5206 nla_len(tb[NL80211_TXRATE_HT]), 5207 mask->control[band].ht_mcs)) 5208 return -EINVAL; 5209 } 5210 5211 if (tb[NL80211_TXRATE_VHT]) { 5212 if (!vht_set_mcs_mask( 5213 sband, 5214 nla_data(tb[NL80211_TXRATE_VHT]), 5215 mask->control[band].vht_mcs)) 5216 return -EINVAL; 5217 } 5218 5219 if (tb[NL80211_TXRATE_GI]) { 5220 mask->control[band].gi = 5221 nla_get_u8(tb[NL80211_TXRATE_GI]); 5222 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI) 5223 return -EINVAL; 5224 } 5225 if (tb[NL80211_TXRATE_HE] && 5226 !he_set_mcs_mask(info, wdev, sband, 5227 nla_data(tb[NL80211_TXRATE_HE]), 5228 mask->control[band].he_mcs, 5229 link_id)) 5230 return -EINVAL; 5231 5232 if (tb[NL80211_TXRATE_HE_GI]) 5233 mask->control[band].he_gi = 5234 nla_get_u8(tb[NL80211_TXRATE_HE_GI]); 5235 if (tb[NL80211_TXRATE_HE_LTF]) 5236 mask->control[band].he_ltf = 5237 nla_get_u8(tb[NL80211_TXRATE_HE_LTF]); 5238 5239 if (mask->control[band].legacy == 0) { 5240 /* don't allow empty legacy rates if HT, VHT or HE 5241 * are not even supported. 5242 */ 5243 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported || 5244 rdev->wiphy.bands[band]->vht_cap.vht_supported || 5245 ieee80211_get_he_iftype_cap(sband, wdev->iftype))) 5246 return -EINVAL; 5247 5248 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) 5249 if (mask->control[band].ht_mcs[i]) 5250 goto out; 5251 5252 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) 5253 if (mask->control[band].vht_mcs[i]) 5254 goto out; 5255 5256 for (i = 0; i < NL80211_HE_NSS_MAX; i++) 5257 if (mask->control[band].he_mcs[i]) 5258 goto out; 5259 5260 /* legacy and mcs rates may not be both empty */ 5261 return -EINVAL; 5262 } 5263 } 5264 5265 out: 5266 return 0; 5267 } 5268 5269 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev, 5270 enum nl80211_band band, 5271 struct cfg80211_bitrate_mask *beacon_rate) 5272 { 5273 u32 count_ht, count_vht, count_he, i; 5274 u32 rate = beacon_rate->control[band].legacy; 5275 5276 /* Allow only one rate */ 5277 if (hweight32(rate) > 1) 5278 return -EINVAL; 5279 5280 count_ht = 0; 5281 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) { 5282 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) { 5283 return -EINVAL; 5284 } else if (beacon_rate->control[band].ht_mcs[i]) { 5285 count_ht++; 5286 if (count_ht > 1) 5287 return -EINVAL; 5288 } 5289 if (count_ht && rate) 5290 return -EINVAL; 5291 } 5292 5293 count_vht = 0; 5294 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5295 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) { 5296 return -EINVAL; 5297 } else if (beacon_rate->control[band].vht_mcs[i]) { 5298 count_vht++; 5299 if (count_vht > 1) 5300 return -EINVAL; 5301 } 5302 if (count_vht && rate) 5303 return -EINVAL; 5304 } 5305 5306 count_he = 0; 5307 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5308 if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) { 5309 return -EINVAL; 5310 } else if (beacon_rate->control[band].he_mcs[i]) { 5311 count_he++; 5312 if (count_he > 1) 5313 return -EINVAL; 5314 } 5315 if (count_he && rate) 5316 return -EINVAL; 5317 } 5318 5319 if ((count_ht && count_vht && count_he) || 5320 (!rate && !count_ht && !count_vht && !count_he)) 5321 return -EINVAL; 5322 5323 if (rate && 5324 !wiphy_ext_feature_isset(&rdev->wiphy, 5325 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) 5326 return -EINVAL; 5327 if (count_ht && 5328 !wiphy_ext_feature_isset(&rdev->wiphy, 5329 NL80211_EXT_FEATURE_BEACON_RATE_HT)) 5330 return -EINVAL; 5331 if (count_vht && 5332 !wiphy_ext_feature_isset(&rdev->wiphy, 5333 NL80211_EXT_FEATURE_BEACON_RATE_VHT)) 5334 return -EINVAL; 5335 if (count_he && 5336 !wiphy_ext_feature_isset(&rdev->wiphy, 5337 NL80211_EXT_FEATURE_BEACON_RATE_HE)) 5338 return -EINVAL; 5339 5340 return 0; 5341 } 5342 5343 static int nl80211_parse_mbssid_config(struct wiphy *wiphy, 5344 struct net_device *dev, 5345 struct nlattr *attrs, 5346 struct cfg80211_mbssid_config *config, 5347 u8 num_elems) 5348 { 5349 struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1]; 5350 5351 if (!wiphy->mbssid_max_interfaces) 5352 return -EOPNOTSUPP; 5353 5354 if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL, 5355 NULL) || 5356 !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]) 5357 return -EINVAL; 5358 5359 config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]); 5360 if (config->ema) { 5361 if (!wiphy->ema_max_profile_periodicity) 5362 return -EOPNOTSUPP; 5363 5364 if (num_elems > wiphy->ema_max_profile_periodicity) 5365 return -EINVAL; 5366 } 5367 5368 config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]); 5369 if (config->index >= wiphy->mbssid_max_interfaces || 5370 (!config->index && !num_elems)) 5371 return -EINVAL; 5372 5373 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) { 5374 u32 tx_ifindex = 5375 nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]); 5376 5377 if ((!config->index && tx_ifindex != dev->ifindex) || 5378 (config->index && tx_ifindex == dev->ifindex)) 5379 return -EINVAL; 5380 5381 if (tx_ifindex != dev->ifindex) { 5382 struct net_device *tx_netdev = 5383 dev_get_by_index(wiphy_net(wiphy), tx_ifindex); 5384 5385 if (!tx_netdev || !tx_netdev->ieee80211_ptr || 5386 tx_netdev->ieee80211_ptr->wiphy != wiphy || 5387 tx_netdev->ieee80211_ptr->iftype != 5388 NL80211_IFTYPE_AP) { 5389 dev_put(tx_netdev); 5390 return -EINVAL; 5391 } 5392 5393 config->tx_wdev = tx_netdev->ieee80211_ptr; 5394 } else { 5395 config->tx_wdev = dev->ieee80211_ptr; 5396 } 5397 } else if (!config->index) { 5398 config->tx_wdev = dev->ieee80211_ptr; 5399 } else { 5400 return -EINVAL; 5401 } 5402 5403 return 0; 5404 } 5405 5406 static struct cfg80211_mbssid_elems * 5407 nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs) 5408 { 5409 struct nlattr *nl_elems; 5410 struct cfg80211_mbssid_elems *elems; 5411 int rem_elems; 5412 u8 i = 0, num_elems = 0; 5413 5414 if (!wiphy->mbssid_max_interfaces) 5415 return ERR_PTR(-EINVAL); 5416 5417 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5418 if (num_elems >= 255) 5419 return ERR_PTR(-EINVAL); 5420 num_elems++; 5421 } 5422 5423 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5424 if (!elems) 5425 return ERR_PTR(-ENOMEM); 5426 elems->cnt = num_elems; 5427 5428 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5429 elems->elem[i].data = nla_data(nl_elems); 5430 elems->elem[i].len = nla_len(nl_elems); 5431 i++; 5432 } 5433 return elems; 5434 } 5435 5436 static struct cfg80211_rnr_elems * 5437 nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs, 5438 struct netlink_ext_ack *extack) 5439 { 5440 struct nlattr *nl_elems; 5441 struct cfg80211_rnr_elems *elems; 5442 int rem_elems; 5443 u8 i = 0, num_elems = 0; 5444 5445 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5446 int ret; 5447 5448 ret = validate_ie_attr(nl_elems, extack); 5449 if (ret) 5450 return ERR_PTR(ret); 5451 5452 num_elems++; 5453 } 5454 5455 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5456 if (!elems) 5457 return ERR_PTR(-ENOMEM); 5458 elems->cnt = num_elems; 5459 5460 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5461 elems->elem[i].data = nla_data(nl_elems); 5462 elems->elem[i].len = nla_len(nl_elems); 5463 i++; 5464 } 5465 return elems; 5466 } 5467 5468 static int nl80211_parse_he_bss_color(struct nlattr *attrs, 5469 struct cfg80211_he_bss_color *he_bss_color) 5470 { 5471 struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1]; 5472 int err; 5473 5474 err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs, 5475 he_bss_color_policy, NULL); 5476 if (err) 5477 return err; 5478 5479 if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]) 5480 return -EINVAL; 5481 5482 he_bss_color->color = 5483 nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]); 5484 he_bss_color->enabled = 5485 !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]); 5486 he_bss_color->partial = 5487 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]); 5488 5489 return 0; 5490 } 5491 5492 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev, 5493 struct nlattr *attrs[], 5494 struct cfg80211_beacon_data *bcn, 5495 struct netlink_ext_ack *extack) 5496 { 5497 bool haveinfo = false; 5498 int err; 5499 5500 memset(bcn, 0, sizeof(*bcn)); 5501 5502 bcn->link_id = nl80211_link_id(attrs); 5503 5504 if (attrs[NL80211_ATTR_BEACON_HEAD]) { 5505 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]); 5506 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]); 5507 if (!bcn->head_len) 5508 return -EINVAL; 5509 haveinfo = true; 5510 } 5511 5512 if (attrs[NL80211_ATTR_BEACON_TAIL]) { 5513 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]); 5514 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]); 5515 haveinfo = true; 5516 } 5517 5518 if (!haveinfo) 5519 return -EINVAL; 5520 5521 if (attrs[NL80211_ATTR_IE]) { 5522 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]); 5523 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]); 5524 } 5525 5526 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) { 5527 bcn->proberesp_ies = 5528 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5529 bcn->proberesp_ies_len = 5530 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5531 } 5532 5533 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) { 5534 bcn->assocresp_ies = 5535 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5536 bcn->assocresp_ies_len = 5537 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5538 } 5539 5540 if (attrs[NL80211_ATTR_PROBE_RESP]) { 5541 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]); 5542 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]); 5543 } 5544 5545 if (attrs[NL80211_ATTR_FTM_RESPONDER]) { 5546 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1]; 5547 5548 err = nla_parse_nested_deprecated(tb, 5549 NL80211_FTM_RESP_ATTR_MAX, 5550 attrs[NL80211_ATTR_FTM_RESPONDER], 5551 NULL, NULL); 5552 if (err) 5553 return err; 5554 5555 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] && 5556 wiphy_ext_feature_isset(&rdev->wiphy, 5557 NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER)) 5558 bcn->ftm_responder = 1; 5559 else 5560 return -EOPNOTSUPP; 5561 5562 if (tb[NL80211_FTM_RESP_ATTR_LCI]) { 5563 bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]); 5564 bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]); 5565 } 5566 5567 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) { 5568 bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5569 bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5570 } 5571 } else { 5572 bcn->ftm_responder = -1; 5573 } 5574 5575 if (attrs[NL80211_ATTR_HE_BSS_COLOR]) { 5576 err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR], 5577 &bcn->he_bss_color); 5578 if (err) 5579 return err; 5580 bcn->he_bss_color_valid = true; 5581 } 5582 5583 if (attrs[NL80211_ATTR_MBSSID_ELEMS]) { 5584 struct cfg80211_mbssid_elems *mbssid = 5585 nl80211_parse_mbssid_elems(&rdev->wiphy, 5586 attrs[NL80211_ATTR_MBSSID_ELEMS]); 5587 5588 if (IS_ERR(mbssid)) 5589 return PTR_ERR(mbssid); 5590 5591 bcn->mbssid_ies = mbssid; 5592 5593 if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) { 5594 struct cfg80211_rnr_elems *rnr = 5595 nl80211_parse_rnr_elems(&rdev->wiphy, 5596 attrs[NL80211_ATTR_EMA_RNR_ELEMS], 5597 extack); 5598 5599 if (IS_ERR(rnr)) 5600 return PTR_ERR(rnr); 5601 5602 if (rnr && rnr->cnt < bcn->mbssid_ies->cnt) 5603 return -EINVAL; 5604 5605 bcn->rnr_ies = rnr; 5606 } 5607 } 5608 5609 return 0; 5610 } 5611 5612 static int nl80211_parse_he_obss_pd(struct nlattr *attrs, 5613 struct ieee80211_he_obss_pd *he_obss_pd) 5614 { 5615 struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1]; 5616 int err; 5617 5618 err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs, 5619 he_obss_pd_policy, NULL); 5620 if (err) 5621 return err; 5622 5623 if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]) 5624 return -EINVAL; 5625 5626 he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]); 5627 5628 if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]) 5629 he_obss_pd->min_offset = 5630 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]); 5631 if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]) 5632 he_obss_pd->max_offset = 5633 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]); 5634 if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]) 5635 he_obss_pd->non_srg_max_offset = 5636 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]); 5637 5638 if (he_obss_pd->min_offset > he_obss_pd->max_offset) 5639 return -EINVAL; 5640 5641 if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]) 5642 memcpy(he_obss_pd->bss_color_bitmap, 5643 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]), 5644 sizeof(he_obss_pd->bss_color_bitmap)); 5645 5646 if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]) 5647 memcpy(he_obss_pd->partial_bssid_bitmap, 5648 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]), 5649 sizeof(he_obss_pd->partial_bssid_bitmap)); 5650 5651 he_obss_pd->enable = true; 5652 5653 return 0; 5654 } 5655 5656 static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev, 5657 struct nlattr *attrs, 5658 struct cfg80211_fils_discovery *fd) 5659 { 5660 struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1]; 5661 int ret; 5662 5663 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5664 NL80211_EXT_FEATURE_FILS_DISCOVERY)) 5665 return -EINVAL; 5666 5667 ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs, 5668 NULL, NULL); 5669 if (ret) 5670 return ret; 5671 5672 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] && 5673 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] && 5674 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) { 5675 fd->update = true; 5676 return 0; 5677 } 5678 5679 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] || 5680 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] || 5681 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) 5682 return -EINVAL; 5683 5684 fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5685 fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5686 fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]); 5687 fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]); 5688 fd->update = true; 5689 return 0; 5690 } 5691 5692 static int 5693 nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev, 5694 struct nlattr *attrs, 5695 struct cfg80211_unsol_bcast_probe_resp *presp) 5696 { 5697 struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1]; 5698 int ret; 5699 5700 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5701 NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP)) 5702 return -EINVAL; 5703 5704 ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX, 5705 attrs, NULL, NULL); 5706 if (ret) 5707 return ret; 5708 5709 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] && 5710 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) { 5711 presp->update = true; 5712 return 0; 5713 } 5714 5715 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] || 5716 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) 5717 return -EINVAL; 5718 5719 presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5720 presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5721 presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]); 5722 presp->update = true; 5723 return 0; 5724 } 5725 5726 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params, 5727 const struct element *rates) 5728 { 5729 int i; 5730 5731 if (!rates) 5732 return; 5733 5734 for (i = 0; i < rates->datalen; i++) { 5735 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY) 5736 params->ht_required = true; 5737 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY) 5738 params->vht_required = true; 5739 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY) 5740 params->he_required = true; 5741 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E) 5742 params->sae_h2e_required = true; 5743 } 5744 } 5745 5746 /* 5747 * Since the nl80211 API didn't include, from the beginning, attributes about 5748 * HT/VHT requirements/capabilities, we parse them out of the IEs for the 5749 * benefit of drivers that rebuild IEs in the firmware. 5750 */ 5751 static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params) 5752 { 5753 const struct cfg80211_beacon_data *bcn = ¶ms->beacon; 5754 size_t ies_len = bcn->tail_len; 5755 const u8 *ies = bcn->tail; 5756 const struct element *rates; 5757 const struct element *cap; 5758 5759 rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len); 5760 nl80211_check_ap_rate_selectors(params, rates); 5761 5762 rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len); 5763 nl80211_check_ap_rate_selectors(params, rates); 5764 5765 cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len); 5766 if (cap && cap->datalen >= sizeof(*params->ht_cap)) 5767 params->ht_cap = (void *)cap->data; 5768 cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len); 5769 if (cap && cap->datalen >= sizeof(*params->vht_cap)) 5770 params->vht_cap = (void *)cap->data; 5771 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len); 5772 if (cap && cap->datalen >= sizeof(*params->he_cap) + 1) 5773 params->he_cap = (void *)(cap->data + 1); 5774 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len); 5775 if (cap && cap->datalen >= sizeof(*params->he_oper) + 1) 5776 params->he_oper = (void *)(cap->data + 1); 5777 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len); 5778 if (cap) { 5779 if (!cap->datalen) 5780 return -EINVAL; 5781 params->eht_cap = (void *)(cap->data + 1); 5782 if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap, 5783 (const u8 *)params->eht_cap, 5784 cap->datalen - 1, true)) 5785 return -EINVAL; 5786 } 5787 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len); 5788 if (cap) { 5789 if (!cap->datalen) 5790 return -EINVAL; 5791 params->eht_oper = (void *)(cap->data + 1); 5792 if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper, 5793 cap->datalen - 1)) 5794 return -EINVAL; 5795 } 5796 return 0; 5797 } 5798 5799 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev, 5800 struct cfg80211_ap_settings *params) 5801 { 5802 struct wireless_dev *wdev; 5803 5804 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 5805 if (wdev->iftype != NL80211_IFTYPE_AP && 5806 wdev->iftype != NL80211_IFTYPE_P2P_GO) 5807 continue; 5808 5809 if (!wdev->u.ap.preset_chandef.chan) 5810 continue; 5811 5812 params->chandef = wdev->u.ap.preset_chandef; 5813 return true; 5814 } 5815 5816 return false; 5817 } 5818 5819 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev, 5820 enum nl80211_auth_type auth_type, 5821 enum nl80211_commands cmd) 5822 { 5823 if (auth_type > NL80211_AUTHTYPE_MAX) 5824 return false; 5825 5826 switch (cmd) { 5827 case NL80211_CMD_AUTHENTICATE: 5828 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 5829 auth_type == NL80211_AUTHTYPE_SAE) 5830 return false; 5831 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5832 NL80211_EXT_FEATURE_FILS_STA) && 5833 (auth_type == NL80211_AUTHTYPE_FILS_SK || 5834 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5835 auth_type == NL80211_AUTHTYPE_FILS_PK)) 5836 return false; 5837 return true; 5838 case NL80211_CMD_CONNECT: 5839 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 5840 !wiphy_ext_feature_isset(&rdev->wiphy, 5841 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 5842 auth_type == NL80211_AUTHTYPE_SAE) 5843 return false; 5844 5845 /* FILS with SK PFS or PK not supported yet */ 5846 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5847 auth_type == NL80211_AUTHTYPE_FILS_PK) 5848 return false; 5849 if (!wiphy_ext_feature_isset( 5850 &rdev->wiphy, 5851 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 5852 auth_type == NL80211_AUTHTYPE_FILS_SK) 5853 return false; 5854 return true; 5855 case NL80211_CMD_START_AP: 5856 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5857 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) && 5858 auth_type == NL80211_AUTHTYPE_SAE) 5859 return false; 5860 /* FILS not supported yet */ 5861 if (auth_type == NL80211_AUTHTYPE_FILS_SK || 5862 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5863 auth_type == NL80211_AUTHTYPE_FILS_PK) 5864 return false; 5865 return true; 5866 default: 5867 return false; 5868 } 5869 } 5870 5871 static void nl80211_send_ap_started(struct wireless_dev *wdev, 5872 unsigned int link_id) 5873 { 5874 struct wiphy *wiphy = wdev->wiphy; 5875 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 5876 struct sk_buff *msg; 5877 void *hdr; 5878 5879 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 5880 if (!msg) 5881 return; 5882 5883 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP); 5884 if (!hdr) 5885 goto out; 5886 5887 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 5888 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 5889 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 5890 NL80211_ATTR_PAD) || 5891 (wdev->u.ap.ssid_len && 5892 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 5893 wdev->u.ap.ssid)) || 5894 (wdev->valid_links && 5895 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 5896 goto out; 5897 5898 genlmsg_end(msg, hdr); 5899 5900 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 5901 NL80211_MCGRP_MLME, GFP_KERNEL); 5902 return; 5903 out: 5904 nlmsg_free(msg); 5905 } 5906 5907 static int nl80211_validate_ap_phy_operation(struct cfg80211_ap_settings *params) 5908 { 5909 struct ieee80211_channel *channel = params->chandef.chan; 5910 5911 if ((params->he_cap || params->he_oper) && 5912 (channel->flags & IEEE80211_CHAN_NO_HE)) 5913 return -EOPNOTSUPP; 5914 5915 if ((params->eht_cap || params->eht_oper) && 5916 (channel->flags & IEEE80211_CHAN_NO_EHT)) 5917 return -EOPNOTSUPP; 5918 5919 return 0; 5920 } 5921 5922 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info) 5923 { 5924 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5925 unsigned int link_id = nl80211_link_id(info->attrs); 5926 struct net_device *dev = info->user_ptr[1]; 5927 struct wireless_dev *wdev = dev->ieee80211_ptr; 5928 struct cfg80211_ap_settings *params; 5929 int err; 5930 5931 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 5932 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 5933 return -EOPNOTSUPP; 5934 5935 if (!rdev->ops->start_ap) 5936 return -EOPNOTSUPP; 5937 5938 if (wdev->links[link_id].ap.beacon_interval) 5939 return -EALREADY; 5940 5941 /* these are required for START_AP */ 5942 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] || 5943 !info->attrs[NL80211_ATTR_DTIM_PERIOD] || 5944 !info->attrs[NL80211_ATTR_BEACON_HEAD]) 5945 return -EINVAL; 5946 5947 params = kzalloc(sizeof(*params), GFP_KERNEL); 5948 if (!params) 5949 return -ENOMEM; 5950 5951 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 5952 info->extack); 5953 if (err) 5954 goto out; 5955 5956 params->beacon_interval = 5957 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 5958 params->dtim_period = 5959 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 5960 5961 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype, 5962 params->beacon_interval); 5963 if (err) 5964 goto out; 5965 5966 /* 5967 * In theory, some of these attributes should be required here 5968 * but since they were not used when the command was originally 5969 * added, keep them optional for old user space programs to let 5970 * them continue to work with drivers that do not need the 5971 * additional information -- drivers must check! 5972 */ 5973 if (info->attrs[NL80211_ATTR_SSID]) { 5974 params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 5975 params->ssid_len = 5976 nla_len(info->attrs[NL80211_ATTR_SSID]); 5977 if (params->ssid_len == 0) { 5978 err = -EINVAL; 5979 goto out; 5980 } 5981 5982 if (wdev->u.ap.ssid_len && 5983 (wdev->u.ap.ssid_len != params->ssid_len || 5984 memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) { 5985 /* require identical SSID for MLO */ 5986 err = -EINVAL; 5987 goto out; 5988 } 5989 } else if (wdev->valid_links) { 5990 /* require SSID for MLO */ 5991 err = -EINVAL; 5992 goto out; 5993 } 5994 5995 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) 5996 params->hidden_ssid = nla_get_u32( 5997 info->attrs[NL80211_ATTR_HIDDEN_SSID]); 5998 5999 params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 6000 6001 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 6002 params->auth_type = nla_get_u32( 6003 info->attrs[NL80211_ATTR_AUTH_TYPE]); 6004 if (!nl80211_valid_auth_type(rdev, params->auth_type, 6005 NL80211_CMD_START_AP)) { 6006 err = -EINVAL; 6007 goto out; 6008 } 6009 } else 6010 params->auth_type = NL80211_AUTHTYPE_AUTOMATIC; 6011 6012 err = nl80211_crypto_settings(rdev, info, ¶ms->crypto, 6013 NL80211_MAX_NR_CIPHER_SUITES); 6014 if (err) 6015 goto out; 6016 6017 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) { 6018 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) { 6019 err = -EOPNOTSUPP; 6020 goto out; 6021 } 6022 params->inactivity_timeout = nla_get_u16( 6023 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]); 6024 } 6025 6026 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 6027 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6028 err = -EINVAL; 6029 goto out; 6030 } 6031 params->p2p_ctwindow = 6032 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 6033 if (params->p2p_ctwindow != 0 && 6034 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) { 6035 err = -EINVAL; 6036 goto out; 6037 } 6038 } 6039 6040 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 6041 u8 tmp; 6042 6043 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6044 err = -EINVAL; 6045 goto out; 6046 } 6047 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 6048 params->p2p_opp_ps = tmp; 6049 if (params->p2p_opp_ps != 0 && 6050 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) { 6051 err = -EINVAL; 6052 goto out; 6053 } 6054 } 6055 6056 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 6057 err = nl80211_parse_chandef(rdev, info, ¶ms->chandef); 6058 if (err) 6059 goto out; 6060 } else if (wdev->valid_links) { 6061 /* with MLD need to specify the channel configuration */ 6062 err = -EINVAL; 6063 goto out; 6064 } else if (wdev->u.ap.preset_chandef.chan) { 6065 params->chandef = wdev->u.ap.preset_chandef; 6066 } else if (!nl80211_get_ap_channel(rdev, params)) { 6067 err = -EINVAL; 6068 goto out; 6069 } 6070 6071 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms->chandef, 6072 wdev->iftype)) { 6073 err = -EINVAL; 6074 goto out; 6075 } 6076 6077 if (info->attrs[NL80211_ATTR_TX_RATES]) { 6078 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 6079 NL80211_ATTR_TX_RATES, 6080 ¶ms->beacon_rate, 6081 dev, false, link_id); 6082 if (err) 6083 goto out; 6084 6085 err = validate_beacon_tx_rate(rdev, params->chandef.chan->band, 6086 ¶ms->beacon_rate); 6087 if (err) 6088 goto out; 6089 } 6090 6091 if (info->attrs[NL80211_ATTR_SMPS_MODE]) { 6092 params->smps_mode = 6093 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]); 6094 switch (params->smps_mode) { 6095 case NL80211_SMPS_OFF: 6096 break; 6097 case NL80211_SMPS_STATIC: 6098 if (!(rdev->wiphy.features & 6099 NL80211_FEATURE_STATIC_SMPS)) { 6100 err = -EINVAL; 6101 goto out; 6102 } 6103 break; 6104 case NL80211_SMPS_DYNAMIC: 6105 if (!(rdev->wiphy.features & 6106 NL80211_FEATURE_DYNAMIC_SMPS)) { 6107 err = -EINVAL; 6108 goto out; 6109 } 6110 break; 6111 default: 6112 err = -EINVAL; 6113 goto out; 6114 } 6115 } else { 6116 params->smps_mode = NL80211_SMPS_OFF; 6117 } 6118 6119 params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 6120 if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 6121 err = -EOPNOTSUPP; 6122 goto out; 6123 } 6124 6125 if (info->attrs[NL80211_ATTR_ACL_POLICY]) { 6126 params->acl = parse_acl_data(&rdev->wiphy, info); 6127 if (IS_ERR(params->acl)) { 6128 err = PTR_ERR(params->acl); 6129 params->acl = NULL; 6130 goto out; 6131 } 6132 } 6133 6134 params->twt_responder = 6135 nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]); 6136 6137 if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) { 6138 err = nl80211_parse_he_obss_pd( 6139 info->attrs[NL80211_ATTR_HE_OBSS_PD], 6140 ¶ms->he_obss_pd); 6141 if (err) 6142 goto out; 6143 } 6144 6145 if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) { 6146 err = nl80211_parse_fils_discovery(rdev, 6147 info->attrs[NL80211_ATTR_FILS_DISCOVERY], 6148 ¶ms->fils_discovery); 6149 if (err) 6150 goto out; 6151 } 6152 6153 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 6154 err = nl80211_parse_unsol_bcast_probe_resp( 6155 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 6156 ¶ms->unsol_bcast_probe_resp); 6157 if (err) 6158 goto out; 6159 } 6160 6161 if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) { 6162 err = nl80211_parse_mbssid_config(&rdev->wiphy, dev, 6163 info->attrs[NL80211_ATTR_MBSSID_CONFIG], 6164 ¶ms->mbssid_config, 6165 params->beacon.mbssid_ies ? 6166 params->beacon.mbssid_ies->cnt : 6167 0); 6168 if (err) 6169 goto out; 6170 } 6171 6172 if (!params->mbssid_config.ema && params->beacon.rnr_ies) { 6173 err = -EINVAL; 6174 goto out; 6175 } 6176 6177 err = nl80211_calculate_ap_params(params); 6178 if (err) 6179 goto out; 6180 6181 err = nl80211_validate_ap_phy_operation(params); 6182 if (err) 6183 goto out; 6184 6185 if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]) 6186 params->flags = nla_get_u32( 6187 info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]); 6188 else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT]) 6189 params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT; 6190 6191 if (wdev->conn_owner_nlportid && 6192 info->attrs[NL80211_ATTR_SOCKET_OWNER] && 6193 wdev->conn_owner_nlportid != info->snd_portid) { 6194 err = -EINVAL; 6195 goto out; 6196 } 6197 6198 /* FIXME: validate MLO/link-id against driver capabilities */ 6199 6200 err = rdev_start_ap(rdev, dev, params); 6201 if (!err) { 6202 wdev->links[link_id].ap.beacon_interval = params->beacon_interval; 6203 wdev->links[link_id].ap.chandef = params->chandef; 6204 wdev->u.ap.ssid_len = params->ssid_len; 6205 memcpy(wdev->u.ap.ssid, params->ssid, 6206 params->ssid_len); 6207 6208 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 6209 wdev->conn_owner_nlportid = info->snd_portid; 6210 6211 nl80211_send_ap_started(wdev, link_id); 6212 } 6213 out: 6214 kfree(params->acl); 6215 kfree(params->beacon.mbssid_ies); 6216 if (params->mbssid_config.tx_wdev && 6217 params->mbssid_config.tx_wdev->netdev && 6218 params->mbssid_config.tx_wdev->netdev != dev) 6219 dev_put(params->mbssid_config.tx_wdev->netdev); 6220 kfree(params->beacon.rnr_ies); 6221 kfree(params); 6222 6223 return err; 6224 } 6225 6226 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info) 6227 { 6228 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6229 unsigned int link_id = nl80211_link_id(info->attrs); 6230 struct net_device *dev = info->user_ptr[1]; 6231 struct wireless_dev *wdev = dev->ieee80211_ptr; 6232 struct cfg80211_ap_update *params; 6233 struct nlattr *attr; 6234 int err; 6235 6236 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6237 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6238 return -EOPNOTSUPP; 6239 6240 if (!rdev->ops->change_beacon) 6241 return -EOPNOTSUPP; 6242 6243 if (!wdev->links[link_id].ap.beacon_interval) 6244 return -EINVAL; 6245 6246 params = kzalloc(sizeof(*params), GFP_KERNEL); 6247 if (!params) 6248 return -ENOMEM; 6249 6250 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 6251 info->extack); 6252 if (err) 6253 goto out; 6254 6255 attr = info->attrs[NL80211_ATTR_FILS_DISCOVERY]; 6256 if (attr) { 6257 err = nl80211_parse_fils_discovery(rdev, attr, 6258 ¶ms->fils_discovery); 6259 if (err) 6260 goto out; 6261 } 6262 6263 attr = info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]; 6264 if (attr) { 6265 err = nl80211_parse_unsol_bcast_probe_resp(rdev, attr, 6266 ¶ms->unsol_bcast_probe_resp); 6267 if (err) 6268 goto out; 6269 } 6270 6271 err = rdev_change_beacon(rdev, dev, params); 6272 6273 out: 6274 kfree(params->beacon.mbssid_ies); 6275 kfree(params->beacon.rnr_ies); 6276 kfree(params); 6277 return err; 6278 } 6279 6280 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info) 6281 { 6282 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6283 unsigned int link_id = nl80211_link_id(info->attrs); 6284 struct net_device *dev = info->user_ptr[1]; 6285 6286 return cfg80211_stop_ap(rdev, dev, link_id, false); 6287 } 6288 6289 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = { 6290 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG }, 6291 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG }, 6292 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG }, 6293 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG }, 6294 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG }, 6295 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG }, 6296 }; 6297 6298 static int parse_station_flags(struct genl_info *info, 6299 enum nl80211_iftype iftype, 6300 struct station_parameters *params) 6301 { 6302 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1]; 6303 struct nlattr *nla; 6304 int flag; 6305 6306 /* 6307 * Try parsing the new attribute first so userspace 6308 * can specify both for older kernels. 6309 */ 6310 nla = info->attrs[NL80211_ATTR_STA_FLAGS2]; 6311 if (nla) { 6312 struct nl80211_sta_flag_update *sta_flags; 6313 6314 sta_flags = nla_data(nla); 6315 params->sta_flags_mask = sta_flags->mask; 6316 params->sta_flags_set = sta_flags->set; 6317 params->sta_flags_set &= params->sta_flags_mask; 6318 if ((params->sta_flags_mask | 6319 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID)) 6320 return -EINVAL; 6321 return 0; 6322 } 6323 6324 /* if present, parse the old attribute */ 6325 6326 nla = info->attrs[NL80211_ATTR_STA_FLAGS]; 6327 if (!nla) 6328 return 0; 6329 6330 if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack)) 6331 return -EINVAL; 6332 6333 /* 6334 * Only allow certain flags for interface types so that 6335 * other attributes are silently ignored. Remember that 6336 * this is backward compatibility code with old userspace 6337 * and shouldn't be hit in other cases anyway. 6338 */ 6339 switch (iftype) { 6340 case NL80211_IFTYPE_AP: 6341 case NL80211_IFTYPE_AP_VLAN: 6342 case NL80211_IFTYPE_P2P_GO: 6343 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6344 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6345 BIT(NL80211_STA_FLAG_WME) | 6346 BIT(NL80211_STA_FLAG_MFP); 6347 break; 6348 case NL80211_IFTYPE_P2P_CLIENT: 6349 case NL80211_IFTYPE_STATION: 6350 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6351 BIT(NL80211_STA_FLAG_TDLS_PEER); 6352 break; 6353 case NL80211_IFTYPE_MESH_POINT: 6354 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6355 BIT(NL80211_STA_FLAG_MFP) | 6356 BIT(NL80211_STA_FLAG_AUTHORIZED); 6357 break; 6358 default: 6359 return -EINVAL; 6360 } 6361 6362 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) { 6363 if (flags[flag]) { 6364 params->sta_flags_set |= (1<<flag); 6365 6366 /* no longer support new API additions in old API */ 6367 if (flag > NL80211_STA_FLAG_MAX_OLD_API) 6368 return -EINVAL; 6369 } 6370 } 6371 6372 return 0; 6373 } 6374 6375 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr) 6376 { 6377 struct nlattr *rate; 6378 u32 bitrate; 6379 u16 bitrate_compat; 6380 enum nl80211_rate_info rate_flg; 6381 6382 rate = nla_nest_start_noflag(msg, attr); 6383 if (!rate) 6384 return false; 6385 6386 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */ 6387 bitrate = cfg80211_calculate_bitrate(info); 6388 /* report 16-bit bitrate only if we can */ 6389 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0; 6390 if (bitrate > 0 && 6391 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate)) 6392 return false; 6393 if (bitrate_compat > 0 && 6394 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat)) 6395 return false; 6396 6397 switch (info->bw) { 6398 case RATE_INFO_BW_1: 6399 rate_flg = NL80211_RATE_INFO_1_MHZ_WIDTH; 6400 break; 6401 case RATE_INFO_BW_2: 6402 rate_flg = NL80211_RATE_INFO_2_MHZ_WIDTH; 6403 break; 6404 case RATE_INFO_BW_4: 6405 rate_flg = NL80211_RATE_INFO_4_MHZ_WIDTH; 6406 break; 6407 case RATE_INFO_BW_5: 6408 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH; 6409 break; 6410 case RATE_INFO_BW_8: 6411 rate_flg = NL80211_RATE_INFO_8_MHZ_WIDTH; 6412 break; 6413 case RATE_INFO_BW_10: 6414 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH; 6415 break; 6416 case RATE_INFO_BW_16: 6417 rate_flg = NL80211_RATE_INFO_16_MHZ_WIDTH; 6418 break; 6419 default: 6420 WARN_ON(1); 6421 fallthrough; 6422 case RATE_INFO_BW_20: 6423 rate_flg = 0; 6424 break; 6425 case RATE_INFO_BW_40: 6426 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH; 6427 break; 6428 case RATE_INFO_BW_80: 6429 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH; 6430 break; 6431 case RATE_INFO_BW_160: 6432 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH; 6433 break; 6434 case RATE_INFO_BW_HE_RU: 6435 rate_flg = 0; 6436 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS)); 6437 break; 6438 case RATE_INFO_BW_320: 6439 rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH; 6440 break; 6441 case RATE_INFO_BW_EHT_RU: 6442 rate_flg = 0; 6443 WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS)); 6444 break; 6445 } 6446 6447 if (rate_flg && nla_put_flag(msg, rate_flg)) 6448 return false; 6449 6450 if (info->flags & RATE_INFO_FLAGS_MCS) { 6451 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs)) 6452 return false; 6453 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6454 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6455 return false; 6456 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) { 6457 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs)) 6458 return false; 6459 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss)) 6460 return false; 6461 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6462 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6463 return false; 6464 } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) { 6465 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs)) 6466 return false; 6467 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss)) 6468 return false; 6469 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi)) 6470 return false; 6471 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm)) 6472 return false; 6473 if (info->bw == RATE_INFO_BW_HE_RU && 6474 nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC, 6475 info->he_ru_alloc)) 6476 return false; 6477 } else if (info->flags & RATE_INFO_FLAGS_S1G_MCS) { 6478 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_MCS, info->mcs)) 6479 return false; 6480 if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_NSS, info->nss)) 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_EHT_MCS) { 6486 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs)) 6487 return false; 6488 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss)) 6489 return false; 6490 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi)) 6491 return false; 6492 if (info->bw == RATE_INFO_BW_EHT_RU && 6493 nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC, 6494 info->eht_ru_alloc)) 6495 return false; 6496 } 6497 6498 nla_nest_end(msg, rate); 6499 return true; 6500 } 6501 6502 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal, 6503 int id) 6504 { 6505 void *attr; 6506 int i = 0; 6507 6508 if (!mask) 6509 return true; 6510 6511 attr = nla_nest_start_noflag(msg, id); 6512 if (!attr) 6513 return false; 6514 6515 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { 6516 if (!(mask & BIT(i))) 6517 continue; 6518 6519 if (nla_put_u8(msg, i, signal[i])) 6520 return false; 6521 } 6522 6523 nla_nest_end(msg, attr); 6524 6525 return true; 6526 } 6527 6528 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid, 6529 u32 seq, int flags, 6530 struct cfg80211_registered_device *rdev, 6531 struct net_device *dev, 6532 const u8 *mac_addr, struct station_info *sinfo) 6533 { 6534 void *hdr; 6535 struct nlattr *sinfoattr, *bss_param; 6536 6537 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 6538 if (!hdr) { 6539 cfg80211_sinfo_release_content(sinfo); 6540 return -1; 6541 } 6542 6543 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 6544 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 6545 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation)) 6546 goto nla_put_failure; 6547 6548 sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 6549 if (!sinfoattr) 6550 goto nla_put_failure; 6551 6552 #define PUT_SINFO(attr, memb, type) do { \ 6553 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 6554 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6555 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 6556 sinfo->memb)) \ 6557 goto nla_put_failure; \ 6558 } while (0) 6559 #define PUT_SINFO_U64(attr, memb) do { \ 6560 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6561 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 6562 sinfo->memb, NL80211_STA_INFO_PAD)) \ 6563 goto nla_put_failure; \ 6564 } while (0) 6565 6566 PUT_SINFO(CONNECTED_TIME, connected_time, u32); 6567 PUT_SINFO(INACTIVE_TIME, inactive_time, u32); 6568 PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at); 6569 6570 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 6571 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 6572 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 6573 (u32)sinfo->rx_bytes)) 6574 goto nla_put_failure; 6575 6576 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 6577 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 6578 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 6579 (u32)sinfo->tx_bytes)) 6580 goto nla_put_failure; 6581 6582 PUT_SINFO_U64(RX_BYTES64, rx_bytes); 6583 PUT_SINFO_U64(TX_BYTES64, tx_bytes); 6584 PUT_SINFO(LLID, llid, u16); 6585 PUT_SINFO(PLID, plid, u16); 6586 PUT_SINFO(PLINK_STATE, plink_state, u8); 6587 PUT_SINFO_U64(RX_DURATION, rx_duration); 6588 PUT_SINFO_U64(TX_DURATION, tx_duration); 6589 6590 if (wiphy_ext_feature_isset(&rdev->wiphy, 6591 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 6592 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 6593 6594 switch (rdev->wiphy.signal_type) { 6595 case CFG80211_SIGNAL_TYPE_MBM: 6596 PUT_SINFO(SIGNAL, signal, u8); 6597 PUT_SINFO(SIGNAL_AVG, signal_avg, u8); 6598 break; 6599 default: 6600 break; 6601 } 6602 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 6603 if (!nl80211_put_signal(msg, sinfo->chains, 6604 sinfo->chain_signal, 6605 NL80211_STA_INFO_CHAIN_SIGNAL)) 6606 goto nla_put_failure; 6607 } 6608 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 6609 if (!nl80211_put_signal(msg, sinfo->chains, 6610 sinfo->chain_signal_avg, 6611 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 6612 goto nla_put_failure; 6613 } 6614 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 6615 if (!nl80211_put_sta_rate(msg, &sinfo->txrate, 6616 NL80211_STA_INFO_TX_BITRATE)) 6617 goto nla_put_failure; 6618 } 6619 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 6620 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate, 6621 NL80211_STA_INFO_RX_BITRATE)) 6622 goto nla_put_failure; 6623 } 6624 6625 PUT_SINFO(RX_PACKETS, rx_packets, u32); 6626 PUT_SINFO(TX_PACKETS, tx_packets, u32); 6627 PUT_SINFO(TX_RETRIES, tx_retries, u32); 6628 PUT_SINFO(TX_FAILED, tx_failed, u32); 6629 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 6630 PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32); 6631 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32); 6632 PUT_SINFO(LOCAL_PM, local_pm, u32); 6633 PUT_SINFO(PEER_PM, peer_pm, u32); 6634 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32); 6635 PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8); 6636 PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8); 6637 6638 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 6639 bss_param = nla_nest_start_noflag(msg, 6640 NL80211_STA_INFO_BSS_PARAM); 6641 if (!bss_param) 6642 goto nla_put_failure; 6643 6644 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) && 6645 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 6646 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 6647 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 6648 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 6649 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 6650 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 6651 sinfo->bss_param.dtim_period) || 6652 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 6653 sinfo->bss_param.beacon_interval)) 6654 goto nla_put_failure; 6655 6656 nla_nest_end(msg, bss_param); 6657 } 6658 if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) && 6659 nla_put(msg, NL80211_STA_INFO_STA_FLAGS, 6660 sizeof(struct nl80211_sta_flag_update), 6661 &sinfo->sta_flags)) 6662 goto nla_put_failure; 6663 6664 PUT_SINFO_U64(T_OFFSET, t_offset); 6665 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 6666 PUT_SINFO_U64(BEACON_RX, rx_beacon); 6667 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 6668 PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32); 6669 PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 6670 if (wiphy_ext_feature_isset(&rdev->wiphy, 6671 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 6672 PUT_SINFO(ACK_SIGNAL, ack_signal, u8); 6673 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 6674 } 6675 6676 #undef PUT_SINFO 6677 #undef PUT_SINFO_U64 6678 6679 if (sinfo->pertid) { 6680 struct nlattr *tidsattr; 6681 int tid; 6682 6683 tidsattr = nla_nest_start_noflag(msg, 6684 NL80211_STA_INFO_TID_STATS); 6685 if (!tidsattr) 6686 goto nla_put_failure; 6687 6688 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 6689 struct cfg80211_tid_stats *tidstats; 6690 struct nlattr *tidattr; 6691 6692 tidstats = &sinfo->pertid[tid]; 6693 6694 if (!tidstats->filled) 6695 continue; 6696 6697 tidattr = nla_nest_start_noflag(msg, tid + 1); 6698 if (!tidattr) 6699 goto nla_put_failure; 6700 6701 #define PUT_TIDVAL_U64(attr, memb) do { \ 6702 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 6703 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 6704 tidstats->memb, NL80211_TID_STATS_PAD)) \ 6705 goto nla_put_failure; \ 6706 } while (0) 6707 6708 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 6709 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 6710 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 6711 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 6712 6713 #undef PUT_TIDVAL_U64 6714 if ((tidstats->filled & 6715 BIT(NL80211_TID_STATS_TXQ_STATS)) && 6716 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 6717 NL80211_TID_STATS_TXQ_STATS)) 6718 goto nla_put_failure; 6719 6720 nla_nest_end(msg, tidattr); 6721 } 6722 6723 nla_nest_end(msg, tidsattr); 6724 } 6725 6726 nla_nest_end(msg, sinfoattr); 6727 6728 if (sinfo->assoc_req_ies_len && 6729 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len, 6730 sinfo->assoc_req_ies)) 6731 goto nla_put_failure; 6732 6733 if (sinfo->assoc_resp_ies_len && 6734 nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len, 6735 sinfo->assoc_resp_ies)) 6736 goto nla_put_failure; 6737 6738 if (sinfo->mlo_params_valid) { 6739 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 6740 sinfo->assoc_link_id)) 6741 goto nla_put_failure; 6742 6743 if (!is_zero_ether_addr(sinfo->mld_addr) && 6744 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 6745 sinfo->mld_addr)) 6746 goto nla_put_failure; 6747 } 6748 6749 cfg80211_sinfo_release_content(sinfo); 6750 genlmsg_end(msg, hdr); 6751 return 0; 6752 6753 nla_put_failure: 6754 cfg80211_sinfo_release_content(sinfo); 6755 genlmsg_cancel(msg, hdr); 6756 return -EMSGSIZE; 6757 } 6758 6759 static int nl80211_dump_station(struct sk_buff *skb, 6760 struct netlink_callback *cb) 6761 { 6762 struct station_info sinfo; 6763 struct cfg80211_registered_device *rdev; 6764 struct wireless_dev *wdev; 6765 u8 mac_addr[ETH_ALEN]; 6766 int sta_idx = cb->args[2]; 6767 int err; 6768 6769 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 6770 if (err) 6771 return err; 6772 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 6773 __acquire(&rdev->wiphy.mtx); 6774 6775 if (!wdev->netdev) { 6776 err = -EINVAL; 6777 goto out_err; 6778 } 6779 6780 if (!rdev->ops->dump_station) { 6781 err = -EOPNOTSUPP; 6782 goto out_err; 6783 } 6784 6785 while (1) { 6786 memset(&sinfo, 0, sizeof(sinfo)); 6787 err = rdev_dump_station(rdev, wdev->netdev, sta_idx, 6788 mac_addr, &sinfo); 6789 if (err == -ENOENT) 6790 break; 6791 if (err) 6792 goto out_err; 6793 6794 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION, 6795 NETLINK_CB(cb->skb).portid, 6796 cb->nlh->nlmsg_seq, NLM_F_MULTI, 6797 rdev, wdev->netdev, mac_addr, 6798 &sinfo) < 0) 6799 goto out; 6800 6801 sta_idx++; 6802 } 6803 6804 out: 6805 cb->args[2] = sta_idx; 6806 err = skb->len; 6807 out_err: 6808 wiphy_unlock(&rdev->wiphy); 6809 6810 return err; 6811 } 6812 6813 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info) 6814 { 6815 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6816 struct net_device *dev = info->user_ptr[1]; 6817 struct station_info sinfo; 6818 struct sk_buff *msg; 6819 u8 *mac_addr = NULL; 6820 int err; 6821 6822 memset(&sinfo, 0, sizeof(sinfo)); 6823 6824 if (!info->attrs[NL80211_ATTR_MAC]) 6825 return -EINVAL; 6826 6827 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 6828 6829 if (!rdev->ops->get_station) 6830 return -EOPNOTSUPP; 6831 6832 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 6833 if (err) 6834 return err; 6835 6836 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6837 if (!msg) { 6838 cfg80211_sinfo_release_content(&sinfo); 6839 return -ENOMEM; 6840 } 6841 6842 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 6843 info->snd_portid, info->snd_seq, 0, 6844 rdev, dev, mac_addr, &sinfo) < 0) { 6845 nlmsg_free(msg); 6846 return -ENOBUFS; 6847 } 6848 6849 return genlmsg_reply(msg, info); 6850 } 6851 6852 int cfg80211_check_station_change(struct wiphy *wiphy, 6853 struct station_parameters *params, 6854 enum cfg80211_station_type statype) 6855 { 6856 if (params->listen_interval != -1 && 6857 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6858 return -EINVAL; 6859 6860 if (params->support_p2p_ps != -1 && 6861 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6862 return -EINVAL; 6863 6864 if (params->aid && 6865 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && 6866 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6867 return -EINVAL; 6868 6869 /* When you run into this, adjust the code below for the new flag */ 6870 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 6871 6872 switch (statype) { 6873 case CFG80211_STA_MESH_PEER_KERNEL: 6874 case CFG80211_STA_MESH_PEER_USER: 6875 /* 6876 * No ignoring the TDLS flag here -- the userspace mesh 6877 * code doesn't have the bug of including TDLS in the 6878 * mask everywhere. 6879 */ 6880 if (params->sta_flags_mask & 6881 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6882 BIT(NL80211_STA_FLAG_MFP) | 6883 BIT(NL80211_STA_FLAG_AUTHORIZED))) 6884 return -EINVAL; 6885 break; 6886 case CFG80211_STA_TDLS_PEER_SETUP: 6887 case CFG80211_STA_TDLS_PEER_ACTIVE: 6888 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 6889 return -EINVAL; 6890 /* ignore since it can't change */ 6891 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 6892 break; 6893 default: 6894 /* disallow mesh-specific things */ 6895 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) 6896 return -EINVAL; 6897 if (params->local_pm) 6898 return -EINVAL; 6899 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 6900 return -EINVAL; 6901 } 6902 6903 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 6904 statype != CFG80211_STA_TDLS_PEER_ACTIVE) { 6905 /* TDLS can't be set, ... */ 6906 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) 6907 return -EINVAL; 6908 /* 6909 * ... but don't bother the driver with it. This works around 6910 * a hostapd/wpa_supplicant issue -- it always includes the 6911 * TLDS_PEER flag in the mask even for AP mode. 6912 */ 6913 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 6914 } 6915 6916 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 6917 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 6918 /* reject other things that can't change */ 6919 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) 6920 return -EINVAL; 6921 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) 6922 return -EINVAL; 6923 if (params->link_sta_params.supported_rates) 6924 return -EINVAL; 6925 if (params->ext_capab || params->link_sta_params.ht_capa || 6926 params->link_sta_params.vht_capa || 6927 params->link_sta_params.he_capa || 6928 params->link_sta_params.eht_capa) 6929 return -EINVAL; 6930 if (params->sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 6931 return -EINVAL; 6932 } 6933 6934 if (statype != CFG80211_STA_AP_CLIENT && 6935 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 6936 if (params->vlan) 6937 return -EINVAL; 6938 } 6939 6940 switch (statype) { 6941 case CFG80211_STA_AP_MLME_CLIENT: 6942 /* Use this only for authorizing/unauthorizing a station */ 6943 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 6944 return -EOPNOTSUPP; 6945 break; 6946 case CFG80211_STA_AP_CLIENT: 6947 case CFG80211_STA_AP_CLIENT_UNASSOC: 6948 /* accept only the listed bits */ 6949 if (params->sta_flags_mask & 6950 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 6951 BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6952 BIT(NL80211_STA_FLAG_ASSOCIATED) | 6953 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6954 BIT(NL80211_STA_FLAG_WME) | 6955 BIT(NL80211_STA_FLAG_MFP) | 6956 BIT(NL80211_STA_FLAG_SPP_AMSDU))) 6957 return -EINVAL; 6958 6959 /* but authenticated/associated only if driver handles it */ 6960 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 6961 params->sta_flags_mask & 6962 (BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6963 BIT(NL80211_STA_FLAG_ASSOCIATED))) 6964 return -EINVAL; 6965 break; 6966 case CFG80211_STA_IBSS: 6967 case CFG80211_STA_AP_STA: 6968 /* reject any changes other than AUTHORIZED */ 6969 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED)) 6970 return -EINVAL; 6971 break; 6972 case CFG80211_STA_TDLS_PEER_SETUP: 6973 /* reject any changes other than AUTHORIZED or WME */ 6974 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 6975 BIT(NL80211_STA_FLAG_WME))) 6976 return -EINVAL; 6977 /* force (at least) rates when authorizing */ 6978 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) && 6979 !params->link_sta_params.supported_rates) 6980 return -EINVAL; 6981 break; 6982 case CFG80211_STA_TDLS_PEER_ACTIVE: 6983 /* reject any changes */ 6984 return -EINVAL; 6985 case CFG80211_STA_MESH_PEER_KERNEL: 6986 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 6987 return -EINVAL; 6988 break; 6989 case CFG80211_STA_MESH_PEER_USER: 6990 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION && 6991 params->plink_action != NL80211_PLINK_ACTION_BLOCK) 6992 return -EINVAL; 6993 break; 6994 } 6995 6996 /* 6997 * Older kernel versions ignored this attribute entirely, so don't 6998 * reject attempts to update it but mark it as unused instead so the 6999 * driver won't look at the data. 7000 */ 7001 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 7002 statype != CFG80211_STA_TDLS_PEER_SETUP) 7003 params->link_sta_params.opmode_notif_used = false; 7004 7005 return 0; 7006 } 7007 EXPORT_SYMBOL(cfg80211_check_station_change); 7008 7009 /* 7010 * Get vlan interface making sure it is running and on the right wiphy. 7011 */ 7012 static struct net_device *get_vlan(struct genl_info *info, 7013 struct cfg80211_registered_device *rdev) 7014 { 7015 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN]; 7016 struct net_device *v; 7017 int ret; 7018 7019 if (!vlanattr) 7020 return NULL; 7021 7022 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr)); 7023 if (!v) 7024 return ERR_PTR(-ENODEV); 7025 7026 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) { 7027 ret = -EINVAL; 7028 goto error; 7029 } 7030 7031 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 7032 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 7033 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 7034 ret = -EINVAL; 7035 goto error; 7036 } 7037 7038 if (!netif_running(v)) { 7039 ret = -ENETDOWN; 7040 goto error; 7041 } 7042 7043 return v; 7044 error: 7045 dev_put(v); 7046 return ERR_PTR(ret); 7047 } 7048 7049 static int nl80211_parse_sta_wme(struct genl_info *info, 7050 struct station_parameters *params) 7051 { 7052 struct nlattr *tb[NL80211_STA_WME_MAX + 1]; 7053 struct nlattr *nla; 7054 int err; 7055 7056 /* parse WME attributes if present */ 7057 if (!info->attrs[NL80211_ATTR_STA_WME]) 7058 return 0; 7059 7060 nla = info->attrs[NL80211_ATTR_STA_WME]; 7061 err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla, 7062 nl80211_sta_wme_policy, 7063 info->extack); 7064 if (err) 7065 return err; 7066 7067 if (tb[NL80211_STA_WME_UAPSD_QUEUES]) 7068 params->uapsd_queues = nla_get_u8( 7069 tb[NL80211_STA_WME_UAPSD_QUEUES]); 7070 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) 7071 return -EINVAL; 7072 7073 if (tb[NL80211_STA_WME_MAX_SP]) 7074 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]); 7075 7076 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) 7077 return -EINVAL; 7078 7079 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD; 7080 7081 return 0; 7082 } 7083 7084 static int nl80211_parse_sta_channel_info(struct genl_info *info, 7085 struct station_parameters *params) 7086 { 7087 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) { 7088 params->supported_channels = 7089 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7090 params->supported_channels_len = 7091 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7092 /* 7093 * Need to include at least one (first channel, number of 7094 * channels) tuple for each subband (checked in policy), 7095 * and must have proper tuples for the rest of the data as well. 7096 */ 7097 if (params->supported_channels_len % 2) 7098 return -EINVAL; 7099 } 7100 7101 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) { 7102 params->supported_oper_classes = 7103 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7104 params->supported_oper_classes_len = 7105 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7106 } 7107 return 0; 7108 } 7109 7110 static int nl80211_set_station_tdls(struct genl_info *info, 7111 struct station_parameters *params) 7112 { 7113 int err; 7114 /* Dummy STA entry gets updated once the peer capabilities are known */ 7115 if (info->attrs[NL80211_ATTR_PEER_AID]) 7116 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7117 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7118 params->link_sta_params.ht_capa = 7119 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7120 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7121 params->link_sta_params.vht_capa = 7122 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7123 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7124 params->link_sta_params.he_capa = 7125 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7126 params->link_sta_params.he_capa_len = 7127 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7128 7129 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7130 params->link_sta_params.eht_capa = 7131 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7132 params->link_sta_params.eht_capa_len = 7133 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7134 7135 if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa, 7136 (const u8 *)params->link_sta_params.eht_capa, 7137 params->link_sta_params.eht_capa_len, 7138 false)) 7139 return -EINVAL; 7140 } 7141 } 7142 7143 err = nl80211_parse_sta_channel_info(info, params); 7144 if (err) 7145 return err; 7146 7147 return nl80211_parse_sta_wme(info, params); 7148 } 7149 7150 static int nl80211_parse_sta_txpower_setting(struct genl_info *info, 7151 struct sta_txpwr *txpwr, 7152 bool *txpwr_set) 7153 { 7154 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7155 int idx; 7156 7157 if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) { 7158 if (!rdev->ops->set_tx_power || 7159 !wiphy_ext_feature_isset(&rdev->wiphy, 7160 NL80211_EXT_FEATURE_STA_TX_PWR)) 7161 return -EOPNOTSUPP; 7162 7163 idx = NL80211_ATTR_STA_TX_POWER_SETTING; 7164 txpwr->type = nla_get_u8(info->attrs[idx]); 7165 7166 if (txpwr->type == NL80211_TX_POWER_LIMITED) { 7167 idx = NL80211_ATTR_STA_TX_POWER; 7168 7169 if (info->attrs[idx]) 7170 txpwr->power = nla_get_s16(info->attrs[idx]); 7171 else 7172 return -EINVAL; 7173 } 7174 7175 *txpwr_set = true; 7176 } else { 7177 *txpwr_set = false; 7178 } 7179 7180 return 0; 7181 } 7182 7183 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info) 7184 { 7185 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7186 struct net_device *dev = info->user_ptr[1]; 7187 struct station_parameters params; 7188 u8 *mac_addr; 7189 int err; 7190 7191 memset(¶ms, 0, sizeof(params)); 7192 7193 if (!rdev->ops->change_station) 7194 return -EOPNOTSUPP; 7195 7196 /* 7197 * AID and listen_interval properties can be set only for unassociated 7198 * station. Include these parameters here and will check them in 7199 * cfg80211_check_station_change(). 7200 */ 7201 if (info->attrs[NL80211_ATTR_STA_AID]) 7202 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7203 7204 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7205 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7206 7207 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7208 params.listen_interval = 7209 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7210 else 7211 params.listen_interval = -1; 7212 7213 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) 7214 params.support_p2p_ps = 7215 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7216 else 7217 params.support_p2p_ps = -1; 7218 7219 if (!info->attrs[NL80211_ATTR_MAC]) 7220 return -EINVAL; 7221 7222 params.link_sta_params.link_id = 7223 nl80211_link_id_or_invalid(info->attrs); 7224 7225 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7226 /* If MLD_ADDR attribute is set then this is an MLD station 7227 * and the MLD_ADDR attribute holds the MLD address and the 7228 * MAC attribute holds for the LINK address. 7229 * In that case, the link_id is also expected to be valid. 7230 */ 7231 if (params.link_sta_params.link_id < 0) 7232 return -EINVAL; 7233 7234 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7235 params.link_sta_params.mld_mac = mac_addr; 7236 params.link_sta_params.link_mac = 7237 nla_data(info->attrs[NL80211_ATTR_MAC]); 7238 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7239 return -EINVAL; 7240 } else { 7241 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7242 } 7243 7244 7245 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 7246 params.link_sta_params.supported_rates = 7247 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7248 params.link_sta_params.supported_rates_len = 7249 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7250 } 7251 7252 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7253 params.capability = 7254 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7255 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7256 } 7257 7258 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7259 params.ext_capab = 7260 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7261 params.ext_capab_len = 7262 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7263 } 7264 7265 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7266 return -EINVAL; 7267 7268 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7269 params.plink_action = 7270 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7271 7272 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) { 7273 params.plink_state = 7274 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]); 7275 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) 7276 params.peer_aid = nla_get_u16( 7277 info->attrs[NL80211_ATTR_MESH_PEER_AID]); 7278 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE; 7279 } 7280 7281 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) 7282 params.local_pm = nla_get_u32( 7283 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]); 7284 7285 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7286 params.link_sta_params.opmode_notif_used = true; 7287 params.link_sta_params.opmode_notif = 7288 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7289 } 7290 7291 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7292 params.link_sta_params.he_6ghz_capa = 7293 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7294 7295 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7296 params.airtime_weight = 7297 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7298 7299 if (params.airtime_weight && 7300 !wiphy_ext_feature_isset(&rdev->wiphy, 7301 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7302 return -EOPNOTSUPP; 7303 7304 err = nl80211_parse_sta_txpower_setting(info, 7305 ¶ms.link_sta_params.txpwr, 7306 ¶ms.link_sta_params.txpwr_set); 7307 if (err) 7308 return err; 7309 7310 /* Include parameters for TDLS peer (will check later) */ 7311 err = nl80211_set_station_tdls(info, ¶ms); 7312 if (err) 7313 return err; 7314 7315 params.vlan = get_vlan(info, rdev); 7316 if (IS_ERR(params.vlan)) 7317 return PTR_ERR(params.vlan); 7318 7319 switch (dev->ieee80211_ptr->iftype) { 7320 case NL80211_IFTYPE_AP: 7321 case NL80211_IFTYPE_AP_VLAN: 7322 case NL80211_IFTYPE_P2P_GO: 7323 case NL80211_IFTYPE_P2P_CLIENT: 7324 case NL80211_IFTYPE_STATION: 7325 case NL80211_IFTYPE_ADHOC: 7326 case NL80211_IFTYPE_MESH_POINT: 7327 break; 7328 default: 7329 err = -EOPNOTSUPP; 7330 goto out_put_vlan; 7331 } 7332 7333 /* driver will call cfg80211_check_station_change() */ 7334 err = rdev_change_station(rdev, dev, mac_addr, ¶ms); 7335 7336 out_put_vlan: 7337 dev_put(params.vlan); 7338 7339 return err; 7340 } 7341 7342 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info) 7343 { 7344 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7345 int err; 7346 struct net_device *dev = info->user_ptr[1]; 7347 struct wireless_dev *wdev = dev->ieee80211_ptr; 7348 struct station_parameters params; 7349 u8 *mac_addr = NULL; 7350 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7351 BIT(NL80211_STA_FLAG_ASSOCIATED); 7352 7353 memset(¶ms, 0, sizeof(params)); 7354 7355 if (!rdev->ops->add_station) 7356 return -EOPNOTSUPP; 7357 7358 if (!info->attrs[NL80211_ATTR_MAC]) 7359 return -EINVAL; 7360 7361 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7362 return -EINVAL; 7363 7364 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 7365 return -EINVAL; 7366 7367 if (!info->attrs[NL80211_ATTR_STA_AID] && 7368 !info->attrs[NL80211_ATTR_PEER_AID]) 7369 return -EINVAL; 7370 7371 params.link_sta_params.link_id = 7372 nl80211_link_id_or_invalid(info->attrs); 7373 7374 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7375 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7376 params.link_sta_params.mld_mac = mac_addr; 7377 params.link_sta_params.link_mac = 7378 nla_data(info->attrs[NL80211_ATTR_MAC]); 7379 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7380 return -EINVAL; 7381 } else { 7382 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7383 } 7384 7385 params.link_sta_params.supported_rates = 7386 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7387 params.link_sta_params.supported_rates_len = 7388 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7389 params.listen_interval = 7390 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7391 7392 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7393 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7394 7395 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) { 7396 params.support_p2p_ps = 7397 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7398 } else { 7399 /* 7400 * if not specified, assume it's supported for P2P GO interface, 7401 * and is NOT supported for AP interface 7402 */ 7403 params.support_p2p_ps = 7404 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO; 7405 } 7406 7407 if (info->attrs[NL80211_ATTR_PEER_AID]) 7408 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7409 else 7410 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7411 7412 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7413 params.capability = 7414 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7415 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7416 } 7417 7418 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7419 params.ext_capab = 7420 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7421 params.ext_capab_len = 7422 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7423 } 7424 7425 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7426 params.link_sta_params.ht_capa = 7427 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7428 7429 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7430 params.link_sta_params.vht_capa = 7431 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7432 7433 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7434 params.link_sta_params.he_capa = 7435 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7436 params.link_sta_params.he_capa_len = 7437 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7438 7439 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7440 params.link_sta_params.eht_capa = 7441 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7442 params.link_sta_params.eht_capa_len = 7443 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7444 7445 if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa, 7446 (const u8 *)params.link_sta_params.eht_capa, 7447 params.link_sta_params.eht_capa_len, 7448 false)) 7449 return -EINVAL; 7450 } 7451 } 7452 7453 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7454 params.link_sta_params.he_6ghz_capa = 7455 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7456 7457 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7458 params.link_sta_params.opmode_notif_used = true; 7459 params.link_sta_params.opmode_notif = 7460 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7461 } 7462 7463 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7464 params.plink_action = 7465 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7466 7467 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7468 params.airtime_weight = 7469 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7470 7471 if (params.airtime_weight && 7472 !wiphy_ext_feature_isset(&rdev->wiphy, 7473 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7474 return -EOPNOTSUPP; 7475 7476 err = nl80211_parse_sta_txpower_setting(info, 7477 ¶ms.link_sta_params.txpwr, 7478 ¶ms.link_sta_params.txpwr_set); 7479 if (err) 7480 return err; 7481 7482 err = nl80211_parse_sta_channel_info(info, ¶ms); 7483 if (err) 7484 return err; 7485 7486 err = nl80211_parse_sta_wme(info, ¶ms); 7487 if (err) 7488 return err; 7489 7490 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7491 return -EINVAL; 7492 7493 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT 7494 * as userspace might just pass through the capabilities from the IEs 7495 * directly, rather than enforcing this restriction and returning an 7496 * error in this case. 7497 */ 7498 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) { 7499 params.link_sta_params.ht_capa = NULL; 7500 params.link_sta_params.vht_capa = NULL; 7501 7502 /* HE and EHT require WME */ 7503 if (params.link_sta_params.he_capa_len || 7504 params.link_sta_params.he_6ghz_capa || 7505 params.link_sta_params.eht_capa_len) 7506 return -EINVAL; 7507 } 7508 7509 /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */ 7510 if (params.link_sta_params.he_6ghz_capa && 7511 (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa)) 7512 return -EINVAL; 7513 7514 /* When you run into this, adjust the code below for the new flag */ 7515 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8); 7516 7517 switch (dev->ieee80211_ptr->iftype) { 7518 case NL80211_IFTYPE_AP: 7519 case NL80211_IFTYPE_AP_VLAN: 7520 case NL80211_IFTYPE_P2P_GO: 7521 /* ignore WME attributes if iface/sta is not capable */ 7522 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) || 7523 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) 7524 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7525 7526 /* TDLS peers cannot be added */ 7527 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7528 info->attrs[NL80211_ATTR_PEER_AID]) 7529 return -EINVAL; 7530 /* but don't bother the driver with it */ 7531 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7532 7533 /* allow authenticated/associated only if driver handles it */ 7534 if (!(rdev->wiphy.features & 7535 NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 7536 params.sta_flags_mask & auth_assoc) 7537 return -EINVAL; 7538 7539 if (!wiphy_ext_feature_isset(&rdev->wiphy, 7540 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT) && 7541 params.sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU)) 7542 return -EINVAL; 7543 7544 /* Older userspace, or userspace wanting to be compatible with 7545 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth 7546 * and assoc flags in the mask, but assumes the station will be 7547 * added as associated anyway since this was the required driver 7548 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was 7549 * introduced. 7550 * In order to not bother drivers with this quirk in the API 7551 * set the flags in both the mask and set for new stations in 7552 * this case. 7553 */ 7554 if (!(params.sta_flags_mask & auth_assoc)) { 7555 params.sta_flags_mask |= auth_assoc; 7556 params.sta_flags_set |= auth_assoc; 7557 } 7558 7559 /* must be last in here for error handling */ 7560 params.vlan = get_vlan(info, rdev); 7561 if (IS_ERR(params.vlan)) 7562 return PTR_ERR(params.vlan); 7563 break; 7564 case NL80211_IFTYPE_MESH_POINT: 7565 /* ignore uAPSD data */ 7566 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7567 7568 /* associated is disallowed */ 7569 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) 7570 return -EINVAL; 7571 /* TDLS peers cannot be added */ 7572 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7573 info->attrs[NL80211_ATTR_PEER_AID]) 7574 return -EINVAL; 7575 break; 7576 case NL80211_IFTYPE_STATION: 7577 case NL80211_IFTYPE_P2P_CLIENT: 7578 /* ignore uAPSD data */ 7579 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7580 7581 /* these are disallowed */ 7582 if (params.sta_flags_mask & 7583 (BIT(NL80211_STA_FLAG_ASSOCIATED) | 7584 BIT(NL80211_STA_FLAG_AUTHENTICATED))) 7585 return -EINVAL; 7586 /* Only TDLS peers can be added */ 7587 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 7588 return -EINVAL; 7589 /* Can only add if TDLS ... */ 7590 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS)) 7591 return -EOPNOTSUPP; 7592 /* ... with external setup is supported */ 7593 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP)) 7594 return -EOPNOTSUPP; 7595 /* 7596 * Older wpa_supplicant versions always mark the TDLS peer 7597 * as authorized, but it shouldn't yet be. 7598 */ 7599 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED); 7600 break; 7601 default: 7602 return -EOPNOTSUPP; 7603 } 7604 7605 /* be aware of params.vlan when changing code here */ 7606 7607 if (wdev->valid_links) { 7608 if (params.link_sta_params.link_id < 0) { 7609 err = -EINVAL; 7610 goto out; 7611 } 7612 if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) { 7613 err = -ENOLINK; 7614 goto out; 7615 } 7616 } else { 7617 if (params.link_sta_params.link_id >= 0) { 7618 err = -EINVAL; 7619 goto out; 7620 } 7621 } 7622 err = rdev_add_station(rdev, dev, mac_addr, ¶ms); 7623 out: 7624 dev_put(params.vlan); 7625 return err; 7626 } 7627 7628 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info) 7629 { 7630 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7631 struct net_device *dev = info->user_ptr[1]; 7632 struct wireless_dev *wdev = dev->ieee80211_ptr; 7633 struct station_del_parameters params; 7634 int link_id = nl80211_link_id_or_invalid(info->attrs); 7635 7636 memset(¶ms, 0, sizeof(params)); 7637 7638 if (info->attrs[NL80211_ATTR_MAC]) 7639 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 7640 7641 switch (wdev->iftype) { 7642 case NL80211_IFTYPE_AP: 7643 case NL80211_IFTYPE_AP_VLAN: 7644 case NL80211_IFTYPE_MESH_POINT: 7645 case NL80211_IFTYPE_P2P_GO: 7646 /* always accept these */ 7647 break; 7648 case NL80211_IFTYPE_ADHOC: 7649 /* conditionally accept */ 7650 if (wiphy_ext_feature_isset(&rdev->wiphy, 7651 NL80211_EXT_FEATURE_DEL_IBSS_STA)) 7652 break; 7653 return -EINVAL; 7654 default: 7655 return -EINVAL; 7656 } 7657 7658 if (!rdev->ops->del_station) 7659 return -EOPNOTSUPP; 7660 7661 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) { 7662 params.subtype = 7663 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]); 7664 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 && 7665 params.subtype != IEEE80211_STYPE_DEAUTH >> 4) 7666 return -EINVAL; 7667 } else { 7668 /* Default to Deauthentication frame */ 7669 params.subtype = IEEE80211_STYPE_DEAUTH >> 4; 7670 } 7671 7672 if (info->attrs[NL80211_ATTR_REASON_CODE]) { 7673 params.reason_code = 7674 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 7675 if (params.reason_code == 0) 7676 return -EINVAL; /* 0 is reserved */ 7677 } else { 7678 /* Default to reason code 2 */ 7679 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID; 7680 } 7681 7682 /* Link ID not expected in case of non-ML operation */ 7683 if (!wdev->valid_links && link_id != -1) 7684 return -EINVAL; 7685 7686 /* If given, a valid link ID should be passed during MLO */ 7687 if (wdev->valid_links && link_id >= 0 && 7688 !(wdev->valid_links & BIT(link_id))) 7689 return -EINVAL; 7690 7691 params.link_id = link_id; 7692 7693 return rdev_del_station(rdev, dev, ¶ms); 7694 } 7695 7696 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq, 7697 int flags, struct net_device *dev, 7698 u8 *dst, u8 *next_hop, 7699 struct mpath_info *pinfo) 7700 { 7701 void *hdr; 7702 struct nlattr *pinfoattr; 7703 7704 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH); 7705 if (!hdr) 7706 return -1; 7707 7708 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 7709 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) || 7710 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) || 7711 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation)) 7712 goto nla_put_failure; 7713 7714 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO); 7715 if (!pinfoattr) 7716 goto nla_put_failure; 7717 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) && 7718 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN, 7719 pinfo->frame_qlen)) 7720 goto nla_put_failure; 7721 if (((pinfo->filled & MPATH_INFO_SN) && 7722 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) || 7723 ((pinfo->filled & MPATH_INFO_METRIC) && 7724 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC, 7725 pinfo->metric)) || 7726 ((pinfo->filled & MPATH_INFO_EXPTIME) && 7727 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME, 7728 pinfo->exptime)) || 7729 ((pinfo->filled & MPATH_INFO_FLAGS) && 7730 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS, 7731 pinfo->flags)) || 7732 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) && 7733 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT, 7734 pinfo->discovery_timeout)) || 7735 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) && 7736 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES, 7737 pinfo->discovery_retries)) || 7738 ((pinfo->filled & MPATH_INFO_HOP_COUNT) && 7739 nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT, 7740 pinfo->hop_count)) || 7741 ((pinfo->filled & MPATH_INFO_PATH_CHANGE) && 7742 nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE, 7743 pinfo->path_change_count))) 7744 goto nla_put_failure; 7745 7746 nla_nest_end(msg, pinfoattr); 7747 7748 genlmsg_end(msg, hdr); 7749 return 0; 7750 7751 nla_put_failure: 7752 genlmsg_cancel(msg, hdr); 7753 return -EMSGSIZE; 7754 } 7755 7756 static int nl80211_dump_mpath(struct sk_buff *skb, 7757 struct netlink_callback *cb) 7758 { 7759 struct mpath_info pinfo; 7760 struct cfg80211_registered_device *rdev; 7761 struct wireless_dev *wdev; 7762 u8 dst[ETH_ALEN]; 7763 u8 next_hop[ETH_ALEN]; 7764 int path_idx = cb->args[2]; 7765 int err; 7766 7767 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7768 if (err) 7769 return err; 7770 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7771 __acquire(&rdev->wiphy.mtx); 7772 7773 if (!rdev->ops->dump_mpath) { 7774 err = -EOPNOTSUPP; 7775 goto out_err; 7776 } 7777 7778 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 7779 err = -EOPNOTSUPP; 7780 goto out_err; 7781 } 7782 7783 while (1) { 7784 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst, 7785 next_hop, &pinfo); 7786 if (err == -ENOENT) 7787 break; 7788 if (err) 7789 goto out_err; 7790 7791 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 7792 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7793 wdev->netdev, dst, next_hop, 7794 &pinfo) < 0) 7795 goto out; 7796 7797 path_idx++; 7798 } 7799 7800 out: 7801 cb->args[2] = path_idx; 7802 err = skb->len; 7803 out_err: 7804 wiphy_unlock(&rdev->wiphy); 7805 return err; 7806 } 7807 7808 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info) 7809 { 7810 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7811 int err; 7812 struct net_device *dev = info->user_ptr[1]; 7813 struct mpath_info pinfo; 7814 struct sk_buff *msg; 7815 u8 *dst = NULL; 7816 u8 next_hop[ETH_ALEN]; 7817 7818 memset(&pinfo, 0, sizeof(pinfo)); 7819 7820 if (!info->attrs[NL80211_ATTR_MAC]) 7821 return -EINVAL; 7822 7823 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7824 7825 if (!rdev->ops->get_mpath) 7826 return -EOPNOTSUPP; 7827 7828 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7829 return -EOPNOTSUPP; 7830 7831 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo); 7832 if (err) 7833 return err; 7834 7835 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7836 if (!msg) 7837 return -ENOMEM; 7838 7839 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 7840 dev, dst, next_hop, &pinfo) < 0) { 7841 nlmsg_free(msg); 7842 return -ENOBUFS; 7843 } 7844 7845 return genlmsg_reply(msg, info); 7846 } 7847 7848 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info) 7849 { 7850 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7851 struct net_device *dev = info->user_ptr[1]; 7852 u8 *dst = NULL; 7853 u8 *next_hop = NULL; 7854 7855 if (!info->attrs[NL80211_ATTR_MAC]) 7856 return -EINVAL; 7857 7858 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 7859 return -EINVAL; 7860 7861 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7862 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 7863 7864 if (!rdev->ops->change_mpath) 7865 return -EOPNOTSUPP; 7866 7867 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7868 return -EOPNOTSUPP; 7869 7870 return rdev_change_mpath(rdev, dev, dst, next_hop); 7871 } 7872 7873 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info) 7874 { 7875 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7876 struct net_device *dev = info->user_ptr[1]; 7877 u8 *dst = NULL; 7878 u8 *next_hop = NULL; 7879 7880 if (!info->attrs[NL80211_ATTR_MAC]) 7881 return -EINVAL; 7882 7883 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 7884 return -EINVAL; 7885 7886 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7887 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 7888 7889 if (!rdev->ops->add_mpath) 7890 return -EOPNOTSUPP; 7891 7892 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7893 return -EOPNOTSUPP; 7894 7895 return rdev_add_mpath(rdev, dev, dst, next_hop); 7896 } 7897 7898 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info) 7899 { 7900 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7901 struct net_device *dev = info->user_ptr[1]; 7902 u8 *dst = NULL; 7903 7904 if (info->attrs[NL80211_ATTR_MAC]) 7905 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7906 7907 if (!rdev->ops->del_mpath) 7908 return -EOPNOTSUPP; 7909 7910 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7911 return -EOPNOTSUPP; 7912 7913 return rdev_del_mpath(rdev, dev, dst); 7914 } 7915 7916 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info) 7917 { 7918 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7919 int err; 7920 struct net_device *dev = info->user_ptr[1]; 7921 struct mpath_info pinfo; 7922 struct sk_buff *msg; 7923 u8 *dst = NULL; 7924 u8 mpp[ETH_ALEN]; 7925 7926 memset(&pinfo, 0, sizeof(pinfo)); 7927 7928 if (!info->attrs[NL80211_ATTR_MAC]) 7929 return -EINVAL; 7930 7931 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7932 7933 if (!rdev->ops->get_mpp) 7934 return -EOPNOTSUPP; 7935 7936 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7937 return -EOPNOTSUPP; 7938 7939 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo); 7940 if (err) 7941 return err; 7942 7943 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7944 if (!msg) 7945 return -ENOMEM; 7946 7947 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 7948 dev, dst, mpp, &pinfo) < 0) { 7949 nlmsg_free(msg); 7950 return -ENOBUFS; 7951 } 7952 7953 return genlmsg_reply(msg, info); 7954 } 7955 7956 static int nl80211_dump_mpp(struct sk_buff *skb, 7957 struct netlink_callback *cb) 7958 { 7959 struct mpath_info pinfo; 7960 struct cfg80211_registered_device *rdev; 7961 struct wireless_dev *wdev; 7962 u8 dst[ETH_ALEN]; 7963 u8 mpp[ETH_ALEN]; 7964 int path_idx = cb->args[2]; 7965 int err; 7966 7967 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7968 if (err) 7969 return err; 7970 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7971 __acquire(&rdev->wiphy.mtx); 7972 7973 if (!rdev->ops->dump_mpp) { 7974 err = -EOPNOTSUPP; 7975 goto out_err; 7976 } 7977 7978 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 7979 err = -EOPNOTSUPP; 7980 goto out_err; 7981 } 7982 7983 while (1) { 7984 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst, 7985 mpp, &pinfo); 7986 if (err == -ENOENT) 7987 break; 7988 if (err) 7989 goto out_err; 7990 7991 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 7992 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7993 wdev->netdev, dst, mpp, 7994 &pinfo) < 0) 7995 goto out; 7996 7997 path_idx++; 7998 } 7999 8000 out: 8001 cb->args[2] = path_idx; 8002 err = skb->len; 8003 out_err: 8004 wiphy_unlock(&rdev->wiphy); 8005 return err; 8006 } 8007 8008 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info) 8009 { 8010 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8011 struct net_device *dev = info->user_ptr[1]; 8012 struct bss_parameters params; 8013 8014 memset(¶ms, 0, sizeof(params)); 8015 params.link_id = nl80211_link_id_or_invalid(info->attrs); 8016 /* default to not changing parameters */ 8017 params.use_cts_prot = -1; 8018 params.use_short_preamble = -1; 8019 params.use_short_slot_time = -1; 8020 params.ap_isolate = -1; 8021 params.ht_opmode = -1; 8022 params.p2p_ctwindow = -1; 8023 params.p2p_opp_ps = -1; 8024 8025 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT]) 8026 params.use_cts_prot = 8027 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]); 8028 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]) 8029 params.use_short_preamble = 8030 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]); 8031 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]) 8032 params.use_short_slot_time = 8033 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]); 8034 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 8035 params.basic_rates = 8036 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 8037 params.basic_rates_len = 8038 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 8039 } 8040 if (info->attrs[NL80211_ATTR_AP_ISOLATE]) 8041 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]); 8042 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE]) 8043 params.ht_opmode = 8044 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]); 8045 8046 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 8047 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8048 return -EINVAL; 8049 params.p2p_ctwindow = 8050 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 8051 if (params.p2p_ctwindow != 0 && 8052 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) 8053 return -EINVAL; 8054 } 8055 8056 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 8057 u8 tmp; 8058 8059 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8060 return -EINVAL; 8061 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 8062 params.p2p_opp_ps = tmp; 8063 if (params.p2p_opp_ps && 8064 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) 8065 return -EINVAL; 8066 } 8067 8068 if (!rdev->ops->change_bss) 8069 return -EOPNOTSUPP; 8070 8071 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 8072 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8073 return -EOPNOTSUPP; 8074 8075 return rdev_change_bss(rdev, dev, ¶ms); 8076 } 8077 8078 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info) 8079 { 8080 char *data = NULL; 8081 bool is_indoor; 8082 enum nl80211_user_reg_hint_type user_reg_hint_type; 8083 u32 owner_nlportid; 8084 8085 /* 8086 * You should only get this when cfg80211 hasn't yet initialized 8087 * completely when built-in to the kernel right between the time 8088 * window between nl80211_init() and regulatory_init(), if that is 8089 * even possible. 8090 */ 8091 if (unlikely(!rcu_access_pointer(cfg80211_regdomain))) 8092 return -EINPROGRESS; 8093 8094 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]) 8095 user_reg_hint_type = 8096 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]); 8097 else 8098 user_reg_hint_type = NL80211_USER_REG_HINT_USER; 8099 8100 switch (user_reg_hint_type) { 8101 case NL80211_USER_REG_HINT_USER: 8102 case NL80211_USER_REG_HINT_CELL_BASE: 8103 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8104 return -EINVAL; 8105 8106 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8107 return regulatory_hint_user(data, user_reg_hint_type); 8108 case NL80211_USER_REG_HINT_INDOOR: 8109 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 8110 owner_nlportid = info->snd_portid; 8111 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR]; 8112 } else { 8113 owner_nlportid = 0; 8114 is_indoor = true; 8115 } 8116 8117 return regulatory_hint_indoor(is_indoor, owner_nlportid); 8118 default: 8119 return -EINVAL; 8120 } 8121 } 8122 8123 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info) 8124 { 8125 return reg_reload_regdb(); 8126 } 8127 8128 static int nl80211_get_mesh_config(struct sk_buff *skb, 8129 struct genl_info *info) 8130 { 8131 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8132 struct net_device *dev = info->user_ptr[1]; 8133 struct wireless_dev *wdev = dev->ieee80211_ptr; 8134 struct mesh_config cur_params; 8135 int err = 0; 8136 void *hdr; 8137 struct nlattr *pinfoattr; 8138 struct sk_buff *msg; 8139 8140 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8141 return -EOPNOTSUPP; 8142 8143 if (!rdev->ops->get_mesh_config) 8144 return -EOPNOTSUPP; 8145 8146 /* If not connected, get default parameters */ 8147 if (!wdev->u.mesh.id_len) 8148 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params)); 8149 else 8150 err = rdev_get_mesh_config(rdev, dev, &cur_params); 8151 8152 if (err) 8153 return err; 8154 8155 /* Draw up a netlink message to send back */ 8156 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8157 if (!msg) 8158 return -ENOMEM; 8159 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8160 NL80211_CMD_GET_MESH_CONFIG); 8161 if (!hdr) 8162 goto out; 8163 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG); 8164 if (!pinfoattr) 8165 goto nla_put_failure; 8166 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 8167 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT, 8168 cur_params.dot11MeshRetryTimeout) || 8169 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT, 8170 cur_params.dot11MeshConfirmTimeout) || 8171 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT, 8172 cur_params.dot11MeshHoldingTimeout) || 8173 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS, 8174 cur_params.dot11MeshMaxPeerLinks) || 8175 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES, 8176 cur_params.dot11MeshMaxRetries) || 8177 nla_put_u8(msg, NL80211_MESHCONF_TTL, 8178 cur_params.dot11MeshTTL) || 8179 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL, 8180 cur_params.element_ttl) || 8181 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8182 cur_params.auto_open_plinks) || 8183 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8184 cur_params.dot11MeshNbrOffsetMaxNeighbor) || 8185 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8186 cur_params.dot11MeshHWMPmaxPREQretries) || 8187 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME, 8188 cur_params.path_refresh_time) || 8189 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8190 cur_params.min_discovery_timeout) || 8191 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8192 cur_params.dot11MeshHWMPactivePathTimeout) || 8193 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8194 cur_params.dot11MeshHWMPpreqMinInterval) || 8195 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8196 cur_params.dot11MeshHWMPperrMinInterval) || 8197 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8198 cur_params.dot11MeshHWMPnetDiameterTraversalTime) || 8199 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE, 8200 cur_params.dot11MeshHWMPRootMode) || 8201 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8202 cur_params.dot11MeshHWMPRannInterval) || 8203 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8204 cur_params.dot11MeshGateAnnouncementProtocol) || 8205 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING, 8206 cur_params.dot11MeshForwarding) || 8207 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD, 8208 cur_params.rssi_threshold) || 8209 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE, 8210 cur_params.ht_opmode) || 8211 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8212 cur_params.dot11MeshHWMPactivePathToRootTimeout) || 8213 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8214 cur_params.dot11MeshHWMProotInterval) || 8215 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8216 cur_params.dot11MeshHWMPconfirmationInterval) || 8217 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE, 8218 cur_params.power_mode) || 8219 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW, 8220 cur_params.dot11MeshAwakeWindowDuration) || 8221 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT, 8222 cur_params.plink_timeout) || 8223 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE, 8224 cur_params.dot11MeshConnectedToMeshGate) || 8225 nla_put_u8(msg, NL80211_MESHCONF_NOLEARN, 8226 cur_params.dot11MeshNolearn) || 8227 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS, 8228 cur_params.dot11MeshConnectedToAuthServer)) 8229 goto nla_put_failure; 8230 nla_nest_end(msg, pinfoattr); 8231 genlmsg_end(msg, hdr); 8232 return genlmsg_reply(msg, info); 8233 8234 nla_put_failure: 8235 out: 8236 nlmsg_free(msg); 8237 return -ENOBUFS; 8238 } 8239 8240 static const struct nla_policy 8241 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = { 8242 [NL80211_MESHCONF_RETRY_TIMEOUT] = 8243 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8244 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = 8245 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8246 [NL80211_MESHCONF_HOLDING_TIMEOUT] = 8247 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8248 [NL80211_MESHCONF_MAX_PEER_LINKS] = 8249 NLA_POLICY_RANGE(NLA_U16, 0, 255), 8250 [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16), 8251 [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8252 [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8253 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1), 8254 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = 8255 NLA_POLICY_RANGE(NLA_U32, 1, 255), 8256 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 }, 8257 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 }, 8258 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1), 8259 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 }, 8260 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = 8261 NLA_POLICY_MIN(NLA_U16, 1), 8262 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = 8263 NLA_POLICY_MIN(NLA_U16, 1), 8264 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = 8265 NLA_POLICY_MIN(NLA_U16, 1), 8266 [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4), 8267 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = 8268 NLA_POLICY_MIN(NLA_U16, 1), 8269 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1), 8270 [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1), 8271 [NL80211_MESHCONF_RSSI_THRESHOLD] = 8272 NLA_POLICY_RANGE(NLA_S32, -255, 0), 8273 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 }, 8274 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 }, 8275 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = 8276 NLA_POLICY_MIN(NLA_U16, 1), 8277 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = 8278 NLA_POLICY_MIN(NLA_U16, 1), 8279 [NL80211_MESHCONF_POWER_MODE] = 8280 NLA_POLICY_RANGE(NLA_U32, 8281 NL80211_MESH_POWER_ACTIVE, 8282 NL80211_MESH_POWER_MAX), 8283 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 }, 8284 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 }, 8285 [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8286 [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8287 [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8288 }; 8289 8290 static const struct nla_policy 8291 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = { 8292 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 }, 8293 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 }, 8294 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 }, 8295 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG }, 8296 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 }, 8297 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG }, 8298 [NL80211_MESH_SETUP_IE] = 8299 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 8300 IEEE80211_MAX_DATA_LEN), 8301 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG }, 8302 }; 8303 8304 static int nl80211_parse_mesh_config(struct genl_info *info, 8305 struct mesh_config *cfg, 8306 u32 *mask_out) 8307 { 8308 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1]; 8309 u32 mask = 0; 8310 u16 ht_opmode; 8311 8312 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \ 8313 do { \ 8314 if (tb[attr]) { \ 8315 cfg->param = fn(tb[attr]); \ 8316 mask |= BIT((attr) - 1); \ 8317 } \ 8318 } while (0) 8319 8320 if (!info->attrs[NL80211_ATTR_MESH_CONFIG]) 8321 return -EINVAL; 8322 if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack)) 8323 return -EINVAL; 8324 8325 /* This makes sure that there aren't more than 32 mesh config 8326 * parameters (otherwise our bitfield scheme would not work.) */ 8327 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32); 8328 8329 /* Fill in the params struct */ 8330 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask, 8331 NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16); 8332 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask, 8333 NL80211_MESHCONF_CONFIRM_TIMEOUT, 8334 nla_get_u16); 8335 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask, 8336 NL80211_MESHCONF_HOLDING_TIMEOUT, 8337 nla_get_u16); 8338 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask, 8339 NL80211_MESHCONF_MAX_PEER_LINKS, 8340 nla_get_u16); 8341 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask, 8342 NL80211_MESHCONF_MAX_RETRIES, nla_get_u8); 8343 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask, 8344 NL80211_MESHCONF_TTL, nla_get_u8); 8345 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask, 8346 NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8); 8347 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask, 8348 NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8349 nla_get_u8); 8350 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, 8351 mask, 8352 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8353 nla_get_u32); 8354 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask, 8355 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8356 nla_get_u8); 8357 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask, 8358 NL80211_MESHCONF_PATH_REFRESH_TIME, 8359 nla_get_u32); 8360 if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) && 8361 (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535)) 8362 return -EINVAL; 8363 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask, 8364 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8365 nla_get_u16); 8366 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, 8367 mask, 8368 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8369 nla_get_u32); 8370 if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) && 8371 (cfg->dot11MeshHWMPactivePathTimeout < 1 || 8372 cfg->dot11MeshHWMPactivePathTimeout > 65535)) 8373 return -EINVAL; 8374 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask, 8375 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8376 nla_get_u16); 8377 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask, 8378 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8379 nla_get_u16); 8380 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8381 dot11MeshHWMPnetDiameterTraversalTime, mask, 8382 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8383 nla_get_u16); 8384 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask, 8385 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8); 8386 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask, 8387 NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8388 nla_get_u16); 8389 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol, 8390 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8391 nla_get_u8); 8392 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask, 8393 NL80211_MESHCONF_FORWARDING, nla_get_u8); 8394 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask, 8395 NL80211_MESHCONF_RSSI_THRESHOLD, 8396 nla_get_s32); 8397 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask, 8398 NL80211_MESHCONF_CONNECTED_TO_GATE, 8399 nla_get_u8); 8400 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask, 8401 NL80211_MESHCONF_CONNECTED_TO_AS, 8402 nla_get_u8); 8403 /* 8404 * Check HT operation mode based on 8405 * IEEE 802.11-2016 9.4.2.57 HT Operation element. 8406 */ 8407 if (tb[NL80211_MESHCONF_HT_OPMODE]) { 8408 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]); 8409 8410 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION | 8411 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT | 8412 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)) 8413 return -EINVAL; 8414 8415 /* NON_HT_STA bit is reserved, but some programs set it */ 8416 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT; 8417 8418 cfg->ht_opmode = ht_opmode; 8419 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1)); 8420 } 8421 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8422 dot11MeshHWMPactivePathToRootTimeout, mask, 8423 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8424 nla_get_u32); 8425 if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) && 8426 (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 || 8427 cfg->dot11MeshHWMPactivePathToRootTimeout > 65535)) 8428 return -EINVAL; 8429 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask, 8430 NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8431 nla_get_u16); 8432 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval, 8433 mask, 8434 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8435 nla_get_u16); 8436 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask, 8437 NL80211_MESHCONF_POWER_MODE, nla_get_u32); 8438 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask, 8439 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16); 8440 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask, 8441 NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32); 8442 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask, 8443 NL80211_MESHCONF_NOLEARN, nla_get_u8); 8444 if (mask_out) 8445 *mask_out = mask; 8446 8447 return 0; 8448 8449 #undef FILL_IN_MESH_PARAM_IF_SET 8450 } 8451 8452 static int nl80211_parse_mesh_setup(struct genl_info *info, 8453 struct mesh_setup *setup) 8454 { 8455 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8456 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1]; 8457 8458 if (!info->attrs[NL80211_ATTR_MESH_SETUP]) 8459 return -EINVAL; 8460 if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack)) 8461 return -EINVAL; 8462 8463 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC]) 8464 setup->sync_method = 8465 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ? 8466 IEEE80211_SYNC_METHOD_VENDOR : 8467 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET; 8468 8469 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL]) 8470 setup->path_sel_proto = 8471 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ? 8472 IEEE80211_PATH_PROTOCOL_VENDOR : 8473 IEEE80211_PATH_PROTOCOL_HWMP; 8474 8475 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC]) 8476 setup->path_metric = 8477 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ? 8478 IEEE80211_PATH_METRIC_VENDOR : 8479 IEEE80211_PATH_METRIC_AIRTIME; 8480 8481 if (tb[NL80211_MESH_SETUP_IE]) { 8482 struct nlattr *ieattr = 8483 tb[NL80211_MESH_SETUP_IE]; 8484 setup->ie = nla_data(ieattr); 8485 setup->ie_len = nla_len(ieattr); 8486 } 8487 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] && 8488 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM)) 8489 return -EINVAL; 8490 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]); 8491 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]); 8492 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]); 8493 if (setup->is_secure) 8494 setup->user_mpm = true; 8495 8496 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) { 8497 if (!setup->user_mpm) 8498 return -EINVAL; 8499 setup->auth_id = 8500 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]); 8501 } 8502 8503 return 0; 8504 } 8505 8506 static int nl80211_update_mesh_config(struct sk_buff *skb, 8507 struct genl_info *info) 8508 { 8509 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8510 struct net_device *dev = info->user_ptr[1]; 8511 struct wireless_dev *wdev = dev->ieee80211_ptr; 8512 struct mesh_config cfg = {}; 8513 u32 mask; 8514 int err; 8515 8516 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8517 return -EOPNOTSUPP; 8518 8519 if (!rdev->ops->update_mesh_config) 8520 return -EOPNOTSUPP; 8521 8522 err = nl80211_parse_mesh_config(info, &cfg, &mask); 8523 if (err) 8524 return err; 8525 8526 if (!wdev->u.mesh.id_len) 8527 err = -ENOLINK; 8528 8529 if (!err) 8530 err = rdev_update_mesh_config(rdev, dev, mask, &cfg); 8531 8532 return err; 8533 } 8534 8535 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom, 8536 struct sk_buff *msg) 8537 { 8538 struct nlattr *nl_reg_rules; 8539 unsigned int i; 8540 8541 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) || 8542 (regdom->dfs_region && 8543 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region))) 8544 goto nla_put_failure; 8545 8546 nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES); 8547 if (!nl_reg_rules) 8548 goto nla_put_failure; 8549 8550 for (i = 0; i < regdom->n_reg_rules; i++) { 8551 struct nlattr *nl_reg_rule; 8552 const struct ieee80211_reg_rule *reg_rule; 8553 const struct ieee80211_freq_range *freq_range; 8554 const struct ieee80211_power_rule *power_rule; 8555 unsigned int max_bandwidth_khz; 8556 8557 reg_rule = ®dom->reg_rules[i]; 8558 freq_range = ®_rule->freq_range; 8559 power_rule = ®_rule->power_rule; 8560 8561 nl_reg_rule = nla_nest_start_noflag(msg, i); 8562 if (!nl_reg_rule) 8563 goto nla_put_failure; 8564 8565 max_bandwidth_khz = freq_range->max_bandwidth_khz; 8566 if (!max_bandwidth_khz) 8567 max_bandwidth_khz = reg_get_max_bandwidth(regdom, 8568 reg_rule); 8569 8570 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS, 8571 reg_rule->flags) || 8572 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START, 8573 freq_range->start_freq_khz) || 8574 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END, 8575 freq_range->end_freq_khz) || 8576 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW, 8577 max_bandwidth_khz) || 8578 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN, 8579 power_rule->max_antenna_gain) || 8580 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP, 8581 power_rule->max_eirp) || 8582 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME, 8583 reg_rule->dfs_cac_ms)) 8584 goto nla_put_failure; 8585 8586 if ((reg_rule->flags & NL80211_RRF_PSD) && 8587 nla_put_s8(msg, NL80211_ATTR_POWER_RULE_PSD, 8588 reg_rule->psd)) 8589 goto nla_put_failure; 8590 8591 nla_nest_end(msg, nl_reg_rule); 8592 } 8593 8594 nla_nest_end(msg, nl_reg_rules); 8595 return 0; 8596 8597 nla_put_failure: 8598 return -EMSGSIZE; 8599 } 8600 8601 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info) 8602 { 8603 const struct ieee80211_regdomain *regdom = NULL; 8604 struct cfg80211_registered_device *rdev; 8605 struct wiphy *wiphy = NULL; 8606 struct sk_buff *msg; 8607 int err = -EMSGSIZE; 8608 void *hdr; 8609 8610 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8611 if (!msg) 8612 return -ENOBUFS; 8613 8614 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8615 NL80211_CMD_GET_REG); 8616 if (!hdr) 8617 goto put_failure; 8618 8619 rtnl_lock(); 8620 8621 if (info->attrs[NL80211_ATTR_WIPHY]) { 8622 bool self_managed; 8623 8624 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 8625 if (IS_ERR(rdev)) { 8626 err = PTR_ERR(rdev); 8627 goto nla_put_failure; 8628 } 8629 8630 wiphy = &rdev->wiphy; 8631 self_managed = wiphy->regulatory_flags & 8632 REGULATORY_WIPHY_SELF_MANAGED; 8633 8634 rcu_read_lock(); 8635 8636 regdom = get_wiphy_regdom(wiphy); 8637 8638 /* a self-managed-reg device must have a private regdom */ 8639 if (WARN_ON(!regdom && self_managed)) { 8640 err = -EINVAL; 8641 goto nla_put_failure_rcu; 8642 } 8643 8644 if (regdom && 8645 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8646 goto nla_put_failure_rcu; 8647 } else { 8648 rcu_read_lock(); 8649 } 8650 8651 if (!wiphy && reg_last_request_cell_base() && 8652 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8653 NL80211_USER_REG_HINT_CELL_BASE)) 8654 goto nla_put_failure_rcu; 8655 8656 if (!regdom) 8657 regdom = rcu_dereference(cfg80211_regdomain); 8658 8659 if (nl80211_put_regdom(regdom, msg)) 8660 goto nla_put_failure_rcu; 8661 8662 rcu_read_unlock(); 8663 8664 genlmsg_end(msg, hdr); 8665 rtnl_unlock(); 8666 return genlmsg_reply(msg, info); 8667 8668 nla_put_failure_rcu: 8669 rcu_read_unlock(); 8670 nla_put_failure: 8671 rtnl_unlock(); 8672 put_failure: 8673 nlmsg_free(msg); 8674 return err; 8675 } 8676 8677 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb, 8678 u32 seq, int flags, struct wiphy *wiphy, 8679 const struct ieee80211_regdomain *regdom) 8680 { 8681 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 8682 NL80211_CMD_GET_REG); 8683 8684 if (!hdr) 8685 return -1; 8686 8687 genl_dump_check_consistent(cb, hdr); 8688 8689 if (nl80211_put_regdom(regdom, msg)) 8690 goto nla_put_failure; 8691 8692 if (!wiphy && reg_last_request_cell_base() && 8693 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8694 NL80211_USER_REG_HINT_CELL_BASE)) 8695 goto nla_put_failure; 8696 8697 if (wiphy && 8698 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8699 goto nla_put_failure; 8700 8701 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 8702 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 8703 goto nla_put_failure; 8704 8705 genlmsg_end(msg, hdr); 8706 return 0; 8707 8708 nla_put_failure: 8709 genlmsg_cancel(msg, hdr); 8710 return -EMSGSIZE; 8711 } 8712 8713 static int nl80211_get_reg_dump(struct sk_buff *skb, 8714 struct netlink_callback *cb) 8715 { 8716 const struct ieee80211_regdomain *regdom = NULL; 8717 struct cfg80211_registered_device *rdev; 8718 int err, reg_idx, start = cb->args[2]; 8719 8720 rcu_read_lock(); 8721 8722 if (cfg80211_regdomain && start == 0) { 8723 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8724 NLM_F_MULTI, NULL, 8725 rcu_dereference(cfg80211_regdomain)); 8726 if (err < 0) 8727 goto out_err; 8728 } 8729 8730 /* the global regdom is idx 0 */ 8731 reg_idx = 1; 8732 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 8733 regdom = get_wiphy_regdom(&rdev->wiphy); 8734 if (!regdom) 8735 continue; 8736 8737 if (++reg_idx <= start) 8738 continue; 8739 8740 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8741 NLM_F_MULTI, &rdev->wiphy, regdom); 8742 if (err < 0) { 8743 reg_idx--; 8744 break; 8745 } 8746 } 8747 8748 cb->args[2] = reg_idx; 8749 err = skb->len; 8750 out_err: 8751 rcu_read_unlock(); 8752 return err; 8753 } 8754 8755 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 8756 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = { 8757 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 }, 8758 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 }, 8759 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 }, 8760 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 }, 8761 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 }, 8762 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 }, 8763 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 }, 8764 }; 8765 8766 static int parse_reg_rule(struct nlattr *tb[], 8767 struct ieee80211_reg_rule *reg_rule) 8768 { 8769 struct ieee80211_freq_range *freq_range = ®_rule->freq_range; 8770 struct ieee80211_power_rule *power_rule = ®_rule->power_rule; 8771 8772 if (!tb[NL80211_ATTR_REG_RULE_FLAGS]) 8773 return -EINVAL; 8774 if (!tb[NL80211_ATTR_FREQ_RANGE_START]) 8775 return -EINVAL; 8776 if (!tb[NL80211_ATTR_FREQ_RANGE_END]) 8777 return -EINVAL; 8778 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]) 8779 return -EINVAL; 8780 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]) 8781 return -EINVAL; 8782 8783 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]); 8784 8785 freq_range->start_freq_khz = 8786 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]); 8787 freq_range->end_freq_khz = 8788 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]); 8789 freq_range->max_bandwidth_khz = 8790 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]); 8791 8792 power_rule->max_eirp = 8793 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]); 8794 8795 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]) 8796 power_rule->max_antenna_gain = 8797 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]); 8798 8799 if (tb[NL80211_ATTR_DFS_CAC_TIME]) 8800 reg_rule->dfs_cac_ms = 8801 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]); 8802 8803 return 0; 8804 } 8805 8806 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info) 8807 { 8808 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1]; 8809 struct nlattr *nl_reg_rule; 8810 char *alpha2; 8811 int rem_reg_rules, r; 8812 u32 num_rules = 0, rule_idx = 0; 8813 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET; 8814 struct ieee80211_regdomain *rd; 8815 8816 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8817 return -EINVAL; 8818 8819 if (!info->attrs[NL80211_ATTR_REG_RULES]) 8820 return -EINVAL; 8821 8822 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8823 8824 if (info->attrs[NL80211_ATTR_DFS_REGION]) 8825 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]); 8826 8827 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 8828 rem_reg_rules) { 8829 num_rules++; 8830 if (num_rules > NL80211_MAX_SUPP_REG_RULES) 8831 return -EINVAL; 8832 } 8833 8834 rtnl_lock(); 8835 if (!reg_is_valid_request(alpha2)) { 8836 r = -EINVAL; 8837 goto out; 8838 } 8839 8840 rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL); 8841 if (!rd) { 8842 r = -ENOMEM; 8843 goto out; 8844 } 8845 8846 rd->n_reg_rules = num_rules; 8847 rd->alpha2[0] = alpha2[0]; 8848 rd->alpha2[1] = alpha2[1]; 8849 8850 /* 8851 * Disable DFS master mode if the DFS region was 8852 * not supported or known on this kernel. 8853 */ 8854 if (reg_supported_dfs_region(dfs_region)) 8855 rd->dfs_region = dfs_region; 8856 8857 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 8858 rem_reg_rules) { 8859 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX, 8860 nl_reg_rule, reg_rule_policy, 8861 info->extack); 8862 if (r) 8863 goto bad_reg; 8864 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]); 8865 if (r) 8866 goto bad_reg; 8867 8868 rule_idx++; 8869 8870 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) { 8871 r = -EINVAL; 8872 goto bad_reg; 8873 } 8874 } 8875 8876 r = set_regdom(rd, REGD_SOURCE_CRDA); 8877 /* set_regdom takes ownership of rd */ 8878 rd = NULL; 8879 bad_reg: 8880 kfree(rd); 8881 out: 8882 rtnl_unlock(); 8883 return r; 8884 } 8885 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */ 8886 8887 static int validate_scan_freqs(struct nlattr *freqs) 8888 { 8889 struct nlattr *attr1, *attr2; 8890 int n_channels = 0, tmp1, tmp2; 8891 8892 nla_for_each_nested(attr1, freqs, tmp1) 8893 if (nla_len(attr1) != sizeof(u32)) 8894 return 0; 8895 8896 nla_for_each_nested(attr1, freqs, tmp1) { 8897 n_channels++; 8898 /* 8899 * Some hardware has a limited channel list for 8900 * scanning, and it is pretty much nonsensical 8901 * to scan for a channel twice, so disallow that 8902 * and don't require drivers to check that the 8903 * channel list they get isn't longer than what 8904 * they can scan, as long as they can scan all 8905 * the channels they registered at once. 8906 */ 8907 nla_for_each_nested(attr2, freqs, tmp2) 8908 if (attr1 != attr2 && 8909 nla_get_u32(attr1) == nla_get_u32(attr2)) 8910 return 0; 8911 } 8912 8913 return n_channels; 8914 } 8915 8916 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b) 8917 { 8918 return b < NUM_NL80211_BANDS && wiphy->bands[b]; 8919 } 8920 8921 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy, 8922 struct cfg80211_bss_selection *bss_select) 8923 { 8924 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1]; 8925 struct nlattr *nest; 8926 int err; 8927 bool found = false; 8928 int i; 8929 8930 /* only process one nested attribute */ 8931 nest = nla_data(nla); 8932 if (!nla_ok(nest, nla_len(nest))) 8933 return -EINVAL; 8934 8935 err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX, 8936 nest, nl80211_bss_select_policy, 8937 NULL); 8938 if (err) 8939 return err; 8940 8941 /* only one attribute may be given */ 8942 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) { 8943 if (attr[i]) { 8944 if (found) 8945 return -EINVAL; 8946 found = true; 8947 } 8948 } 8949 8950 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID; 8951 8952 if (attr[NL80211_BSS_SELECT_ATTR_RSSI]) 8953 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI; 8954 8955 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) { 8956 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF; 8957 bss_select->param.band_pref = 8958 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]); 8959 if (!is_band_valid(wiphy, bss_select->param.band_pref)) 8960 return -EINVAL; 8961 } 8962 8963 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) { 8964 struct nl80211_bss_select_rssi_adjust *adj_param; 8965 8966 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]); 8967 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST; 8968 bss_select->param.adjust.band = adj_param->band; 8969 bss_select->param.adjust.delta = adj_param->delta; 8970 if (!is_band_valid(wiphy, bss_select->param.adjust.band)) 8971 return -EINVAL; 8972 } 8973 8974 /* user-space did not provide behaviour attribute */ 8975 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID) 8976 return -EINVAL; 8977 8978 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour))) 8979 return -EINVAL; 8980 8981 return 0; 8982 } 8983 8984 int nl80211_parse_random_mac(struct nlattr **attrs, 8985 u8 *mac_addr, u8 *mac_addr_mask) 8986 { 8987 int i; 8988 8989 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) { 8990 eth_zero_addr(mac_addr); 8991 eth_zero_addr(mac_addr_mask); 8992 mac_addr[0] = 0x2; 8993 mac_addr_mask[0] = 0x3; 8994 8995 return 0; 8996 } 8997 8998 /* need both or none */ 8999 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK]) 9000 return -EINVAL; 9001 9002 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN); 9003 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN); 9004 9005 /* don't allow or configure an mcast address */ 9006 if (!is_multicast_ether_addr(mac_addr_mask) || 9007 is_multicast_ether_addr(mac_addr)) 9008 return -EINVAL; 9009 9010 /* 9011 * allow users to pass a MAC address that has bits set outside 9012 * of the mask, but don't bother drivers with having to deal 9013 * with such bits 9014 */ 9015 for (i = 0; i < ETH_ALEN; i++) 9016 mac_addr[i] &= mac_addr_mask[i]; 9017 9018 return 0; 9019 } 9020 9021 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev, 9022 struct ieee80211_channel *chan) 9023 { 9024 unsigned int link_id; 9025 bool all_ok = true; 9026 9027 lockdep_assert_wiphy(wdev->wiphy); 9028 9029 if (!cfg80211_beaconing_iface_active(wdev)) 9030 return true; 9031 9032 /* 9033 * FIXME: check if we have a free HW resource/link for chan 9034 * 9035 * This, as well as the FIXME below, requires knowing the link 9036 * capabilities of the hardware. 9037 */ 9038 9039 /* we cannot leave radar channels */ 9040 for_each_valid_link(wdev, link_id) { 9041 struct cfg80211_chan_def *chandef; 9042 9043 chandef = wdev_chandef(wdev, link_id); 9044 if (!chandef || !chandef->chan) 9045 continue; 9046 9047 /* 9048 * FIXME: don't require all_ok, but rather check only the 9049 * correct HW resource/link onto which 'chan' falls, 9050 * as only that link leaves the channel for doing 9051 * the off-channel operation. 9052 */ 9053 9054 if (chandef->chan->flags & IEEE80211_CHAN_RADAR) 9055 all_ok = false; 9056 } 9057 9058 if (all_ok) 9059 return true; 9060 9061 return regulatory_pre_cac_allowed(wdev->wiphy); 9062 } 9063 9064 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag, 9065 enum nl80211_ext_feature_index feat) 9066 { 9067 if (!(flags & flag)) 9068 return true; 9069 if (wiphy_ext_feature_isset(wiphy, feat)) 9070 return true; 9071 return false; 9072 } 9073 9074 static int 9075 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev, 9076 void *request, struct nlattr **attrs, 9077 bool is_sched_scan) 9078 { 9079 u8 *mac_addr, *mac_addr_mask; 9080 u32 *flags; 9081 enum nl80211_feature_flags randomness_flag; 9082 9083 if (!attrs[NL80211_ATTR_SCAN_FLAGS]) 9084 return 0; 9085 9086 if (is_sched_scan) { 9087 struct cfg80211_sched_scan_request *req = request; 9088 9089 randomness_flag = wdev ? 9090 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR : 9091 NL80211_FEATURE_ND_RANDOM_MAC_ADDR; 9092 flags = &req->flags; 9093 mac_addr = req->mac_addr; 9094 mac_addr_mask = req->mac_addr_mask; 9095 } else { 9096 struct cfg80211_scan_request *req = request; 9097 9098 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; 9099 flags = &req->flags; 9100 mac_addr = req->mac_addr; 9101 mac_addr_mask = req->mac_addr_mask; 9102 } 9103 9104 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]); 9105 9106 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) && 9107 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) || 9108 !nl80211_check_scan_feat(wiphy, *flags, 9109 NL80211_SCAN_FLAG_LOW_SPAN, 9110 NL80211_EXT_FEATURE_LOW_SPAN_SCAN) || 9111 !nl80211_check_scan_feat(wiphy, *flags, 9112 NL80211_SCAN_FLAG_LOW_POWER, 9113 NL80211_EXT_FEATURE_LOW_POWER_SCAN) || 9114 !nl80211_check_scan_feat(wiphy, *flags, 9115 NL80211_SCAN_FLAG_HIGH_ACCURACY, 9116 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) || 9117 !nl80211_check_scan_feat(wiphy, *flags, 9118 NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME, 9119 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) || 9120 !nl80211_check_scan_feat(wiphy, *flags, 9121 NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP, 9122 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) || 9123 !nl80211_check_scan_feat(wiphy, *flags, 9124 NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION, 9125 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) || 9126 !nl80211_check_scan_feat(wiphy, *flags, 9127 NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE, 9128 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) || 9129 !nl80211_check_scan_feat(wiphy, *flags, 9130 NL80211_SCAN_FLAG_RANDOM_SN, 9131 NL80211_EXT_FEATURE_SCAN_RANDOM_SN) || 9132 !nl80211_check_scan_feat(wiphy, *flags, 9133 NL80211_SCAN_FLAG_MIN_PREQ_CONTENT, 9134 NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT)) 9135 return -EOPNOTSUPP; 9136 9137 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { 9138 int err; 9139 9140 if (!(wiphy->features & randomness_flag) || 9141 (wdev && wdev->connected)) 9142 return -EOPNOTSUPP; 9143 9144 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask); 9145 if (err) 9146 return err; 9147 } 9148 9149 return 0; 9150 } 9151 9152 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info) 9153 { 9154 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9155 struct wireless_dev *wdev = info->user_ptr[1]; 9156 struct cfg80211_scan_request *request; 9157 struct nlattr *scan_freqs = NULL; 9158 bool scan_freqs_khz = false; 9159 struct nlattr *attr; 9160 struct wiphy *wiphy; 9161 int err, tmp, n_ssids = 0, n_channels, i; 9162 size_t ie_len, size; 9163 9164 wiphy = &rdev->wiphy; 9165 9166 if (wdev->iftype == NL80211_IFTYPE_NAN) 9167 return -EOPNOTSUPP; 9168 9169 if (!rdev->ops->scan) 9170 return -EOPNOTSUPP; 9171 9172 if (rdev->scan_req || rdev->scan_msg) 9173 return -EBUSY; 9174 9175 if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) { 9176 if (!wiphy_ext_feature_isset(wiphy, 9177 NL80211_EXT_FEATURE_SCAN_FREQ_KHZ)) 9178 return -EOPNOTSUPP; 9179 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]; 9180 scan_freqs_khz = true; 9181 } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) 9182 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]; 9183 9184 if (scan_freqs) { 9185 n_channels = validate_scan_freqs(scan_freqs); 9186 if (!n_channels) 9187 return -EINVAL; 9188 } else { 9189 n_channels = ieee80211_get_num_supported_channels(wiphy); 9190 } 9191 9192 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) 9193 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) 9194 n_ssids++; 9195 9196 if (n_ssids > wiphy->max_scan_ssids) 9197 return -EINVAL; 9198 9199 if (info->attrs[NL80211_ATTR_IE]) 9200 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9201 else 9202 ie_len = 0; 9203 9204 if (ie_len > wiphy->max_scan_ie_len) 9205 return -EINVAL; 9206 9207 size = struct_size(request, channels, n_channels); 9208 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9209 size = size_add(size, ie_len); 9210 request = kzalloc(size, GFP_KERNEL); 9211 if (!request) 9212 return -ENOMEM; 9213 9214 if (n_ssids) 9215 request->ssids = (void *)&request->channels[n_channels]; 9216 request->n_ssids = n_ssids; 9217 if (ie_len) { 9218 if (n_ssids) 9219 request->ie = (void *)(request->ssids + n_ssids); 9220 else 9221 request->ie = (void *)(request->channels + n_channels); 9222 } 9223 9224 i = 0; 9225 if (scan_freqs) { 9226 /* user specified, bail out if channel not found */ 9227 nla_for_each_nested(attr, scan_freqs, tmp) { 9228 struct ieee80211_channel *chan; 9229 int freq = nla_get_u32(attr); 9230 9231 if (!scan_freqs_khz) 9232 freq = MHZ_TO_KHZ(freq); 9233 9234 chan = ieee80211_get_channel_khz(wiphy, freq); 9235 if (!chan) { 9236 err = -EINVAL; 9237 goto out_free; 9238 } 9239 9240 /* ignore disabled channels */ 9241 if (chan->flags & IEEE80211_CHAN_DISABLED) 9242 continue; 9243 9244 request->channels[i] = chan; 9245 i++; 9246 } 9247 } else { 9248 enum nl80211_band band; 9249 9250 /* all channels */ 9251 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9252 int j; 9253 9254 if (!wiphy->bands[band]) 9255 continue; 9256 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9257 struct ieee80211_channel *chan; 9258 9259 chan = &wiphy->bands[band]->channels[j]; 9260 9261 if (chan->flags & IEEE80211_CHAN_DISABLED) 9262 continue; 9263 9264 request->channels[i] = chan; 9265 i++; 9266 } 9267 } 9268 } 9269 9270 if (!i) { 9271 err = -EINVAL; 9272 goto out_free; 9273 } 9274 9275 request->n_channels = i; 9276 9277 for (i = 0; i < request->n_channels; i++) { 9278 struct ieee80211_channel *chan = request->channels[i]; 9279 9280 /* if we can go off-channel to the target channel we're good */ 9281 if (cfg80211_off_channel_oper_allowed(wdev, chan)) 9282 continue; 9283 9284 if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) { 9285 err = -EBUSY; 9286 goto out_free; 9287 } 9288 } 9289 9290 i = 0; 9291 if (n_ssids) { 9292 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) { 9293 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9294 err = -EINVAL; 9295 goto out_free; 9296 } 9297 request->ssids[i].ssid_len = nla_len(attr); 9298 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr)); 9299 i++; 9300 } 9301 } 9302 9303 if (info->attrs[NL80211_ATTR_IE]) { 9304 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9305 memcpy((void *)request->ie, 9306 nla_data(info->attrs[NL80211_ATTR_IE]), 9307 request->ie_len); 9308 } 9309 9310 for (i = 0; i < NUM_NL80211_BANDS; i++) 9311 if (wiphy->bands[i]) 9312 request->rates[i] = 9313 (1 << wiphy->bands[i]->n_bitrates) - 1; 9314 9315 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) { 9316 nla_for_each_nested(attr, 9317 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES], 9318 tmp) { 9319 enum nl80211_band band = nla_type(attr); 9320 9321 if (band < 0 || band >= NUM_NL80211_BANDS) { 9322 err = -EINVAL; 9323 goto out_free; 9324 } 9325 9326 if (!wiphy->bands[band]) 9327 continue; 9328 9329 err = ieee80211_get_ratemask(wiphy->bands[band], 9330 nla_data(attr), 9331 nla_len(attr), 9332 &request->rates[band]); 9333 if (err) 9334 goto out_free; 9335 } 9336 } 9337 9338 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) { 9339 request->duration = 9340 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]); 9341 request->duration_mandatory = 9342 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]); 9343 } 9344 9345 err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs, 9346 false); 9347 if (err) 9348 goto out_free; 9349 9350 request->no_cck = 9351 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 9352 9353 /* Initial implementation used NL80211_ATTR_MAC to set the specific 9354 * BSSID to scan for. This was problematic because that same attribute 9355 * was already used for another purpose (local random MAC address). The 9356 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards 9357 * compatibility with older userspace components, also use the 9358 * NL80211_ATTR_MAC value here if it can be determined to be used for 9359 * the specific BSSID use case instead of the random MAC address 9360 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use). 9361 */ 9362 if (info->attrs[NL80211_ATTR_BSSID]) 9363 memcpy(request->bssid, 9364 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN); 9365 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) && 9366 info->attrs[NL80211_ATTR_MAC]) 9367 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]), 9368 ETH_ALEN); 9369 else 9370 eth_broadcast_addr(request->bssid); 9371 9372 request->tsf_report_link_id = nl80211_link_id_or_invalid(info->attrs); 9373 request->wdev = wdev; 9374 request->wiphy = &rdev->wiphy; 9375 request->scan_start = jiffies; 9376 9377 rdev->scan_req = request; 9378 err = cfg80211_scan(rdev); 9379 9380 if (err) 9381 goto out_free; 9382 9383 nl80211_send_scan_start(rdev, wdev); 9384 dev_hold(wdev->netdev); 9385 9386 return 0; 9387 9388 out_free: 9389 rdev->scan_req = NULL; 9390 kfree(request); 9391 9392 return err; 9393 } 9394 9395 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info) 9396 { 9397 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9398 struct wireless_dev *wdev = info->user_ptr[1]; 9399 9400 if (!rdev->ops->abort_scan) 9401 return -EOPNOTSUPP; 9402 9403 if (rdev->scan_msg) 9404 return 0; 9405 9406 if (!rdev->scan_req) 9407 return -ENOENT; 9408 9409 rdev_abort_scan(rdev, wdev); 9410 return 0; 9411 } 9412 9413 static int 9414 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans, 9415 struct cfg80211_sched_scan_request *request, 9416 struct nlattr **attrs) 9417 { 9418 int tmp, err, i = 0; 9419 struct nlattr *attr; 9420 9421 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9422 u32 interval; 9423 9424 /* 9425 * If scan plans are not specified, 9426 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this 9427 * case one scan plan will be set with the specified scan 9428 * interval and infinite number of iterations. 9429 */ 9430 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]); 9431 if (!interval) 9432 return -EINVAL; 9433 9434 request->scan_plans[0].interval = 9435 DIV_ROUND_UP(interval, MSEC_PER_SEC); 9436 if (!request->scan_plans[0].interval) 9437 return -EINVAL; 9438 9439 if (request->scan_plans[0].interval > 9440 wiphy->max_sched_scan_plan_interval) 9441 request->scan_plans[0].interval = 9442 wiphy->max_sched_scan_plan_interval; 9443 9444 return 0; 9445 } 9446 9447 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) { 9448 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1]; 9449 9450 if (WARN_ON(i >= n_plans)) 9451 return -EINVAL; 9452 9453 err = nla_parse_nested_deprecated(plan, 9454 NL80211_SCHED_SCAN_PLAN_MAX, 9455 attr, nl80211_plan_policy, 9456 NULL); 9457 if (err) 9458 return err; 9459 9460 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]) 9461 return -EINVAL; 9462 9463 request->scan_plans[i].interval = 9464 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]); 9465 if (!request->scan_plans[i].interval || 9466 request->scan_plans[i].interval > 9467 wiphy->max_sched_scan_plan_interval) 9468 return -EINVAL; 9469 9470 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) { 9471 request->scan_plans[i].iterations = 9472 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]); 9473 if (!request->scan_plans[i].iterations || 9474 (request->scan_plans[i].iterations > 9475 wiphy->max_sched_scan_plan_iterations)) 9476 return -EINVAL; 9477 } else if (i < n_plans - 1) { 9478 /* 9479 * All scan plans but the last one must specify 9480 * a finite number of iterations 9481 */ 9482 return -EINVAL; 9483 } 9484 9485 i++; 9486 } 9487 9488 /* 9489 * The last scan plan must not specify the number of 9490 * iterations, it is supposed to run infinitely 9491 */ 9492 if (request->scan_plans[n_plans - 1].iterations) 9493 return -EINVAL; 9494 9495 return 0; 9496 } 9497 9498 static struct cfg80211_sched_scan_request * 9499 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev, 9500 struct nlattr **attrs, int max_match_sets) 9501 { 9502 struct cfg80211_sched_scan_request *request; 9503 struct nlattr *attr; 9504 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0; 9505 enum nl80211_band band; 9506 size_t ie_len, size; 9507 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1]; 9508 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF; 9509 9510 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9511 n_channels = validate_scan_freqs( 9512 attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 9513 if (!n_channels) 9514 return ERR_PTR(-EINVAL); 9515 } else { 9516 n_channels = ieee80211_get_num_supported_channels(wiphy); 9517 } 9518 9519 if (attrs[NL80211_ATTR_SCAN_SSIDS]) 9520 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9521 tmp) 9522 n_ssids++; 9523 9524 if (n_ssids > wiphy->max_sched_scan_ssids) 9525 return ERR_PTR(-EINVAL); 9526 9527 /* 9528 * First, count the number of 'real' matchsets. Due to an issue with 9529 * the old implementation, matchsets containing only the RSSI attribute 9530 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default' 9531 * RSSI for all matchsets, rather than their own matchset for reporting 9532 * all APs with a strong RSSI. This is needed to be compatible with 9533 * older userspace that treated a matchset with only the RSSI as the 9534 * global RSSI for all other matchsets - if there are other matchsets. 9535 */ 9536 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9537 nla_for_each_nested(attr, 9538 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9539 tmp) { 9540 struct nlattr *rssi; 9541 9542 err = nla_parse_nested_deprecated(tb, 9543 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9544 attr, 9545 nl80211_match_policy, 9546 NULL); 9547 if (err) 9548 return ERR_PTR(err); 9549 9550 /* SSID and BSSID are mutually exclusive */ 9551 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] && 9552 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) 9553 return ERR_PTR(-EINVAL); 9554 9555 /* add other standalone attributes here */ 9556 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] || 9557 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) { 9558 n_match_sets++; 9559 continue; 9560 } 9561 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9562 if (rssi) 9563 default_match_rssi = nla_get_s32(rssi); 9564 } 9565 } 9566 9567 /* However, if there's no other matchset, add the RSSI one */ 9568 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF) 9569 n_match_sets = 1; 9570 9571 if (n_match_sets > max_match_sets) 9572 return ERR_PTR(-EINVAL); 9573 9574 if (attrs[NL80211_ATTR_IE]) 9575 ie_len = nla_len(attrs[NL80211_ATTR_IE]); 9576 else 9577 ie_len = 0; 9578 9579 if (ie_len > wiphy->max_sched_scan_ie_len) 9580 return ERR_PTR(-EINVAL); 9581 9582 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9583 /* 9584 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since 9585 * each scan plan already specifies its own interval 9586 */ 9587 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9588 return ERR_PTR(-EINVAL); 9589 9590 nla_for_each_nested(attr, 9591 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) 9592 n_plans++; 9593 } else { 9594 /* 9595 * The scan interval attribute is kept for backward 9596 * compatibility. If no scan plans are specified and sched scan 9597 * interval is specified, one scan plan will be set with this 9598 * scan interval and infinite number of iterations. 9599 */ 9600 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9601 return ERR_PTR(-EINVAL); 9602 9603 n_plans = 1; 9604 } 9605 9606 if (!n_plans || n_plans > wiphy->max_sched_scan_plans) 9607 return ERR_PTR(-EINVAL); 9608 9609 if (!wiphy_ext_feature_isset( 9610 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) && 9611 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] || 9612 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST])) 9613 return ERR_PTR(-EINVAL); 9614 9615 size = struct_size(request, channels, n_channels); 9616 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9617 size = size_add(size, array_size(sizeof(*request->match_sets), 9618 n_match_sets)); 9619 size = size_add(size, array_size(sizeof(*request->scan_plans), 9620 n_plans)); 9621 size = size_add(size, ie_len); 9622 request = kzalloc(size, GFP_KERNEL); 9623 if (!request) 9624 return ERR_PTR(-ENOMEM); 9625 9626 if (n_ssids) 9627 request->ssids = (void *)&request->channels[n_channels]; 9628 request->n_ssids = n_ssids; 9629 if (ie_len) { 9630 if (n_ssids) 9631 request->ie = (void *)(request->ssids + n_ssids); 9632 else 9633 request->ie = (void *)(request->channels + n_channels); 9634 } 9635 9636 if (n_match_sets) { 9637 if (request->ie) 9638 request->match_sets = (void *)(request->ie + ie_len); 9639 else if (n_ssids) 9640 request->match_sets = 9641 (void *)(request->ssids + n_ssids); 9642 else 9643 request->match_sets = 9644 (void *)(request->channels + n_channels); 9645 } 9646 request->n_match_sets = n_match_sets; 9647 9648 if (n_match_sets) 9649 request->scan_plans = (void *)(request->match_sets + 9650 n_match_sets); 9651 else if (request->ie) 9652 request->scan_plans = (void *)(request->ie + ie_len); 9653 else if (n_ssids) 9654 request->scan_plans = (void *)(request->ssids + n_ssids); 9655 else 9656 request->scan_plans = (void *)(request->channels + n_channels); 9657 9658 request->n_scan_plans = n_plans; 9659 9660 i = 0; 9661 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9662 /* user specified, bail out if channel not found */ 9663 nla_for_each_nested(attr, 9664 attrs[NL80211_ATTR_SCAN_FREQUENCIES], 9665 tmp) { 9666 struct ieee80211_channel *chan; 9667 9668 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 9669 9670 if (!chan) { 9671 err = -EINVAL; 9672 goto out_free; 9673 } 9674 9675 /* ignore disabled channels */ 9676 if (chan->flags & IEEE80211_CHAN_DISABLED) 9677 continue; 9678 9679 request->channels[i] = chan; 9680 i++; 9681 } 9682 } else { 9683 /* all channels */ 9684 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9685 int j; 9686 9687 if (!wiphy->bands[band]) 9688 continue; 9689 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9690 struct ieee80211_channel *chan; 9691 9692 chan = &wiphy->bands[band]->channels[j]; 9693 9694 if (chan->flags & IEEE80211_CHAN_DISABLED) 9695 continue; 9696 9697 request->channels[i] = chan; 9698 i++; 9699 } 9700 } 9701 } 9702 9703 if (!i) { 9704 err = -EINVAL; 9705 goto out_free; 9706 } 9707 9708 request->n_channels = i; 9709 9710 i = 0; 9711 if (n_ssids) { 9712 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9713 tmp) { 9714 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9715 err = -EINVAL; 9716 goto out_free; 9717 } 9718 request->ssids[i].ssid_len = nla_len(attr); 9719 memcpy(request->ssids[i].ssid, nla_data(attr), 9720 nla_len(attr)); 9721 i++; 9722 } 9723 } 9724 9725 i = 0; 9726 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9727 nla_for_each_nested(attr, 9728 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9729 tmp) { 9730 struct nlattr *ssid, *bssid, *rssi; 9731 9732 err = nla_parse_nested_deprecated(tb, 9733 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9734 attr, 9735 nl80211_match_policy, 9736 NULL); 9737 if (err) 9738 goto out_free; 9739 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]; 9740 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]; 9741 9742 if (!ssid && !bssid) { 9743 i++; 9744 continue; 9745 } 9746 9747 if (WARN_ON(i >= n_match_sets)) { 9748 /* this indicates a programming error, 9749 * the loop above should have verified 9750 * things properly 9751 */ 9752 err = -EINVAL; 9753 goto out_free; 9754 } 9755 9756 if (ssid) { 9757 memcpy(request->match_sets[i].ssid.ssid, 9758 nla_data(ssid), nla_len(ssid)); 9759 request->match_sets[i].ssid.ssid_len = 9760 nla_len(ssid); 9761 } 9762 if (bssid) 9763 memcpy(request->match_sets[i].bssid, 9764 nla_data(bssid), ETH_ALEN); 9765 9766 /* special attribute - old implementation w/a */ 9767 request->match_sets[i].rssi_thold = default_match_rssi; 9768 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9769 if (rssi) 9770 request->match_sets[i].rssi_thold = 9771 nla_get_s32(rssi); 9772 i++; 9773 } 9774 9775 /* there was no other matchset, so the RSSI one is alone */ 9776 if (i == 0 && n_match_sets) 9777 request->match_sets[0].rssi_thold = default_match_rssi; 9778 9779 request->min_rssi_thold = INT_MAX; 9780 for (i = 0; i < n_match_sets; i++) 9781 request->min_rssi_thold = 9782 min(request->match_sets[i].rssi_thold, 9783 request->min_rssi_thold); 9784 } else { 9785 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF; 9786 } 9787 9788 if (ie_len) { 9789 request->ie_len = ie_len; 9790 memcpy((void *)request->ie, 9791 nla_data(attrs[NL80211_ATTR_IE]), 9792 request->ie_len); 9793 } 9794 9795 err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true); 9796 if (err) 9797 goto out_free; 9798 9799 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY]) 9800 request->delay = 9801 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]); 9802 9803 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) { 9804 request->relative_rssi = nla_get_s8( 9805 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]); 9806 request->relative_rssi_set = true; 9807 } 9808 9809 if (request->relative_rssi_set && 9810 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) { 9811 struct nl80211_bss_select_rssi_adjust *rssi_adjust; 9812 9813 rssi_adjust = nla_data( 9814 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]); 9815 request->rssi_adjust.band = rssi_adjust->band; 9816 request->rssi_adjust.delta = rssi_adjust->delta; 9817 if (!is_band_valid(wiphy, request->rssi_adjust.band)) { 9818 err = -EINVAL; 9819 goto out_free; 9820 } 9821 } 9822 9823 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs); 9824 if (err) 9825 goto out_free; 9826 9827 request->scan_start = jiffies; 9828 9829 return request; 9830 9831 out_free: 9832 kfree(request); 9833 return ERR_PTR(err); 9834 } 9835 9836 static int nl80211_start_sched_scan(struct sk_buff *skb, 9837 struct genl_info *info) 9838 { 9839 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9840 struct net_device *dev = info->user_ptr[1]; 9841 struct wireless_dev *wdev = dev->ieee80211_ptr; 9842 struct cfg80211_sched_scan_request *sched_scan_req; 9843 bool want_multi; 9844 int err; 9845 9846 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start) 9847 return -EOPNOTSUPP; 9848 9849 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI]; 9850 err = cfg80211_sched_scan_req_possible(rdev, want_multi); 9851 if (err) 9852 return err; 9853 9854 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev, 9855 info->attrs, 9856 rdev->wiphy.max_match_sets); 9857 9858 err = PTR_ERR_OR_ZERO(sched_scan_req); 9859 if (err) 9860 goto out_err; 9861 9862 /* leave request id zero for legacy request 9863 * or if driver does not support multi-scheduled scan 9864 */ 9865 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) 9866 sched_scan_req->reqid = cfg80211_assign_cookie(rdev); 9867 9868 err = rdev_sched_scan_start(rdev, dev, sched_scan_req); 9869 if (err) 9870 goto out_free; 9871 9872 sched_scan_req->dev = dev; 9873 sched_scan_req->wiphy = &rdev->wiphy; 9874 9875 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 9876 sched_scan_req->owner_nlportid = info->snd_portid; 9877 9878 cfg80211_add_sched_scan_req(rdev, sched_scan_req); 9879 9880 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN); 9881 return 0; 9882 9883 out_free: 9884 kfree(sched_scan_req); 9885 out_err: 9886 return err; 9887 } 9888 9889 static int nl80211_stop_sched_scan(struct sk_buff *skb, 9890 struct genl_info *info) 9891 { 9892 struct cfg80211_sched_scan_request *req; 9893 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9894 u64 cookie; 9895 9896 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop) 9897 return -EOPNOTSUPP; 9898 9899 if (info->attrs[NL80211_ATTR_COOKIE]) { 9900 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 9901 return __cfg80211_stop_sched_scan(rdev, cookie, false); 9902 } 9903 9904 req = list_first_or_null_rcu(&rdev->sched_scan_req_list, 9905 struct cfg80211_sched_scan_request, 9906 list); 9907 if (!req || req->reqid || 9908 (req->owner_nlportid && 9909 req->owner_nlportid != info->snd_portid)) 9910 return -ENOENT; 9911 9912 return cfg80211_stop_sched_scan_req(rdev, req, false); 9913 } 9914 9915 static int nl80211_start_radar_detection(struct sk_buff *skb, 9916 struct genl_info *info) 9917 { 9918 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9919 struct net_device *dev = info->user_ptr[1]; 9920 struct wireless_dev *wdev = dev->ieee80211_ptr; 9921 struct wiphy *wiphy = wdev->wiphy; 9922 struct cfg80211_chan_def chandef; 9923 enum nl80211_dfs_regions dfs_region; 9924 unsigned int cac_time_ms; 9925 int err = -EINVAL; 9926 9927 flush_delayed_work(&rdev->dfs_update_channels_wk); 9928 9929 wiphy_lock(wiphy); 9930 9931 dfs_region = reg_get_dfs_region(wiphy); 9932 if (dfs_region == NL80211_DFS_UNSET) 9933 goto unlock; 9934 9935 err = nl80211_parse_chandef(rdev, info, &chandef); 9936 if (err) 9937 goto unlock; 9938 9939 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 9940 if (err < 0) 9941 goto unlock; 9942 9943 if (err == 0) { 9944 err = -EINVAL; 9945 goto unlock; 9946 } 9947 9948 if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) { 9949 err = -EINVAL; 9950 goto unlock; 9951 } 9952 9953 if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) { 9954 err = cfg80211_start_background_radar_detection(rdev, wdev, 9955 &chandef); 9956 goto unlock; 9957 } 9958 9959 if (netif_carrier_ok(dev)) { 9960 err = -EBUSY; 9961 goto unlock; 9962 } 9963 9964 if (wdev->cac_started) { 9965 err = -EBUSY; 9966 goto unlock; 9967 } 9968 9969 /* CAC start is offloaded to HW and can't be started manually */ 9970 if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) { 9971 err = -EOPNOTSUPP; 9972 goto unlock; 9973 } 9974 9975 if (!rdev->ops->start_radar_detection) { 9976 err = -EOPNOTSUPP; 9977 goto unlock; 9978 } 9979 9980 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef); 9981 if (WARN_ON(!cac_time_ms)) 9982 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS; 9983 9984 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms); 9985 if (!err) { 9986 wdev->links[0].ap.chandef = chandef; 9987 wdev->cac_started = true; 9988 wdev->cac_start_time = jiffies; 9989 wdev->cac_time_ms = cac_time_ms; 9990 } 9991 unlock: 9992 wiphy_unlock(wiphy); 9993 9994 return err; 9995 } 9996 9997 static int nl80211_notify_radar_detection(struct sk_buff *skb, 9998 struct genl_info *info) 9999 { 10000 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10001 struct net_device *dev = info->user_ptr[1]; 10002 struct wireless_dev *wdev = dev->ieee80211_ptr; 10003 struct wiphy *wiphy = wdev->wiphy; 10004 struct cfg80211_chan_def chandef; 10005 enum nl80211_dfs_regions dfs_region; 10006 int err; 10007 10008 dfs_region = reg_get_dfs_region(wiphy); 10009 if (dfs_region == NL80211_DFS_UNSET) { 10010 GENL_SET_ERR_MSG(info, 10011 "DFS Region is not set. Unexpected Radar indication"); 10012 return -EINVAL; 10013 } 10014 10015 err = nl80211_parse_chandef(rdev, info, &chandef); 10016 if (err) { 10017 GENL_SET_ERR_MSG(info, "Unable to extract chandef info"); 10018 return err; 10019 } 10020 10021 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 10022 if (err < 0) { 10023 GENL_SET_ERR_MSG(info, "chandef is invalid"); 10024 return err; 10025 } 10026 10027 if (err == 0) { 10028 GENL_SET_ERR_MSG(info, 10029 "Unexpected Radar indication for chandef/iftype"); 10030 return -EINVAL; 10031 } 10032 10033 /* Do not process this notification if radar is already detected 10034 * by kernel on this channel, and return success. 10035 */ 10036 if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE) 10037 return 0; 10038 10039 cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE); 10040 10041 cfg80211_sched_dfs_chan_update(rdev); 10042 10043 rdev->radar_chandef = chandef; 10044 10045 /* Propagate this notification to other radios as well */ 10046 queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk); 10047 10048 return 0; 10049 } 10050 10051 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info) 10052 { 10053 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10054 unsigned int link_id = nl80211_link_id(info->attrs); 10055 struct net_device *dev = info->user_ptr[1]; 10056 struct wireless_dev *wdev = dev->ieee80211_ptr; 10057 struct cfg80211_csa_settings params; 10058 struct nlattr **csa_attrs = NULL; 10059 int err; 10060 bool need_new_beacon = false; 10061 bool need_handle_dfs_flag = true; 10062 int len, i; 10063 u32 cs_count; 10064 10065 if (!rdev->ops->channel_switch || 10066 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 10067 return -EOPNOTSUPP; 10068 10069 switch (dev->ieee80211_ptr->iftype) { 10070 case NL80211_IFTYPE_AP: 10071 case NL80211_IFTYPE_P2P_GO: 10072 need_new_beacon = true; 10073 /* For all modes except AP the handle_dfs flag needs to be 10074 * supplied to tell the kernel that userspace will handle radar 10075 * events when they happen. Otherwise a switch to a channel 10076 * requiring DFS will be rejected. 10077 */ 10078 need_handle_dfs_flag = false; 10079 10080 /* useless if AP is not running */ 10081 if (!wdev->links[link_id].ap.beacon_interval) 10082 return -ENOTCONN; 10083 break; 10084 case NL80211_IFTYPE_ADHOC: 10085 if (!wdev->u.ibss.ssid_len) 10086 return -ENOTCONN; 10087 break; 10088 case NL80211_IFTYPE_MESH_POINT: 10089 if (!wdev->u.mesh.id_len) 10090 return -ENOTCONN; 10091 break; 10092 default: 10093 return -EOPNOTSUPP; 10094 } 10095 10096 memset(¶ms, 0, sizeof(params)); 10097 params.beacon_csa.ftm_responder = -1; 10098 10099 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 10100 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]) 10101 return -EINVAL; 10102 10103 /* only important for AP, IBSS and mesh create IEs internally */ 10104 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES]) 10105 return -EINVAL; 10106 10107 /* Even though the attribute is u32, the specification says 10108 * u8, so let's make sure we don't overflow. 10109 */ 10110 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]); 10111 if (cs_count > 255) 10112 return -EINVAL; 10113 10114 params.count = cs_count; 10115 10116 if (!need_new_beacon) 10117 goto skip_beacons; 10118 10119 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_after, 10120 info->extack); 10121 if (err) 10122 goto free; 10123 10124 csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs), 10125 GFP_KERNEL); 10126 if (!csa_attrs) { 10127 err = -ENOMEM; 10128 goto free; 10129 } 10130 10131 err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX, 10132 info->attrs[NL80211_ATTR_CSA_IES], 10133 nl80211_policy, info->extack); 10134 if (err) 10135 goto free; 10136 10137 err = nl80211_parse_beacon(rdev, csa_attrs, ¶ms.beacon_csa, 10138 info->extack); 10139 if (err) 10140 goto free; 10141 10142 if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 10143 err = -EINVAL; 10144 goto free; 10145 } 10146 10147 len = nla_len(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 10148 if (!len || (len % sizeof(u16))) { 10149 err = -EINVAL; 10150 goto free; 10151 } 10152 10153 params.n_counter_offsets_beacon = len / sizeof(u16); 10154 if (rdev->wiphy.max_num_csa_counters && 10155 (params.n_counter_offsets_beacon > 10156 rdev->wiphy.max_num_csa_counters)) { 10157 err = -EINVAL; 10158 goto free; 10159 } 10160 10161 params.counter_offsets_beacon = 10162 nla_data(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 10163 10164 /* sanity checks - counters should fit and be the same */ 10165 for (i = 0; i < params.n_counter_offsets_beacon; i++) { 10166 u16 offset = params.counter_offsets_beacon[i]; 10167 10168 if (offset >= params.beacon_csa.tail_len) { 10169 err = -EINVAL; 10170 goto free; 10171 } 10172 10173 if (params.beacon_csa.tail[offset] != params.count) { 10174 err = -EINVAL; 10175 goto free; 10176 } 10177 } 10178 10179 if (csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 10180 len = nla_len(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 10181 if (!len || (len % sizeof(u16))) { 10182 err = -EINVAL; 10183 goto free; 10184 } 10185 10186 params.n_counter_offsets_presp = len / sizeof(u16); 10187 if (rdev->wiphy.max_num_csa_counters && 10188 (params.n_counter_offsets_presp > 10189 rdev->wiphy.max_num_csa_counters)) { 10190 err = -EINVAL; 10191 goto free; 10192 } 10193 10194 params.counter_offsets_presp = 10195 nla_data(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 10196 10197 /* sanity checks - counters should fit and be the same */ 10198 for (i = 0; i < params.n_counter_offsets_presp; i++) { 10199 u16 offset = params.counter_offsets_presp[i]; 10200 10201 if (offset >= params.beacon_csa.probe_resp_len) { 10202 err = -EINVAL; 10203 goto free; 10204 } 10205 10206 if (params.beacon_csa.probe_resp[offset] != 10207 params.count) { 10208 err = -EINVAL; 10209 goto free; 10210 } 10211 } 10212 } 10213 10214 skip_beacons: 10215 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 10216 if (err) 10217 goto free; 10218 10219 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 10220 wdev->iftype)) { 10221 err = -EINVAL; 10222 goto free; 10223 } 10224 10225 err = cfg80211_chandef_dfs_required(wdev->wiphy, 10226 ¶ms.chandef, 10227 wdev->iftype); 10228 if (err < 0) 10229 goto free; 10230 10231 if (err > 0) { 10232 params.radar_required = true; 10233 if (need_handle_dfs_flag && 10234 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) { 10235 err = -EINVAL; 10236 goto free; 10237 } 10238 } 10239 10240 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX]) 10241 params.block_tx = true; 10242 10243 params.link_id = link_id; 10244 err = rdev_channel_switch(rdev, dev, ¶ms); 10245 10246 free: 10247 kfree(params.beacon_after.mbssid_ies); 10248 kfree(params.beacon_csa.mbssid_ies); 10249 kfree(params.beacon_after.rnr_ies); 10250 kfree(params.beacon_csa.rnr_ies); 10251 kfree(csa_attrs); 10252 return err; 10253 } 10254 10255 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb, 10256 u32 seq, int flags, 10257 struct cfg80211_registered_device *rdev, 10258 struct wireless_dev *wdev, 10259 struct cfg80211_internal_bss *intbss) 10260 { 10261 struct cfg80211_bss *res = &intbss->pub; 10262 const struct cfg80211_bss_ies *ies; 10263 unsigned int link_id; 10264 void *hdr; 10265 struct nlattr *bss; 10266 10267 lockdep_assert_wiphy(wdev->wiphy); 10268 10269 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 10270 NL80211_CMD_NEW_SCAN_RESULTS); 10271 if (!hdr) 10272 return -1; 10273 10274 genl_dump_check_consistent(cb, hdr); 10275 10276 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation)) 10277 goto nla_put_failure; 10278 if (wdev->netdev && 10279 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex)) 10280 goto nla_put_failure; 10281 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 10282 NL80211_ATTR_PAD)) 10283 goto nla_put_failure; 10284 10285 bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS); 10286 if (!bss) 10287 goto nla_put_failure; 10288 if ((!is_zero_ether_addr(res->bssid) && 10289 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid))) 10290 goto nla_put_failure; 10291 10292 rcu_read_lock(); 10293 /* indicate whether we have probe response data or not */ 10294 if (rcu_access_pointer(res->proberesp_ies) && 10295 nla_put_flag(msg, NL80211_BSS_PRESP_DATA)) 10296 goto fail_unlock_rcu; 10297 10298 /* this pointer prefers to be pointed to probe response data 10299 * but is always valid 10300 */ 10301 ies = rcu_dereference(res->ies); 10302 if (ies) { 10303 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf, 10304 NL80211_BSS_PAD)) 10305 goto fail_unlock_rcu; 10306 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS, 10307 ies->len, ies->data)) 10308 goto fail_unlock_rcu; 10309 } 10310 10311 /* and this pointer is always (unless driver didn't know) beacon data */ 10312 ies = rcu_dereference(res->beacon_ies); 10313 if (ies && ies->from_beacon) { 10314 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf, 10315 NL80211_BSS_PAD)) 10316 goto fail_unlock_rcu; 10317 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES, 10318 ies->len, ies->data)) 10319 goto fail_unlock_rcu; 10320 } 10321 rcu_read_unlock(); 10322 10323 if (res->beacon_interval && 10324 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval)) 10325 goto nla_put_failure; 10326 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) || 10327 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) || 10328 nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET, 10329 res->channel->freq_offset) || 10330 nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO, 10331 jiffies_to_msecs(jiffies - intbss->ts))) 10332 goto nla_put_failure; 10333 10334 if (intbss->parent_tsf && 10335 (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF, 10336 intbss->parent_tsf, NL80211_BSS_PAD) || 10337 nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN, 10338 intbss->parent_bssid))) 10339 goto nla_put_failure; 10340 10341 if (intbss->ts_boottime && 10342 nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME, 10343 intbss->ts_boottime, NL80211_BSS_PAD)) 10344 goto nla_put_failure; 10345 10346 if (!nl80211_put_signal(msg, intbss->pub.chains, 10347 intbss->pub.chain_signal, 10348 NL80211_BSS_CHAIN_SIGNAL)) 10349 goto nla_put_failure; 10350 10351 switch (rdev->wiphy.signal_type) { 10352 case CFG80211_SIGNAL_TYPE_MBM: 10353 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal)) 10354 goto nla_put_failure; 10355 break; 10356 case CFG80211_SIGNAL_TYPE_UNSPEC: 10357 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal)) 10358 goto nla_put_failure; 10359 break; 10360 default: 10361 break; 10362 } 10363 10364 switch (wdev->iftype) { 10365 case NL80211_IFTYPE_P2P_CLIENT: 10366 case NL80211_IFTYPE_STATION: 10367 for_each_valid_link(wdev, link_id) { 10368 if (intbss == wdev->links[link_id].client.current_bss && 10369 (nla_put_u32(msg, NL80211_BSS_STATUS, 10370 NL80211_BSS_STATUS_ASSOCIATED) || 10371 (wdev->valid_links && 10372 (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID, 10373 link_id) || 10374 nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN, 10375 wdev->u.client.connected_addr))))) 10376 goto nla_put_failure; 10377 } 10378 break; 10379 case NL80211_IFTYPE_ADHOC: 10380 if (intbss == wdev->u.ibss.current_bss && 10381 nla_put_u32(msg, NL80211_BSS_STATUS, 10382 NL80211_BSS_STATUS_IBSS_JOINED)) 10383 goto nla_put_failure; 10384 break; 10385 default: 10386 break; 10387 } 10388 10389 if (nla_put_u32(msg, NL80211_BSS_USE_FOR, res->use_for)) 10390 goto nla_put_failure; 10391 10392 if (res->cannot_use_reasons && 10393 nla_put_u64_64bit(msg, NL80211_BSS_CANNOT_USE_REASONS, 10394 res->cannot_use_reasons, 10395 NL80211_BSS_PAD)) 10396 goto nla_put_failure; 10397 10398 nla_nest_end(msg, bss); 10399 10400 genlmsg_end(msg, hdr); 10401 return 0; 10402 10403 fail_unlock_rcu: 10404 rcu_read_unlock(); 10405 nla_put_failure: 10406 genlmsg_cancel(msg, hdr); 10407 return -EMSGSIZE; 10408 } 10409 10410 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb) 10411 { 10412 struct cfg80211_registered_device *rdev; 10413 struct cfg80211_internal_bss *scan; 10414 struct wireless_dev *wdev; 10415 struct nlattr **attrbuf; 10416 int start = cb->args[2], idx = 0; 10417 bool dump_include_use_data; 10418 int err; 10419 10420 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 10421 if (!attrbuf) 10422 return -ENOMEM; 10423 10424 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 10425 if (err) { 10426 kfree(attrbuf); 10427 return err; 10428 } 10429 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10430 __acquire(&rdev->wiphy.mtx); 10431 10432 dump_include_use_data = 10433 attrbuf[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA]; 10434 kfree(attrbuf); 10435 10436 spin_lock_bh(&rdev->bss_lock); 10437 10438 /* 10439 * dump_scan will be called multiple times to break up the scan results 10440 * into multiple messages. It is unlikely that any more bss-es will be 10441 * expired after the first call, so only call only call this on the 10442 * first dump_scan invocation. 10443 */ 10444 if (start == 0) 10445 cfg80211_bss_expire(rdev); 10446 10447 cb->seq = rdev->bss_generation; 10448 10449 list_for_each_entry(scan, &rdev->bss_list, list) { 10450 if (++idx <= start) 10451 continue; 10452 if (!dump_include_use_data && 10453 !(scan->pub.use_for & NL80211_BSS_USE_FOR_NORMAL)) 10454 continue; 10455 if (nl80211_send_bss(skb, cb, 10456 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10457 rdev, wdev, scan) < 0) { 10458 idx--; 10459 break; 10460 } 10461 } 10462 10463 spin_unlock_bh(&rdev->bss_lock); 10464 10465 cb->args[2] = idx; 10466 wiphy_unlock(&rdev->wiphy); 10467 10468 return skb->len; 10469 } 10470 10471 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq, 10472 int flags, struct net_device *dev, 10473 bool allow_radio_stats, 10474 struct survey_info *survey) 10475 { 10476 void *hdr; 10477 struct nlattr *infoattr; 10478 10479 /* skip radio stats if userspace didn't request them */ 10480 if (!survey->channel && !allow_radio_stats) 10481 return 0; 10482 10483 hdr = nl80211hdr_put(msg, portid, seq, flags, 10484 NL80211_CMD_NEW_SURVEY_RESULTS); 10485 if (!hdr) 10486 return -ENOMEM; 10487 10488 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 10489 goto nla_put_failure; 10490 10491 infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO); 10492 if (!infoattr) 10493 goto nla_put_failure; 10494 10495 if (survey->channel && 10496 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY, 10497 survey->channel->center_freq)) 10498 goto nla_put_failure; 10499 10500 if (survey->channel && survey->channel->freq_offset && 10501 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET, 10502 survey->channel->freq_offset)) 10503 goto nla_put_failure; 10504 10505 if ((survey->filled & SURVEY_INFO_NOISE_DBM) && 10506 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise)) 10507 goto nla_put_failure; 10508 if ((survey->filled & SURVEY_INFO_IN_USE) && 10509 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE)) 10510 goto nla_put_failure; 10511 if ((survey->filled & SURVEY_INFO_TIME) && 10512 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME, 10513 survey->time, NL80211_SURVEY_INFO_PAD)) 10514 goto nla_put_failure; 10515 if ((survey->filled & SURVEY_INFO_TIME_BUSY) && 10516 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY, 10517 survey->time_busy, NL80211_SURVEY_INFO_PAD)) 10518 goto nla_put_failure; 10519 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) && 10520 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY, 10521 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD)) 10522 goto nla_put_failure; 10523 if ((survey->filled & SURVEY_INFO_TIME_RX) && 10524 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX, 10525 survey->time_rx, NL80211_SURVEY_INFO_PAD)) 10526 goto nla_put_failure; 10527 if ((survey->filled & SURVEY_INFO_TIME_TX) && 10528 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX, 10529 survey->time_tx, NL80211_SURVEY_INFO_PAD)) 10530 goto nla_put_failure; 10531 if ((survey->filled & SURVEY_INFO_TIME_SCAN) && 10532 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN, 10533 survey->time_scan, NL80211_SURVEY_INFO_PAD)) 10534 goto nla_put_failure; 10535 if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) && 10536 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX, 10537 survey->time_bss_rx, NL80211_SURVEY_INFO_PAD)) 10538 goto nla_put_failure; 10539 10540 nla_nest_end(msg, infoattr); 10541 10542 genlmsg_end(msg, hdr); 10543 return 0; 10544 10545 nla_put_failure: 10546 genlmsg_cancel(msg, hdr); 10547 return -EMSGSIZE; 10548 } 10549 10550 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb) 10551 { 10552 struct nlattr **attrbuf; 10553 struct survey_info survey; 10554 struct cfg80211_registered_device *rdev; 10555 struct wireless_dev *wdev; 10556 int survey_idx = cb->args[2]; 10557 int res; 10558 bool radio_stats; 10559 10560 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 10561 if (!attrbuf) 10562 return -ENOMEM; 10563 10564 res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 10565 if (res) { 10566 kfree(attrbuf); 10567 return res; 10568 } 10569 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10570 __acquire(&rdev->wiphy.mtx); 10571 10572 /* prepare_wdev_dump parsed the attributes */ 10573 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS]; 10574 10575 if (!wdev->netdev) { 10576 res = -EINVAL; 10577 goto out_err; 10578 } 10579 10580 if (!rdev->ops->dump_survey) { 10581 res = -EOPNOTSUPP; 10582 goto out_err; 10583 } 10584 10585 while (1) { 10586 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey); 10587 if (res == -ENOENT) 10588 break; 10589 if (res) 10590 goto out_err; 10591 10592 /* don't send disabled channels, but do send non-channel data */ 10593 if (survey.channel && 10594 survey.channel->flags & IEEE80211_CHAN_DISABLED) { 10595 survey_idx++; 10596 continue; 10597 } 10598 10599 if (nl80211_send_survey(skb, 10600 NETLINK_CB(cb->skb).portid, 10601 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10602 wdev->netdev, radio_stats, &survey) < 0) 10603 goto out; 10604 survey_idx++; 10605 } 10606 10607 out: 10608 cb->args[2] = survey_idx; 10609 res = skb->len; 10610 out_err: 10611 kfree(attrbuf); 10612 wiphy_unlock(&rdev->wiphy); 10613 return res; 10614 } 10615 10616 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info) 10617 { 10618 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10619 struct net_device *dev = info->user_ptr[1]; 10620 struct ieee80211_channel *chan; 10621 const u8 *bssid, *ssid; 10622 int err, ssid_len; 10623 enum nl80211_auth_type auth_type; 10624 struct key_parse key; 10625 bool local_state_change; 10626 struct cfg80211_auth_request req = {}; 10627 u32 freq; 10628 10629 if (!info->attrs[NL80211_ATTR_MAC]) 10630 return -EINVAL; 10631 10632 if (!info->attrs[NL80211_ATTR_AUTH_TYPE]) 10633 return -EINVAL; 10634 10635 if (!info->attrs[NL80211_ATTR_SSID]) 10636 return -EINVAL; 10637 10638 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 10639 return -EINVAL; 10640 10641 err = nl80211_parse_key(info, &key); 10642 if (err) 10643 return err; 10644 10645 if (key.idx >= 0) { 10646 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP) 10647 return -EINVAL; 10648 if (!key.p.key || !key.p.key_len) 10649 return -EINVAL; 10650 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 || 10651 key.p.key_len != WLAN_KEY_LEN_WEP40) && 10652 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 || 10653 key.p.key_len != WLAN_KEY_LEN_WEP104)) 10654 return -EINVAL; 10655 if (key.idx > 3) 10656 return -EINVAL; 10657 } else { 10658 key.p.key_len = 0; 10659 key.p.key = NULL; 10660 } 10661 10662 if (key.idx >= 0) { 10663 int i; 10664 bool ok = false; 10665 10666 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) { 10667 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) { 10668 ok = true; 10669 break; 10670 } 10671 } 10672 if (!ok) 10673 return -EINVAL; 10674 } 10675 10676 if (!rdev->ops->auth) 10677 return -EOPNOTSUPP; 10678 10679 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10680 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10681 return -EOPNOTSUPP; 10682 10683 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 10684 freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 10685 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 10686 freq += 10687 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 10688 10689 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 10690 if (!chan) 10691 return -EINVAL; 10692 10693 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10694 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10695 10696 if (info->attrs[NL80211_ATTR_IE]) { 10697 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10698 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10699 } 10700 10701 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 10702 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE)) 10703 return -EINVAL; 10704 10705 if ((auth_type == NL80211_AUTHTYPE_SAE || 10706 auth_type == NL80211_AUTHTYPE_FILS_SK || 10707 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 10708 auth_type == NL80211_AUTHTYPE_FILS_PK) && 10709 !info->attrs[NL80211_ATTR_AUTH_DATA]) 10710 return -EINVAL; 10711 10712 if (info->attrs[NL80211_ATTR_AUTH_DATA]) { 10713 if (auth_type != NL80211_AUTHTYPE_SAE && 10714 auth_type != NL80211_AUTHTYPE_FILS_SK && 10715 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS && 10716 auth_type != NL80211_AUTHTYPE_FILS_PK) 10717 return -EINVAL; 10718 req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]); 10719 req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]); 10720 } 10721 10722 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 10723 10724 /* 10725 * Since we no longer track auth state, ignore 10726 * requests to only change local state. 10727 */ 10728 if (local_state_change) 10729 return 0; 10730 10731 req.auth_type = auth_type; 10732 req.key = key.p.key; 10733 req.key_len = key.p.key_len; 10734 req.key_idx = key.idx; 10735 req.link_id = nl80211_link_id_or_invalid(info->attrs); 10736 if (req.link_id >= 0) { 10737 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 10738 return -EINVAL; 10739 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 10740 return -EINVAL; 10741 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 10742 if (!is_valid_ether_addr(req.ap_mld_addr)) 10743 return -EINVAL; 10744 } 10745 10746 req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, 10747 IEEE80211_BSS_TYPE_ESS, 10748 IEEE80211_PRIVACY_ANY); 10749 if (!req.bss) 10750 return -ENOENT; 10751 10752 err = cfg80211_mlme_auth(rdev, dev, &req); 10753 10754 cfg80211_put_bss(&rdev->wiphy, req.bss); 10755 10756 return err; 10757 } 10758 10759 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev, 10760 struct genl_info *info) 10761 { 10762 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 10763 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set"); 10764 return -EINVAL; 10765 } 10766 10767 if (!rdev->ops->tx_control_port || 10768 !wiphy_ext_feature_isset(&rdev->wiphy, 10769 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 10770 return -EOPNOTSUPP; 10771 10772 return 0; 10773 } 10774 10775 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 10776 struct genl_info *info, 10777 struct cfg80211_crypto_settings *settings, 10778 int cipher_limit) 10779 { 10780 memset(settings, 0, sizeof(*settings)); 10781 10782 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT]; 10783 10784 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 10785 u16 proto; 10786 10787 proto = nla_get_u16( 10788 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 10789 settings->control_port_ethertype = cpu_to_be16(proto); 10790 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 10791 proto != ETH_P_PAE) 10792 return -EINVAL; 10793 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]) 10794 settings->control_port_no_encrypt = true; 10795 } else 10796 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE); 10797 10798 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 10799 int r = validate_pae_over_nl80211(rdev, info); 10800 10801 if (r < 0) 10802 return r; 10803 10804 settings->control_port_over_nl80211 = true; 10805 10806 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH]) 10807 settings->control_port_no_preauth = true; 10808 } 10809 10810 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) { 10811 void *data; 10812 int len, i; 10813 10814 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 10815 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 10816 settings->n_ciphers_pairwise = len / sizeof(u32); 10817 10818 if (len % sizeof(u32)) 10819 return -EINVAL; 10820 10821 if (settings->n_ciphers_pairwise > cipher_limit) 10822 return -EINVAL; 10823 10824 memcpy(settings->ciphers_pairwise, data, len); 10825 10826 for (i = 0; i < settings->n_ciphers_pairwise; i++) 10827 if (!cfg80211_supported_cipher_suite( 10828 &rdev->wiphy, 10829 settings->ciphers_pairwise[i])) 10830 return -EINVAL; 10831 } 10832 10833 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) { 10834 settings->cipher_group = 10835 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]); 10836 if (!cfg80211_supported_cipher_suite(&rdev->wiphy, 10837 settings->cipher_group)) 10838 return -EINVAL; 10839 } 10840 10841 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) 10842 settings->wpa_versions = 10843 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]); 10844 10845 if (info->attrs[NL80211_ATTR_AKM_SUITES]) { 10846 void *data; 10847 int len; 10848 10849 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]); 10850 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]); 10851 settings->n_akm_suites = len / sizeof(u32); 10852 10853 if (len % sizeof(u32)) 10854 return -EINVAL; 10855 10856 if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites) 10857 return -EINVAL; 10858 10859 memcpy(settings->akm_suites, data, len); 10860 } 10861 10862 if (info->attrs[NL80211_ATTR_PMK]) { 10863 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN) 10864 return -EINVAL; 10865 if (!wiphy_ext_feature_isset(&rdev->wiphy, 10866 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) && 10867 !wiphy_ext_feature_isset(&rdev->wiphy, 10868 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK)) 10869 return -EINVAL; 10870 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]); 10871 } 10872 10873 if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) { 10874 if (!wiphy_ext_feature_isset(&rdev->wiphy, 10875 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 10876 !wiphy_ext_feature_isset(&rdev->wiphy, 10877 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP)) 10878 return -EINVAL; 10879 settings->sae_pwd = 10880 nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 10881 settings->sae_pwd_len = 10882 nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 10883 } 10884 10885 if (info->attrs[NL80211_ATTR_SAE_PWE]) 10886 settings->sae_pwe = 10887 nla_get_u8(info->attrs[NL80211_ATTR_SAE_PWE]); 10888 else 10889 settings->sae_pwe = NL80211_SAE_PWE_UNSPECIFIED; 10890 10891 return 0; 10892 } 10893 10894 static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev, 10895 const u8 *ssid, int ssid_len, 10896 struct nlattr **attrs, 10897 int assoc_link_id, int link_id) 10898 { 10899 struct ieee80211_channel *chan; 10900 struct cfg80211_bss *bss; 10901 const u8 *bssid; 10902 u32 freq, use_for = 0; 10903 10904 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ]) 10905 return ERR_PTR(-EINVAL); 10906 10907 bssid = nla_data(attrs[NL80211_ATTR_MAC]); 10908 10909 freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ])); 10910 if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 10911 freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 10912 10913 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 10914 if (!chan) 10915 return ERR_PTR(-EINVAL); 10916 10917 if (assoc_link_id >= 0) 10918 use_for = NL80211_BSS_USE_FOR_MLD_LINK; 10919 if (assoc_link_id == link_id) 10920 use_for |= NL80211_BSS_USE_FOR_NORMAL; 10921 10922 bss = __cfg80211_get_bss(&rdev->wiphy, chan, bssid, 10923 ssid, ssid_len, 10924 IEEE80211_BSS_TYPE_ESS, 10925 IEEE80211_PRIVACY_ANY, 10926 use_for); 10927 if (!bss) 10928 return ERR_PTR(-ENOENT); 10929 10930 return bss; 10931 } 10932 10933 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info) 10934 { 10935 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10936 struct net_device *dev = info->user_ptr[1]; 10937 struct cfg80211_assoc_request req = {}; 10938 struct nlattr **attrs = NULL; 10939 const u8 *ap_addr, *ssid; 10940 unsigned int link_id; 10941 int err, ssid_len; 10942 10943 if (dev->ieee80211_ptr->conn_owner_nlportid && 10944 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 10945 return -EPERM; 10946 10947 if (!info->attrs[NL80211_ATTR_SSID]) 10948 return -EINVAL; 10949 10950 if (!rdev->ops->assoc) 10951 return -EOPNOTSUPP; 10952 10953 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10954 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10955 return -EOPNOTSUPP; 10956 10957 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10958 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10959 10960 if (info->attrs[NL80211_ATTR_IE]) { 10961 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10962 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10963 10964 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 10965 req.ie, req.ie_len)) { 10966 NL_SET_ERR_MSG_ATTR(info->extack, 10967 info->attrs[NL80211_ATTR_IE], 10968 "non-inheritance makes no sense"); 10969 return -EINVAL; 10970 } 10971 } 10972 10973 if (info->attrs[NL80211_ATTR_USE_MFP]) { 10974 enum nl80211_mfp mfp = 10975 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 10976 if (mfp == NL80211_MFP_REQUIRED) 10977 req.use_mfp = true; 10978 else if (mfp != NL80211_MFP_NO) 10979 return -EINVAL; 10980 } 10981 10982 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 10983 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 10984 10985 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 10986 req.flags |= ASSOC_REQ_DISABLE_HT; 10987 10988 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 10989 memcpy(&req.ht_capa_mask, 10990 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 10991 sizeof(req.ht_capa_mask)); 10992 10993 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 10994 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 10995 return -EINVAL; 10996 memcpy(&req.ht_capa, 10997 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 10998 sizeof(req.ht_capa)); 10999 } 11000 11001 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 11002 req.flags |= ASSOC_REQ_DISABLE_VHT; 11003 11004 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 11005 req.flags |= ASSOC_REQ_DISABLE_HE; 11006 11007 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 11008 req.flags |= ASSOC_REQ_DISABLE_EHT; 11009 11010 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11011 memcpy(&req.vht_capa_mask, 11012 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 11013 sizeof(req.vht_capa_mask)); 11014 11015 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 11016 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11017 return -EINVAL; 11018 memcpy(&req.vht_capa, 11019 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 11020 sizeof(req.vht_capa)); 11021 } 11022 11023 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 11024 if (!((rdev->wiphy.features & 11025 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 11026 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 11027 !wiphy_ext_feature_isset(&rdev->wiphy, 11028 NL80211_EXT_FEATURE_RRM)) 11029 return -EINVAL; 11030 req.flags |= ASSOC_REQ_USE_RRM; 11031 } 11032 11033 if (info->attrs[NL80211_ATTR_FILS_KEK]) { 11034 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 11035 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 11036 if (!info->attrs[NL80211_ATTR_FILS_NONCES]) 11037 return -EINVAL; 11038 req.fils_nonces = 11039 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 11040 } 11041 11042 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) { 11043 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 11044 return -EINVAL; 11045 memcpy(&req.s1g_capa_mask, 11046 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]), 11047 sizeof(req.s1g_capa_mask)); 11048 } 11049 11050 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) { 11051 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) 11052 return -EINVAL; 11053 memcpy(&req.s1g_capa, 11054 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]), 11055 sizeof(req.s1g_capa)); 11056 } 11057 11058 if (nla_get_flag(info->attrs[NL80211_ATTR_ASSOC_SPP_AMSDU])) { 11059 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11060 NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT)) { 11061 GENL_SET_ERR_MSG(info, "SPP A-MSDUs not supported"); 11062 return -EINVAL; 11063 } 11064 req.flags |= ASSOC_REQ_SPP_AMSDU; 11065 } 11066 11067 req.link_id = nl80211_link_id_or_invalid(info->attrs); 11068 11069 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 11070 unsigned int attrsize = NUM_NL80211_ATTR * sizeof(*attrs); 11071 struct nlattr *link; 11072 int rem = 0; 11073 11074 if (req.link_id < 0) 11075 return -EINVAL; 11076 11077 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 11078 return -EINVAL; 11079 11080 if (info->attrs[NL80211_ATTR_MAC] || 11081 info->attrs[NL80211_ATTR_WIPHY_FREQ] || 11082 !info->attrs[NL80211_ATTR_MLD_ADDR]) 11083 return -EINVAL; 11084 11085 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 11086 ap_addr = req.ap_mld_addr; 11087 11088 attrs = kzalloc(attrsize, GFP_KERNEL); 11089 if (!attrs) 11090 return -ENOMEM; 11091 11092 nla_for_each_nested(link, 11093 info->attrs[NL80211_ATTR_MLO_LINKS], 11094 rem) { 11095 memset(attrs, 0, attrsize); 11096 11097 nla_parse_nested(attrs, NL80211_ATTR_MAX, 11098 link, NULL, NULL); 11099 11100 if (!attrs[NL80211_ATTR_MLO_LINK_ID]) { 11101 err = -EINVAL; 11102 NL_SET_BAD_ATTR(info->extack, link); 11103 goto free; 11104 } 11105 11106 link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]); 11107 /* cannot use the same link ID again */ 11108 if (req.links[link_id].bss) { 11109 err = -EINVAL; 11110 NL_SET_BAD_ATTR(info->extack, link); 11111 goto free; 11112 } 11113 req.links[link_id].bss = 11114 nl80211_assoc_bss(rdev, ssid, ssid_len, attrs, 11115 req.link_id, link_id); 11116 if (IS_ERR(req.links[link_id].bss)) { 11117 err = PTR_ERR(req.links[link_id].bss); 11118 req.links[link_id].bss = NULL; 11119 NL_SET_ERR_MSG_ATTR(info->extack, 11120 link, "Error fetching BSS for link"); 11121 goto free; 11122 } 11123 11124 if (attrs[NL80211_ATTR_IE]) { 11125 req.links[link_id].elems = 11126 nla_data(attrs[NL80211_ATTR_IE]); 11127 req.links[link_id].elems_len = 11128 nla_len(attrs[NL80211_ATTR_IE]); 11129 11130 if (cfg80211_find_elem(WLAN_EID_FRAGMENT, 11131 req.links[link_id].elems, 11132 req.links[link_id].elems_len)) { 11133 NL_SET_ERR_MSG_ATTR(info->extack, 11134 attrs[NL80211_ATTR_IE], 11135 "cannot deal with fragmentation"); 11136 err = -EINVAL; 11137 goto free; 11138 } 11139 11140 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 11141 req.links[link_id].elems, 11142 req.links[link_id].elems_len)) { 11143 NL_SET_ERR_MSG_ATTR(info->extack, 11144 attrs[NL80211_ATTR_IE], 11145 "cannot deal with non-inheritance"); 11146 err = -EINVAL; 11147 goto free; 11148 } 11149 } 11150 11151 req.links[link_id].disabled = 11152 nla_get_flag(attrs[NL80211_ATTR_MLO_LINK_DISABLED]); 11153 } 11154 11155 if (!req.links[req.link_id].bss) { 11156 err = -EINVAL; 11157 goto free; 11158 } 11159 11160 if (req.links[req.link_id].elems_len) { 11161 GENL_SET_ERR_MSG(info, 11162 "cannot have per-link elems on assoc link"); 11163 err = -EINVAL; 11164 goto free; 11165 } 11166 11167 if (req.links[req.link_id].disabled) { 11168 GENL_SET_ERR_MSG(info, 11169 "cannot have assoc link disabled"); 11170 err = -EINVAL; 11171 goto free; 11172 } 11173 11174 kfree(attrs); 11175 attrs = NULL; 11176 } else { 11177 if (req.link_id >= 0) 11178 return -EINVAL; 11179 11180 req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs, 11181 -1, -1); 11182 if (IS_ERR(req.bss)) 11183 return PTR_ERR(req.bss); 11184 ap_addr = req.bss->bssid; 11185 } 11186 11187 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1); 11188 if (!err) { 11189 struct nlattr *link; 11190 int rem = 0; 11191 11192 err = cfg80211_mlme_assoc(rdev, dev, &req, 11193 info->extack); 11194 11195 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 11196 dev->ieee80211_ptr->conn_owner_nlportid = 11197 info->snd_portid; 11198 memcpy(dev->ieee80211_ptr->disconnect_bssid, 11199 ap_addr, ETH_ALEN); 11200 } 11201 11202 /* Report error from first problematic link */ 11203 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 11204 nla_for_each_nested(link, 11205 info->attrs[NL80211_ATTR_MLO_LINKS], 11206 rem) { 11207 struct nlattr *link_id_attr = 11208 nla_find_nested(link, NL80211_ATTR_MLO_LINK_ID); 11209 11210 if (!link_id_attr) 11211 continue; 11212 11213 link_id = nla_get_u8(link_id_attr); 11214 11215 if (link_id == req.link_id) 11216 continue; 11217 11218 if (!req.links[link_id].error || 11219 WARN_ON(req.links[link_id].error > 0)) 11220 continue; 11221 11222 WARN_ON(err >= 0); 11223 11224 NL_SET_BAD_ATTR(info->extack, link); 11225 err = req.links[link_id].error; 11226 break; 11227 } 11228 } 11229 } 11230 11231 free: 11232 for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++) 11233 cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss); 11234 cfg80211_put_bss(&rdev->wiphy, req.bss); 11235 kfree(attrs); 11236 11237 return err; 11238 } 11239 11240 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info) 11241 { 11242 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11243 struct net_device *dev = info->user_ptr[1]; 11244 const u8 *ie = NULL, *bssid; 11245 int ie_len = 0; 11246 u16 reason_code; 11247 bool local_state_change; 11248 11249 if (dev->ieee80211_ptr->conn_owner_nlportid && 11250 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11251 return -EPERM; 11252 11253 if (!info->attrs[NL80211_ATTR_MAC]) 11254 return -EINVAL; 11255 11256 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11257 return -EINVAL; 11258 11259 if (!rdev->ops->deauth) 11260 return -EOPNOTSUPP; 11261 11262 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11263 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11264 return -EOPNOTSUPP; 11265 11266 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11267 11268 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11269 if (reason_code == 0) { 11270 /* Reason Code 0 is reserved */ 11271 return -EINVAL; 11272 } 11273 11274 if (info->attrs[NL80211_ATTR_IE]) { 11275 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11276 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11277 } 11278 11279 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11280 11281 return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code, 11282 local_state_change); 11283 } 11284 11285 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info) 11286 { 11287 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11288 struct net_device *dev = info->user_ptr[1]; 11289 const u8 *ie = NULL, *bssid; 11290 int ie_len = 0; 11291 u16 reason_code; 11292 bool local_state_change; 11293 11294 if (dev->ieee80211_ptr->conn_owner_nlportid && 11295 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11296 return -EPERM; 11297 11298 if (!info->attrs[NL80211_ATTR_MAC]) 11299 return -EINVAL; 11300 11301 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11302 return -EINVAL; 11303 11304 if (!rdev->ops->disassoc) 11305 return -EOPNOTSUPP; 11306 11307 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11308 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11309 return -EOPNOTSUPP; 11310 11311 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11312 11313 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11314 if (reason_code == 0) { 11315 /* Reason Code 0 is reserved */ 11316 return -EINVAL; 11317 } 11318 11319 if (info->attrs[NL80211_ATTR_IE]) { 11320 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11321 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11322 } 11323 11324 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11325 11326 return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code, 11327 local_state_change); 11328 } 11329 11330 static bool 11331 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev, 11332 int mcast_rate[NUM_NL80211_BANDS], 11333 int rateval) 11334 { 11335 struct wiphy *wiphy = &rdev->wiphy; 11336 bool found = false; 11337 int band, i; 11338 11339 for (band = 0; band < NUM_NL80211_BANDS; band++) { 11340 struct ieee80211_supported_band *sband; 11341 11342 sband = wiphy->bands[band]; 11343 if (!sband) 11344 continue; 11345 11346 for (i = 0; i < sband->n_bitrates; i++) { 11347 if (sband->bitrates[i].bitrate == rateval) { 11348 mcast_rate[band] = i + 1; 11349 found = true; 11350 break; 11351 } 11352 } 11353 } 11354 11355 return found; 11356 } 11357 11358 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info) 11359 { 11360 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11361 struct net_device *dev = info->user_ptr[1]; 11362 struct cfg80211_ibss_params ibss; 11363 struct wiphy *wiphy; 11364 struct cfg80211_cached_keys *connkeys = NULL; 11365 int err; 11366 11367 memset(&ibss, 0, sizeof(ibss)); 11368 11369 if (!info->attrs[NL80211_ATTR_SSID] || 11370 !nla_len(info->attrs[NL80211_ATTR_SSID])) 11371 return -EINVAL; 11372 11373 ibss.beacon_interval = 100; 11374 11375 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) 11376 ibss.beacon_interval = 11377 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 11378 11379 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC, 11380 ibss.beacon_interval); 11381 if (err) 11382 return err; 11383 11384 if (!rdev->ops->join_ibss) 11385 return -EOPNOTSUPP; 11386 11387 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11388 return -EOPNOTSUPP; 11389 11390 wiphy = &rdev->wiphy; 11391 11392 if (info->attrs[NL80211_ATTR_MAC]) { 11393 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11394 11395 if (!is_valid_ether_addr(ibss.bssid)) 11396 return -EINVAL; 11397 } 11398 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11399 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11400 11401 if (info->attrs[NL80211_ATTR_IE]) { 11402 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11403 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11404 } 11405 11406 err = nl80211_parse_chandef(rdev, info, &ibss.chandef); 11407 if (err) 11408 return err; 11409 11410 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef, 11411 NL80211_IFTYPE_ADHOC)) 11412 return -EINVAL; 11413 11414 switch (ibss.chandef.width) { 11415 case NL80211_CHAN_WIDTH_5: 11416 case NL80211_CHAN_WIDTH_10: 11417 case NL80211_CHAN_WIDTH_20_NOHT: 11418 break; 11419 case NL80211_CHAN_WIDTH_20: 11420 case NL80211_CHAN_WIDTH_40: 11421 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11422 return -EINVAL; 11423 break; 11424 case NL80211_CHAN_WIDTH_80: 11425 case NL80211_CHAN_WIDTH_80P80: 11426 case NL80211_CHAN_WIDTH_160: 11427 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11428 return -EINVAL; 11429 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11430 NL80211_EXT_FEATURE_VHT_IBSS)) 11431 return -EINVAL; 11432 break; 11433 case NL80211_CHAN_WIDTH_320: 11434 return -EINVAL; 11435 default: 11436 return -EINVAL; 11437 } 11438 11439 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED]; 11440 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 11441 11442 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 11443 u8 *rates = 11444 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11445 int n_rates = 11446 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11447 struct ieee80211_supported_band *sband = 11448 wiphy->bands[ibss.chandef.chan->band]; 11449 11450 err = ieee80211_get_ratemask(sband, rates, n_rates, 11451 &ibss.basic_rates); 11452 if (err) 11453 return err; 11454 } 11455 11456 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11457 memcpy(&ibss.ht_capa_mask, 11458 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11459 sizeof(ibss.ht_capa_mask)); 11460 11461 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11462 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11463 return -EINVAL; 11464 memcpy(&ibss.ht_capa, 11465 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11466 sizeof(ibss.ht_capa)); 11467 } 11468 11469 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 11470 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate, 11471 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 11472 return -EINVAL; 11473 11474 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) { 11475 bool no_ht = false; 11476 11477 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht); 11478 if (IS_ERR(connkeys)) 11479 return PTR_ERR(connkeys); 11480 11481 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) && 11482 no_ht) { 11483 kfree_sensitive(connkeys); 11484 return -EINVAL; 11485 } 11486 } 11487 11488 ibss.control_port = 11489 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]); 11490 11491 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 11492 int r = validate_pae_over_nl80211(rdev, info); 11493 11494 if (r < 0) { 11495 kfree_sensitive(connkeys); 11496 return r; 11497 } 11498 11499 ibss.control_port_over_nl80211 = true; 11500 } 11501 11502 ibss.userspace_handles_dfs = 11503 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 11504 11505 err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys); 11506 if (err) 11507 kfree_sensitive(connkeys); 11508 else if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 11509 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 11510 11511 return err; 11512 } 11513 11514 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info) 11515 { 11516 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11517 struct net_device *dev = info->user_ptr[1]; 11518 11519 if (!rdev->ops->leave_ibss) 11520 return -EOPNOTSUPP; 11521 11522 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11523 return -EOPNOTSUPP; 11524 11525 return cfg80211_leave_ibss(rdev, dev, false); 11526 } 11527 11528 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info) 11529 { 11530 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11531 struct net_device *dev = info->user_ptr[1]; 11532 int mcast_rate[NUM_NL80211_BANDS]; 11533 u32 nla_rate; 11534 11535 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC && 11536 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 11537 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB) 11538 return -EOPNOTSUPP; 11539 11540 if (!rdev->ops->set_mcast_rate) 11541 return -EOPNOTSUPP; 11542 11543 memset(mcast_rate, 0, sizeof(mcast_rate)); 11544 11545 if (!info->attrs[NL80211_ATTR_MCAST_RATE]) 11546 return -EINVAL; 11547 11548 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]); 11549 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate)) 11550 return -EINVAL; 11551 11552 return rdev_set_mcast_rate(rdev, dev, mcast_rate); 11553 } 11554 11555 static struct sk_buff * 11556 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev, 11557 struct wireless_dev *wdev, int approxlen, 11558 u32 portid, u32 seq, enum nl80211_commands cmd, 11559 enum nl80211_attrs attr, 11560 const struct nl80211_vendor_cmd_info *info, 11561 gfp_t gfp) 11562 { 11563 struct sk_buff *skb; 11564 void *hdr; 11565 struct nlattr *data; 11566 11567 skb = nlmsg_new(approxlen + 100, gfp); 11568 if (!skb) 11569 return NULL; 11570 11571 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd); 11572 if (!hdr) { 11573 kfree_skb(skb); 11574 return NULL; 11575 } 11576 11577 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 11578 goto nla_put_failure; 11579 11580 if (info) { 11581 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID, 11582 info->vendor_id)) 11583 goto nla_put_failure; 11584 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD, 11585 info->subcmd)) 11586 goto nla_put_failure; 11587 } 11588 11589 if (wdev) { 11590 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 11591 wdev_id(wdev), NL80211_ATTR_PAD)) 11592 goto nla_put_failure; 11593 if (wdev->netdev && 11594 nla_put_u32(skb, NL80211_ATTR_IFINDEX, 11595 wdev->netdev->ifindex)) 11596 goto nla_put_failure; 11597 } 11598 11599 data = nla_nest_start_noflag(skb, attr); 11600 if (!data) 11601 goto nla_put_failure; 11602 11603 ((void **)skb->cb)[0] = rdev; 11604 ((void **)skb->cb)[1] = hdr; 11605 ((void **)skb->cb)[2] = data; 11606 11607 return skb; 11608 11609 nla_put_failure: 11610 kfree_skb(skb); 11611 return NULL; 11612 } 11613 11614 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy, 11615 struct wireless_dev *wdev, 11616 enum nl80211_commands cmd, 11617 enum nl80211_attrs attr, 11618 unsigned int portid, 11619 int vendor_event_idx, 11620 int approxlen, gfp_t gfp) 11621 { 11622 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 11623 const struct nl80211_vendor_cmd_info *info; 11624 11625 switch (cmd) { 11626 case NL80211_CMD_TESTMODE: 11627 if (WARN_ON(vendor_event_idx != -1)) 11628 return NULL; 11629 info = NULL; 11630 break; 11631 case NL80211_CMD_VENDOR: 11632 if (WARN_ON(vendor_event_idx < 0 || 11633 vendor_event_idx >= wiphy->n_vendor_events)) 11634 return NULL; 11635 info = &wiphy->vendor_events[vendor_event_idx]; 11636 break; 11637 default: 11638 WARN_ON(1); 11639 return NULL; 11640 } 11641 11642 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0, 11643 cmd, attr, info, gfp); 11644 } 11645 EXPORT_SYMBOL(__cfg80211_alloc_event_skb); 11646 11647 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp) 11648 { 11649 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 11650 void *hdr = ((void **)skb->cb)[1]; 11651 struct nlmsghdr *nlhdr = nlmsg_hdr(skb); 11652 struct nlattr *data = ((void **)skb->cb)[2]; 11653 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE; 11654 11655 /* clear CB data for netlink core to own from now on */ 11656 memset(skb->cb, 0, sizeof(skb->cb)); 11657 11658 nla_nest_end(skb, data); 11659 genlmsg_end(skb, hdr); 11660 11661 if (nlhdr->nlmsg_pid) { 11662 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb, 11663 nlhdr->nlmsg_pid); 11664 } else { 11665 if (data->nla_type == NL80211_ATTR_VENDOR_DATA) 11666 mcgrp = NL80211_MCGRP_VENDOR; 11667 11668 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 11669 skb, 0, mcgrp, gfp); 11670 } 11671 } 11672 EXPORT_SYMBOL(__cfg80211_send_event_skb); 11673 11674 #ifdef CONFIG_NL80211_TESTMODE 11675 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info) 11676 { 11677 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11678 struct wireless_dev *wdev; 11679 int err; 11680 11681 lockdep_assert_held(&rdev->wiphy.mtx); 11682 11683 wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 11684 info->attrs); 11685 11686 if (!rdev->ops->testmode_cmd) 11687 return -EOPNOTSUPP; 11688 11689 if (IS_ERR(wdev)) { 11690 err = PTR_ERR(wdev); 11691 if (err != -EINVAL) 11692 return err; 11693 wdev = NULL; 11694 } else if (wdev->wiphy != &rdev->wiphy) { 11695 return -EINVAL; 11696 } 11697 11698 if (!info->attrs[NL80211_ATTR_TESTDATA]) 11699 return -EINVAL; 11700 11701 rdev->cur_cmd_info = info; 11702 err = rdev_testmode_cmd(rdev, wdev, 11703 nla_data(info->attrs[NL80211_ATTR_TESTDATA]), 11704 nla_len(info->attrs[NL80211_ATTR_TESTDATA])); 11705 rdev->cur_cmd_info = NULL; 11706 11707 return err; 11708 } 11709 11710 static int nl80211_testmode_dump(struct sk_buff *skb, 11711 struct netlink_callback *cb) 11712 { 11713 struct cfg80211_registered_device *rdev; 11714 struct nlattr **attrbuf = NULL; 11715 int err; 11716 long phy_idx; 11717 void *data = NULL; 11718 int data_len = 0; 11719 11720 rtnl_lock(); 11721 11722 if (cb->args[0]) { 11723 /* 11724 * 0 is a valid index, but not valid for args[0], 11725 * so we need to offset by 1. 11726 */ 11727 phy_idx = cb->args[0] - 1; 11728 11729 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx); 11730 if (!rdev) { 11731 err = -ENOENT; 11732 goto out_err; 11733 } 11734 } else { 11735 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 11736 GFP_KERNEL); 11737 if (!attrbuf) { 11738 err = -ENOMEM; 11739 goto out_err; 11740 } 11741 11742 err = nlmsg_parse_deprecated(cb->nlh, 11743 GENL_HDRLEN + nl80211_fam.hdrsize, 11744 attrbuf, nl80211_fam.maxattr, 11745 nl80211_policy, NULL); 11746 if (err) 11747 goto out_err; 11748 11749 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 11750 if (IS_ERR(rdev)) { 11751 err = PTR_ERR(rdev); 11752 goto out_err; 11753 } 11754 phy_idx = rdev->wiphy_idx; 11755 11756 if (attrbuf[NL80211_ATTR_TESTDATA]) 11757 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA]; 11758 } 11759 11760 if (cb->args[1]) { 11761 data = nla_data((void *)cb->args[1]); 11762 data_len = nla_len((void *)cb->args[1]); 11763 } 11764 11765 if (!rdev->ops->testmode_dump) { 11766 err = -EOPNOTSUPP; 11767 goto out_err; 11768 } 11769 11770 while (1) { 11771 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 11772 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11773 NL80211_CMD_TESTMODE); 11774 struct nlattr *tmdata; 11775 11776 if (!hdr) 11777 break; 11778 11779 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) { 11780 genlmsg_cancel(skb, hdr); 11781 break; 11782 } 11783 11784 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA); 11785 if (!tmdata) { 11786 genlmsg_cancel(skb, hdr); 11787 break; 11788 } 11789 err = rdev_testmode_dump(rdev, skb, cb, data, data_len); 11790 nla_nest_end(skb, tmdata); 11791 11792 if (err == -ENOBUFS || err == -ENOENT) { 11793 genlmsg_cancel(skb, hdr); 11794 break; 11795 } else if (err) { 11796 genlmsg_cancel(skb, hdr); 11797 goto out_err; 11798 } 11799 11800 genlmsg_end(skb, hdr); 11801 } 11802 11803 err = skb->len; 11804 /* see above */ 11805 cb->args[0] = phy_idx + 1; 11806 out_err: 11807 kfree(attrbuf); 11808 rtnl_unlock(); 11809 return err; 11810 } 11811 #endif 11812 11813 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info) 11814 { 11815 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11816 struct net_device *dev = info->user_ptr[1]; 11817 struct cfg80211_connect_params connect; 11818 struct wiphy *wiphy; 11819 struct cfg80211_cached_keys *connkeys = NULL; 11820 u32 freq = 0; 11821 int err; 11822 11823 memset(&connect, 0, sizeof(connect)); 11824 11825 if (!info->attrs[NL80211_ATTR_SSID] || 11826 !nla_len(info->attrs[NL80211_ATTR_SSID])) 11827 return -EINVAL; 11828 11829 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 11830 connect.auth_type = 11831 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 11832 if (!nl80211_valid_auth_type(rdev, connect.auth_type, 11833 NL80211_CMD_CONNECT)) 11834 return -EINVAL; 11835 } else 11836 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 11837 11838 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY]; 11839 11840 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] && 11841 !wiphy_ext_feature_isset(&rdev->wiphy, 11842 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 11843 return -EINVAL; 11844 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS]; 11845 11846 err = nl80211_crypto_settings(rdev, info, &connect.crypto, 11847 NL80211_MAX_NR_CIPHER_SUITES); 11848 if (err) 11849 return err; 11850 11851 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11852 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11853 return -EOPNOTSUPP; 11854 11855 wiphy = &rdev->wiphy; 11856 11857 connect.bg_scan_period = -1; 11858 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] && 11859 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) { 11860 connect.bg_scan_period = 11861 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]); 11862 } 11863 11864 if (info->attrs[NL80211_ATTR_MAC]) 11865 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11866 else if (info->attrs[NL80211_ATTR_MAC_HINT]) 11867 connect.bssid_hint = 11868 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]); 11869 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11870 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11871 11872 if (info->attrs[NL80211_ATTR_IE]) { 11873 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11874 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11875 } 11876 11877 if (info->attrs[NL80211_ATTR_USE_MFP]) { 11878 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 11879 if (connect.mfp == NL80211_MFP_OPTIONAL && 11880 !wiphy_ext_feature_isset(&rdev->wiphy, 11881 NL80211_EXT_FEATURE_MFP_OPTIONAL)) 11882 return -EOPNOTSUPP; 11883 } else { 11884 connect.mfp = NL80211_MFP_NO; 11885 } 11886 11887 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 11888 connect.prev_bssid = 11889 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 11890 11891 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) 11892 freq = MHZ_TO_KHZ(nla_get_u32( 11893 info->attrs[NL80211_ATTR_WIPHY_FREQ])); 11894 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 11895 freq += 11896 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 11897 11898 if (freq) { 11899 connect.channel = nl80211_get_valid_chan(wiphy, freq); 11900 if (!connect.channel) 11901 return -EINVAL; 11902 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) { 11903 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]); 11904 freq = MHZ_TO_KHZ(freq); 11905 connect.channel_hint = nl80211_get_valid_chan(wiphy, freq); 11906 if (!connect.channel_hint) 11907 return -EINVAL; 11908 } 11909 11910 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 11911 connect.edmg.channels = 11912 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 11913 11914 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 11915 connect.edmg.bw_config = 11916 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 11917 } 11918 11919 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) { 11920 connkeys = nl80211_parse_connkeys(rdev, info, NULL); 11921 if (IS_ERR(connkeys)) 11922 return PTR_ERR(connkeys); 11923 } 11924 11925 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 11926 connect.flags |= ASSOC_REQ_DISABLE_HT; 11927 11928 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11929 memcpy(&connect.ht_capa_mask, 11930 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11931 sizeof(connect.ht_capa_mask)); 11932 11933 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11934 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) { 11935 kfree_sensitive(connkeys); 11936 return -EINVAL; 11937 } 11938 memcpy(&connect.ht_capa, 11939 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11940 sizeof(connect.ht_capa)); 11941 } 11942 11943 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 11944 connect.flags |= ASSOC_REQ_DISABLE_VHT; 11945 11946 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 11947 connect.flags |= ASSOC_REQ_DISABLE_HE; 11948 11949 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 11950 connect.flags |= ASSOC_REQ_DISABLE_EHT; 11951 11952 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11953 memcpy(&connect.vht_capa_mask, 11954 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 11955 sizeof(connect.vht_capa_mask)); 11956 11957 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 11958 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) { 11959 kfree_sensitive(connkeys); 11960 return -EINVAL; 11961 } 11962 memcpy(&connect.vht_capa, 11963 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 11964 sizeof(connect.vht_capa)); 11965 } 11966 11967 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 11968 if (!((rdev->wiphy.features & 11969 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 11970 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 11971 !wiphy_ext_feature_isset(&rdev->wiphy, 11972 NL80211_EXT_FEATURE_RRM)) { 11973 kfree_sensitive(connkeys); 11974 return -EINVAL; 11975 } 11976 connect.flags |= ASSOC_REQ_USE_RRM; 11977 } 11978 11979 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 11980 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 11981 kfree_sensitive(connkeys); 11982 return -EOPNOTSUPP; 11983 } 11984 11985 if (info->attrs[NL80211_ATTR_BSS_SELECT]) { 11986 /* bss selection makes no sense if bssid is set */ 11987 if (connect.bssid) { 11988 kfree_sensitive(connkeys); 11989 return -EINVAL; 11990 } 11991 11992 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT], 11993 wiphy, &connect.bss_select); 11994 if (err) { 11995 kfree_sensitive(connkeys); 11996 return err; 11997 } 11998 } 11999 12000 if (wiphy_ext_feature_isset(&rdev->wiphy, 12001 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 12002 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 12003 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 12004 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 12005 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12006 connect.fils_erp_username = 12007 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12008 connect.fils_erp_username_len = 12009 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12010 connect.fils_erp_realm = 12011 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12012 connect.fils_erp_realm_len = 12013 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12014 connect.fils_erp_next_seq_num = 12015 nla_get_u16( 12016 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 12017 connect.fils_erp_rrk = 12018 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12019 connect.fils_erp_rrk_len = 12020 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12021 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 12022 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 12023 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 12024 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12025 kfree_sensitive(connkeys); 12026 return -EINVAL; 12027 } 12028 12029 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) { 12030 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12031 kfree_sensitive(connkeys); 12032 GENL_SET_ERR_MSG(info, 12033 "external auth requires connection ownership"); 12034 return -EINVAL; 12035 } 12036 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT; 12037 } 12038 12039 if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT])) 12040 connect.flags |= CONNECT_REQ_MLO_SUPPORT; 12041 12042 err = cfg80211_connect(rdev, dev, &connect, connkeys, 12043 connect.prev_bssid); 12044 if (err) 12045 kfree_sensitive(connkeys); 12046 12047 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 12048 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 12049 if (connect.bssid) 12050 memcpy(dev->ieee80211_ptr->disconnect_bssid, 12051 connect.bssid, ETH_ALEN); 12052 else 12053 eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid); 12054 } 12055 12056 return err; 12057 } 12058 12059 static int nl80211_update_connect_params(struct sk_buff *skb, 12060 struct genl_info *info) 12061 { 12062 struct cfg80211_connect_params connect = {}; 12063 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12064 struct net_device *dev = info->user_ptr[1]; 12065 struct wireless_dev *wdev = dev->ieee80211_ptr; 12066 bool fils_sk_offload; 12067 u32 auth_type; 12068 u32 changed = 0; 12069 12070 if (!rdev->ops->update_connect_params) 12071 return -EOPNOTSUPP; 12072 12073 if (info->attrs[NL80211_ATTR_IE]) { 12074 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12075 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12076 changed |= UPDATE_ASSOC_IES; 12077 } 12078 12079 fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy, 12080 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD); 12081 12082 /* 12083 * when driver supports fils-sk offload all attributes must be 12084 * provided. So the else covers "fils-sk-not-all" and 12085 * "no-fils-sk-any". 12086 */ 12087 if (fils_sk_offload && 12088 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 12089 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 12090 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 12091 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12092 connect.fils_erp_username = 12093 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12094 connect.fils_erp_username_len = 12095 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12096 connect.fils_erp_realm = 12097 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12098 connect.fils_erp_realm_len = 12099 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12100 connect.fils_erp_next_seq_num = 12101 nla_get_u16( 12102 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 12103 connect.fils_erp_rrk = 12104 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12105 connect.fils_erp_rrk_len = 12106 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12107 changed |= UPDATE_FILS_ERP_INFO; 12108 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 12109 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 12110 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 12111 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12112 return -EINVAL; 12113 } 12114 12115 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 12116 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 12117 if (!nl80211_valid_auth_type(rdev, auth_type, 12118 NL80211_CMD_CONNECT)) 12119 return -EINVAL; 12120 12121 if (auth_type == NL80211_AUTHTYPE_FILS_SK && 12122 fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO)) 12123 return -EINVAL; 12124 12125 connect.auth_type = auth_type; 12126 changed |= UPDATE_AUTH_TYPE; 12127 } 12128 12129 if (!wdev->connected) 12130 return -ENOLINK; 12131 12132 return rdev_update_connect_params(rdev, dev, &connect, changed); 12133 } 12134 12135 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info) 12136 { 12137 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12138 struct net_device *dev = info->user_ptr[1]; 12139 u16 reason; 12140 12141 if (dev->ieee80211_ptr->conn_owner_nlportid && 12142 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12143 return -EPERM; 12144 12145 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 12146 reason = WLAN_REASON_DEAUTH_LEAVING; 12147 else 12148 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 12149 12150 if (reason == 0) 12151 return -EINVAL; 12152 12153 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12154 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12155 return -EOPNOTSUPP; 12156 12157 return cfg80211_disconnect(rdev, dev, reason, true); 12158 } 12159 12160 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info) 12161 { 12162 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12163 struct net *net; 12164 int err; 12165 12166 if (info->attrs[NL80211_ATTR_PID]) { 12167 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]); 12168 12169 net = get_net_ns_by_pid(pid); 12170 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) { 12171 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]); 12172 12173 net = get_net_ns_by_fd(fd); 12174 } else { 12175 return -EINVAL; 12176 } 12177 12178 if (IS_ERR(net)) 12179 return PTR_ERR(net); 12180 12181 err = 0; 12182 12183 /* check if anything to do */ 12184 if (!net_eq(wiphy_net(&rdev->wiphy), net)) 12185 err = cfg80211_switch_netns(rdev, net); 12186 12187 put_net(net); 12188 return err; 12189 } 12190 12191 static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info) 12192 { 12193 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12194 struct net_device *dev = info->user_ptr[1]; 12195 struct cfg80211_pmksa pmksa; 12196 bool ap_pmksa_caching_support = false; 12197 12198 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 12199 12200 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 12201 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 12202 12203 if (!info->attrs[NL80211_ATTR_PMKID]) 12204 return -EINVAL; 12205 12206 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 12207 12208 if (info->attrs[NL80211_ATTR_MAC]) { 12209 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12210 } else if (info->attrs[NL80211_ATTR_SSID] && 12211 info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 12212 info->attrs[NL80211_ATTR_PMK]) { 12213 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12214 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12215 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 12216 } else { 12217 return -EINVAL; 12218 } 12219 12220 if (info->attrs[NL80211_ATTR_PMK]) { 12221 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 12222 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 12223 } 12224 12225 if (info->attrs[NL80211_ATTR_PMK_LIFETIME]) 12226 pmksa.pmk_lifetime = 12227 nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]); 12228 12229 if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]) 12230 pmksa.pmk_reauth_threshold = 12231 nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]); 12232 12233 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12234 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 12235 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 12236 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 12237 ap_pmksa_caching_support)) 12238 return -EOPNOTSUPP; 12239 12240 if (!rdev->ops->set_pmksa) 12241 return -EOPNOTSUPP; 12242 12243 return rdev_set_pmksa(rdev, dev, &pmksa); 12244 } 12245 12246 static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info) 12247 { 12248 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12249 struct net_device *dev = info->user_ptr[1]; 12250 struct cfg80211_pmksa pmksa; 12251 bool sae_offload_support = false; 12252 bool owe_offload_support = false; 12253 bool ap_pmksa_caching_support = false; 12254 12255 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 12256 12257 sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 12258 NL80211_EXT_FEATURE_SAE_OFFLOAD); 12259 owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy, 12260 NL80211_EXT_FEATURE_OWE_OFFLOAD); 12261 ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy, 12262 NL80211_EXT_FEATURE_AP_PMKSA_CACHING); 12263 12264 if (info->attrs[NL80211_ATTR_PMKID]) 12265 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 12266 12267 if (info->attrs[NL80211_ATTR_MAC]) { 12268 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12269 } else if (info->attrs[NL80211_ATTR_SSID]) { 12270 /* SSID based pmksa flush suppported only for FILS, 12271 * OWE/SAE OFFLOAD cases 12272 */ 12273 if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 12274 info->attrs[NL80211_ATTR_PMK]) { 12275 pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 12276 } else if (!sae_offload_support && !owe_offload_support) { 12277 return -EINVAL; 12278 } 12279 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12280 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12281 } else { 12282 return -EINVAL; 12283 } 12284 12285 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12286 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 12287 !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP || 12288 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) && 12289 ap_pmksa_caching_support)) 12290 return -EOPNOTSUPP; 12291 12292 if (!rdev->ops->del_pmksa) 12293 return -EOPNOTSUPP; 12294 12295 return rdev_del_pmksa(rdev, dev, &pmksa); 12296 } 12297 12298 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info) 12299 { 12300 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12301 struct net_device *dev = info->user_ptr[1]; 12302 12303 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12304 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12305 return -EOPNOTSUPP; 12306 12307 if (!rdev->ops->flush_pmksa) 12308 return -EOPNOTSUPP; 12309 12310 return rdev_flush_pmksa(rdev, dev); 12311 } 12312 12313 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info) 12314 { 12315 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12316 struct net_device *dev = info->user_ptr[1]; 12317 u8 action_code, dialog_token; 12318 u32 peer_capability = 0; 12319 u16 status_code; 12320 u8 *peer; 12321 int link_id; 12322 bool initiator; 12323 12324 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12325 !rdev->ops->tdls_mgmt) 12326 return -EOPNOTSUPP; 12327 12328 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] || 12329 !info->attrs[NL80211_ATTR_STATUS_CODE] || 12330 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] || 12331 !info->attrs[NL80211_ATTR_IE] || 12332 !info->attrs[NL80211_ATTR_MAC]) 12333 return -EINVAL; 12334 12335 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12336 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]); 12337 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 12338 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]); 12339 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]); 12340 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]) 12341 peer_capability = 12342 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]); 12343 link_id = nl80211_link_id_or_invalid(info->attrs); 12344 12345 return rdev_tdls_mgmt(rdev, dev, peer, link_id, action_code, 12346 dialog_token, status_code, peer_capability, 12347 initiator, 12348 nla_data(info->attrs[NL80211_ATTR_IE]), 12349 nla_len(info->attrs[NL80211_ATTR_IE])); 12350 } 12351 12352 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info) 12353 { 12354 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12355 struct net_device *dev = info->user_ptr[1]; 12356 enum nl80211_tdls_operation operation; 12357 u8 *peer; 12358 12359 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12360 !rdev->ops->tdls_oper) 12361 return -EOPNOTSUPP; 12362 12363 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] || 12364 !info->attrs[NL80211_ATTR_MAC]) 12365 return -EINVAL; 12366 12367 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]); 12368 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12369 12370 return rdev_tdls_oper(rdev, dev, peer, operation); 12371 } 12372 12373 static int nl80211_remain_on_channel(struct sk_buff *skb, 12374 struct genl_info *info) 12375 { 12376 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12377 unsigned int link_id = nl80211_link_id(info->attrs); 12378 struct wireless_dev *wdev = info->user_ptr[1]; 12379 struct cfg80211_chan_def chandef; 12380 struct sk_buff *msg; 12381 void *hdr; 12382 u64 cookie; 12383 u32 duration; 12384 int err; 12385 12386 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 12387 !info->attrs[NL80211_ATTR_DURATION]) 12388 return -EINVAL; 12389 12390 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12391 12392 if (!rdev->ops->remain_on_channel || 12393 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)) 12394 return -EOPNOTSUPP; 12395 12396 /* 12397 * We should be on that channel for at least a minimum amount of 12398 * time (10ms) but no longer than the driver supports. 12399 */ 12400 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12401 duration > rdev->wiphy.max_remain_on_channel_duration) 12402 return -EINVAL; 12403 12404 err = nl80211_parse_chandef(rdev, info, &chandef); 12405 if (err) 12406 return err; 12407 12408 if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) { 12409 const struct cfg80211_chan_def *oper_chandef, *compat_chandef; 12410 12411 oper_chandef = wdev_chandef(wdev, link_id); 12412 12413 if (WARN_ON(!oper_chandef)) { 12414 /* cannot happen since we must beacon to get here */ 12415 WARN_ON(1); 12416 return -EBUSY; 12417 } 12418 12419 /* note: returns first one if identical chandefs */ 12420 compat_chandef = cfg80211_chandef_compatible(&chandef, 12421 oper_chandef); 12422 12423 if (compat_chandef != &chandef) 12424 return -EBUSY; 12425 } 12426 12427 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12428 if (!msg) 12429 return -ENOMEM; 12430 12431 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12432 NL80211_CMD_REMAIN_ON_CHANNEL); 12433 if (!hdr) { 12434 err = -ENOBUFS; 12435 goto free_msg; 12436 } 12437 12438 err = rdev_remain_on_channel(rdev, wdev, chandef.chan, 12439 duration, &cookie); 12440 12441 if (err) 12442 goto free_msg; 12443 12444 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12445 NL80211_ATTR_PAD)) 12446 goto nla_put_failure; 12447 12448 genlmsg_end(msg, hdr); 12449 12450 return genlmsg_reply(msg, info); 12451 12452 nla_put_failure: 12453 err = -ENOBUFS; 12454 free_msg: 12455 nlmsg_free(msg); 12456 return err; 12457 } 12458 12459 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb, 12460 struct genl_info *info) 12461 { 12462 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12463 struct wireless_dev *wdev = info->user_ptr[1]; 12464 u64 cookie; 12465 12466 if (!info->attrs[NL80211_ATTR_COOKIE]) 12467 return -EINVAL; 12468 12469 if (!rdev->ops->cancel_remain_on_channel) 12470 return -EOPNOTSUPP; 12471 12472 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12473 12474 return rdev_cancel_remain_on_channel(rdev, wdev, cookie); 12475 } 12476 12477 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb, 12478 struct genl_info *info) 12479 { 12480 struct cfg80211_bitrate_mask mask; 12481 unsigned int link_id = nl80211_link_id(info->attrs); 12482 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12483 struct net_device *dev = info->user_ptr[1]; 12484 int err; 12485 12486 if (!rdev->ops->set_bitrate_mask) 12487 return -EOPNOTSUPP; 12488 12489 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 12490 NL80211_ATTR_TX_RATES, &mask, 12491 dev, true, link_id); 12492 if (err) 12493 return err; 12494 12495 return rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask); 12496 } 12497 12498 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info) 12499 { 12500 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12501 struct wireless_dev *wdev = info->user_ptr[1]; 12502 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION; 12503 12504 if (!info->attrs[NL80211_ATTR_FRAME_MATCH]) 12505 return -EINVAL; 12506 12507 if (info->attrs[NL80211_ATTR_FRAME_TYPE]) 12508 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]); 12509 12510 switch (wdev->iftype) { 12511 case NL80211_IFTYPE_STATION: 12512 case NL80211_IFTYPE_ADHOC: 12513 case NL80211_IFTYPE_P2P_CLIENT: 12514 case NL80211_IFTYPE_AP: 12515 case NL80211_IFTYPE_AP_VLAN: 12516 case NL80211_IFTYPE_MESH_POINT: 12517 case NL80211_IFTYPE_P2P_GO: 12518 case NL80211_IFTYPE_P2P_DEVICE: 12519 break; 12520 case NL80211_IFTYPE_NAN: 12521 if (!wiphy_ext_feature_isset(wdev->wiphy, 12522 NL80211_EXT_FEATURE_SECURE_NAN)) 12523 return -EOPNOTSUPP; 12524 break; 12525 default: 12526 return -EOPNOTSUPP; 12527 } 12528 12529 /* not much point in registering if we can't reply */ 12530 if (!rdev->ops->mgmt_tx) 12531 return -EOPNOTSUPP; 12532 12533 if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] && 12534 !wiphy_ext_feature_isset(&rdev->wiphy, 12535 NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) { 12536 GENL_SET_ERR_MSG(info, 12537 "multicast RX registrations are not supported"); 12538 return -EOPNOTSUPP; 12539 } 12540 12541 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type, 12542 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12543 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12544 info->attrs[NL80211_ATTR_RECEIVE_MULTICAST], 12545 info->extack); 12546 } 12547 12548 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info) 12549 { 12550 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12551 struct wireless_dev *wdev = info->user_ptr[1]; 12552 struct cfg80211_chan_def chandef; 12553 int err; 12554 void *hdr = NULL; 12555 u64 cookie; 12556 struct sk_buff *msg = NULL; 12557 struct cfg80211_mgmt_tx_params params = { 12558 .dont_wait_for_ack = 12559 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK], 12560 }; 12561 12562 if (!info->attrs[NL80211_ATTR_FRAME]) 12563 return -EINVAL; 12564 12565 if (!rdev->ops->mgmt_tx) 12566 return -EOPNOTSUPP; 12567 12568 switch (wdev->iftype) { 12569 case NL80211_IFTYPE_P2P_DEVICE: 12570 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 12571 return -EINVAL; 12572 break; 12573 case NL80211_IFTYPE_STATION: 12574 case NL80211_IFTYPE_ADHOC: 12575 case NL80211_IFTYPE_P2P_CLIENT: 12576 case NL80211_IFTYPE_AP: 12577 case NL80211_IFTYPE_AP_VLAN: 12578 case NL80211_IFTYPE_MESH_POINT: 12579 case NL80211_IFTYPE_P2P_GO: 12580 break; 12581 case NL80211_IFTYPE_NAN: 12582 if (!wiphy_ext_feature_isset(wdev->wiphy, 12583 NL80211_EXT_FEATURE_SECURE_NAN)) 12584 return -EOPNOTSUPP; 12585 break; 12586 default: 12587 return -EOPNOTSUPP; 12588 } 12589 12590 if (info->attrs[NL80211_ATTR_DURATION]) { 12591 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12592 return -EINVAL; 12593 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12594 12595 /* 12596 * We should wait on the channel for at least a minimum amount 12597 * of time (10ms) but no longer than the driver supports. 12598 */ 12599 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12600 params.wait > rdev->wiphy.max_remain_on_channel_duration) 12601 return -EINVAL; 12602 } 12603 12604 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK]; 12605 12606 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12607 return -EINVAL; 12608 12609 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 12610 12611 /* get the channel if any has been specified, otherwise pass NULL to 12612 * the driver. The latter will use the current one 12613 */ 12614 chandef.chan = NULL; 12615 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 12616 err = nl80211_parse_chandef(rdev, info, &chandef); 12617 if (err) 12618 return err; 12619 } 12620 12621 if (!chandef.chan && params.offchan) 12622 return -EINVAL; 12623 12624 if (params.offchan && 12625 !cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) 12626 return -EBUSY; 12627 12628 params.link_id = nl80211_link_id_or_invalid(info->attrs); 12629 /* 12630 * This now races due to the unlock, but we cannot check 12631 * the valid links for the _station_ anyway, so that's up 12632 * to the driver. 12633 */ 12634 if (params.link_id >= 0 && 12635 !(wdev->valid_links & BIT(params.link_id))) 12636 return -EINVAL; 12637 12638 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 12639 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 12640 12641 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) { 12642 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]); 12643 int i; 12644 12645 if (len % sizeof(u16)) 12646 return -EINVAL; 12647 12648 params.n_csa_offsets = len / sizeof(u16); 12649 params.csa_offsets = 12650 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]); 12651 12652 /* check that all the offsets fit the frame */ 12653 for (i = 0; i < params.n_csa_offsets; i++) { 12654 if (params.csa_offsets[i] >= params.len) 12655 return -EINVAL; 12656 } 12657 } 12658 12659 if (!params.dont_wait_for_ack) { 12660 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12661 if (!msg) 12662 return -ENOMEM; 12663 12664 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12665 NL80211_CMD_FRAME); 12666 if (!hdr) { 12667 err = -ENOBUFS; 12668 goto free_msg; 12669 } 12670 } 12671 12672 params.chan = chandef.chan; 12673 err = cfg80211_mlme_mgmt_tx(rdev, wdev, ¶ms, &cookie); 12674 if (err) 12675 goto free_msg; 12676 12677 if (msg) { 12678 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12679 NL80211_ATTR_PAD)) 12680 goto nla_put_failure; 12681 12682 genlmsg_end(msg, hdr); 12683 return genlmsg_reply(msg, info); 12684 } 12685 12686 return 0; 12687 12688 nla_put_failure: 12689 err = -ENOBUFS; 12690 free_msg: 12691 nlmsg_free(msg); 12692 return err; 12693 } 12694 12695 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info) 12696 { 12697 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12698 struct wireless_dev *wdev = info->user_ptr[1]; 12699 u64 cookie; 12700 12701 if (!info->attrs[NL80211_ATTR_COOKIE]) 12702 return -EINVAL; 12703 12704 if (!rdev->ops->mgmt_tx_cancel_wait) 12705 return -EOPNOTSUPP; 12706 12707 switch (wdev->iftype) { 12708 case NL80211_IFTYPE_STATION: 12709 case NL80211_IFTYPE_ADHOC: 12710 case NL80211_IFTYPE_P2P_CLIENT: 12711 case NL80211_IFTYPE_AP: 12712 case NL80211_IFTYPE_AP_VLAN: 12713 case NL80211_IFTYPE_P2P_GO: 12714 case NL80211_IFTYPE_P2P_DEVICE: 12715 break; 12716 case NL80211_IFTYPE_NAN: 12717 if (!wiphy_ext_feature_isset(wdev->wiphy, 12718 NL80211_EXT_FEATURE_SECURE_NAN)) 12719 return -EOPNOTSUPP; 12720 break; 12721 default: 12722 return -EOPNOTSUPP; 12723 } 12724 12725 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12726 12727 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie); 12728 } 12729 12730 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info) 12731 { 12732 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12733 struct wireless_dev *wdev; 12734 struct net_device *dev = info->user_ptr[1]; 12735 u8 ps_state; 12736 bool state; 12737 int err; 12738 12739 if (!info->attrs[NL80211_ATTR_PS_STATE]) 12740 return -EINVAL; 12741 12742 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]); 12743 12744 wdev = dev->ieee80211_ptr; 12745 12746 if (!rdev->ops->set_power_mgmt) 12747 return -EOPNOTSUPP; 12748 12749 state = (ps_state == NL80211_PS_ENABLED) ? true : false; 12750 12751 if (state == wdev->ps) 12752 return 0; 12753 12754 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout); 12755 if (!err) 12756 wdev->ps = state; 12757 return err; 12758 } 12759 12760 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info) 12761 { 12762 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12763 enum nl80211_ps_state ps_state; 12764 struct wireless_dev *wdev; 12765 struct net_device *dev = info->user_ptr[1]; 12766 struct sk_buff *msg; 12767 void *hdr; 12768 int err; 12769 12770 wdev = dev->ieee80211_ptr; 12771 12772 if (!rdev->ops->set_power_mgmt) 12773 return -EOPNOTSUPP; 12774 12775 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12776 if (!msg) 12777 return -ENOMEM; 12778 12779 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12780 NL80211_CMD_GET_POWER_SAVE); 12781 if (!hdr) { 12782 err = -ENOBUFS; 12783 goto free_msg; 12784 } 12785 12786 if (wdev->ps) 12787 ps_state = NL80211_PS_ENABLED; 12788 else 12789 ps_state = NL80211_PS_DISABLED; 12790 12791 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state)) 12792 goto nla_put_failure; 12793 12794 genlmsg_end(msg, hdr); 12795 return genlmsg_reply(msg, info); 12796 12797 nla_put_failure: 12798 err = -ENOBUFS; 12799 free_msg: 12800 nlmsg_free(msg); 12801 return err; 12802 } 12803 12804 static const struct nla_policy 12805 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = { 12806 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY }, 12807 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 }, 12808 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 }, 12809 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 }, 12810 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 }, 12811 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 }, 12812 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 }, 12813 }; 12814 12815 static int nl80211_set_cqm_txe(struct genl_info *info, 12816 u32 rate, u32 pkts, u32 intvl) 12817 { 12818 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12819 struct net_device *dev = info->user_ptr[1]; 12820 struct wireless_dev *wdev = dev->ieee80211_ptr; 12821 12822 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL) 12823 return -EINVAL; 12824 12825 if (!rdev->ops->set_cqm_txe_config) 12826 return -EOPNOTSUPP; 12827 12828 if (wdev->iftype != NL80211_IFTYPE_STATION && 12829 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 12830 return -EOPNOTSUPP; 12831 12832 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl); 12833 } 12834 12835 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev, 12836 struct net_device *dev, 12837 struct cfg80211_cqm_config *cqm_config) 12838 { 12839 struct wireless_dev *wdev = dev->ieee80211_ptr; 12840 s32 last, low, high; 12841 u32 hyst; 12842 int i, n, low_index; 12843 int err; 12844 12845 /* 12846 * Obtain current RSSI value if possible, if not and no RSSI threshold 12847 * event has been received yet, we should receive an event after a 12848 * connection is established and enough beacons received to calculate 12849 * the average. 12850 */ 12851 if (!cqm_config->last_rssi_event_value && 12852 wdev->links[0].client.current_bss && 12853 rdev->ops->get_station) { 12854 struct station_info sinfo = {}; 12855 u8 *mac_addr; 12856 12857 mac_addr = wdev->links[0].client.current_bss->pub.bssid; 12858 12859 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 12860 if (err) 12861 return err; 12862 12863 cfg80211_sinfo_release_content(&sinfo); 12864 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG)) 12865 cqm_config->last_rssi_event_value = 12866 (s8) sinfo.rx_beacon_signal_avg; 12867 } 12868 12869 last = cqm_config->last_rssi_event_value; 12870 hyst = cqm_config->rssi_hyst; 12871 n = cqm_config->n_rssi_thresholds; 12872 12873 for (i = 0; i < n; i++) { 12874 i = array_index_nospec(i, n); 12875 if (last < cqm_config->rssi_thresholds[i]) 12876 break; 12877 } 12878 12879 low_index = i - 1; 12880 if (low_index >= 0) { 12881 low_index = array_index_nospec(low_index, n); 12882 low = cqm_config->rssi_thresholds[low_index] - hyst; 12883 } else { 12884 low = S32_MIN; 12885 } 12886 if (i < n) { 12887 i = array_index_nospec(i, n); 12888 high = cqm_config->rssi_thresholds[i] + hyst - 1; 12889 } else { 12890 high = S32_MAX; 12891 } 12892 12893 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high); 12894 } 12895 12896 static int nl80211_set_cqm_rssi(struct genl_info *info, 12897 const s32 *thresholds, int n_thresholds, 12898 u32 hysteresis) 12899 { 12900 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12901 struct cfg80211_cqm_config *cqm_config = NULL, *old; 12902 struct net_device *dev = info->user_ptr[1]; 12903 struct wireless_dev *wdev = dev->ieee80211_ptr; 12904 s32 prev = S32_MIN; 12905 int i, err; 12906 12907 /* Check all values negative and sorted */ 12908 for (i = 0; i < n_thresholds; i++) { 12909 if (thresholds[i] > 0 || thresholds[i] <= prev) 12910 return -EINVAL; 12911 12912 prev = thresholds[i]; 12913 } 12914 12915 if (wdev->iftype != NL80211_IFTYPE_STATION && 12916 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 12917 return -EOPNOTSUPP; 12918 12919 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */ 12920 n_thresholds = 0; 12921 12922 old = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 12923 12924 /* if already disabled just succeed */ 12925 if (!n_thresholds && !old) 12926 return 0; 12927 12928 if (n_thresholds > 1) { 12929 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12930 NL80211_EXT_FEATURE_CQM_RSSI_LIST) || 12931 !rdev->ops->set_cqm_rssi_range_config) 12932 return -EOPNOTSUPP; 12933 } else { 12934 if (!rdev->ops->set_cqm_rssi_config) 12935 return -EOPNOTSUPP; 12936 } 12937 12938 if (n_thresholds) { 12939 cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds, 12940 n_thresholds), 12941 GFP_KERNEL); 12942 if (!cqm_config) 12943 return -ENOMEM; 12944 12945 cqm_config->rssi_hyst = hysteresis; 12946 cqm_config->n_rssi_thresholds = n_thresholds; 12947 memcpy(cqm_config->rssi_thresholds, thresholds, 12948 flex_array_size(cqm_config, rssi_thresholds, 12949 n_thresholds)); 12950 cqm_config->use_range_api = n_thresholds > 1 || 12951 !rdev->ops->set_cqm_rssi_config; 12952 12953 rcu_assign_pointer(wdev->cqm_config, cqm_config); 12954 12955 if (cqm_config->use_range_api) 12956 err = cfg80211_cqm_rssi_update(rdev, dev, cqm_config); 12957 else 12958 err = rdev_set_cqm_rssi_config(rdev, dev, 12959 thresholds[0], 12960 hysteresis); 12961 } else { 12962 RCU_INIT_POINTER(wdev->cqm_config, NULL); 12963 /* if enabled as range also disable via range */ 12964 if (old->use_range_api) 12965 err = rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0); 12966 else 12967 err = rdev_set_cqm_rssi_config(rdev, dev, 0, 0); 12968 } 12969 12970 if (err) { 12971 rcu_assign_pointer(wdev->cqm_config, old); 12972 kfree_rcu(cqm_config, rcu_head); 12973 } else { 12974 kfree_rcu(old, rcu_head); 12975 } 12976 12977 return err; 12978 } 12979 12980 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info) 12981 { 12982 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1]; 12983 struct nlattr *cqm; 12984 int err; 12985 12986 cqm = info->attrs[NL80211_ATTR_CQM]; 12987 if (!cqm) 12988 return -EINVAL; 12989 12990 err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm, 12991 nl80211_attr_cqm_policy, 12992 info->extack); 12993 if (err) 12994 return err; 12995 12996 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] && 12997 attrs[NL80211_ATTR_CQM_RSSI_HYST]) { 12998 const s32 *thresholds = 12999 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 13000 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 13001 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]); 13002 13003 if (len % 4) 13004 return -EINVAL; 13005 13006 return nl80211_set_cqm_rssi(info, thresholds, len / 4, 13007 hysteresis); 13008 } 13009 13010 if (attrs[NL80211_ATTR_CQM_TXE_RATE] && 13011 attrs[NL80211_ATTR_CQM_TXE_PKTS] && 13012 attrs[NL80211_ATTR_CQM_TXE_INTVL]) { 13013 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]); 13014 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]); 13015 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]); 13016 13017 return nl80211_set_cqm_txe(info, rate, pkts, intvl); 13018 } 13019 13020 return -EINVAL; 13021 } 13022 13023 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info) 13024 { 13025 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13026 struct net_device *dev = info->user_ptr[1]; 13027 struct ocb_setup setup = {}; 13028 int err; 13029 13030 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 13031 if (err) 13032 return err; 13033 13034 return cfg80211_join_ocb(rdev, dev, &setup); 13035 } 13036 13037 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info) 13038 { 13039 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13040 struct net_device *dev = info->user_ptr[1]; 13041 13042 return cfg80211_leave_ocb(rdev, dev); 13043 } 13044 13045 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info) 13046 { 13047 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13048 struct net_device *dev = info->user_ptr[1]; 13049 struct mesh_config cfg; 13050 struct mesh_setup setup; 13051 int err; 13052 13053 /* start with default */ 13054 memcpy(&cfg, &default_mesh_config, sizeof(cfg)); 13055 memcpy(&setup, &default_mesh_setup, sizeof(setup)); 13056 13057 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) { 13058 /* and parse parameters if given */ 13059 err = nl80211_parse_mesh_config(info, &cfg, NULL); 13060 if (err) 13061 return err; 13062 } 13063 13064 if (!info->attrs[NL80211_ATTR_MESH_ID] || 13065 !nla_len(info->attrs[NL80211_ATTR_MESH_ID])) 13066 return -EINVAL; 13067 13068 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]); 13069 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 13070 13071 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 13072 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate, 13073 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 13074 return -EINVAL; 13075 13076 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) { 13077 setup.beacon_interval = 13078 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 13079 13080 err = cfg80211_validate_beacon_int(rdev, 13081 NL80211_IFTYPE_MESH_POINT, 13082 setup.beacon_interval); 13083 if (err) 13084 return err; 13085 } 13086 13087 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) { 13088 setup.dtim_period = 13089 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 13090 if (setup.dtim_period < 1 || setup.dtim_period > 100) 13091 return -EINVAL; 13092 } 13093 13094 if (info->attrs[NL80211_ATTR_MESH_SETUP]) { 13095 /* parse additional setup parameters if given */ 13096 err = nl80211_parse_mesh_setup(info, &setup); 13097 if (err) 13098 return err; 13099 } 13100 13101 if (setup.user_mpm) 13102 cfg.auto_open_plinks = false; 13103 13104 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 13105 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 13106 if (err) 13107 return err; 13108 } else { 13109 /* __cfg80211_join_mesh() will sort it out */ 13110 setup.chandef.chan = NULL; 13111 } 13112 13113 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 13114 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13115 int n_rates = 13116 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13117 struct ieee80211_supported_band *sband; 13118 13119 if (!setup.chandef.chan) 13120 return -EINVAL; 13121 13122 sband = rdev->wiphy.bands[setup.chandef.chan->band]; 13123 13124 err = ieee80211_get_ratemask(sband, rates, n_rates, 13125 &setup.basic_rates); 13126 if (err) 13127 return err; 13128 } 13129 13130 if (info->attrs[NL80211_ATTR_TX_RATES]) { 13131 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 13132 NL80211_ATTR_TX_RATES, 13133 &setup.beacon_rate, 13134 dev, false, 0); 13135 if (err) 13136 return err; 13137 13138 if (!setup.chandef.chan) 13139 return -EINVAL; 13140 13141 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band, 13142 &setup.beacon_rate); 13143 if (err) 13144 return err; 13145 } 13146 13147 setup.userspace_handles_dfs = 13148 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 13149 13150 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 13151 int r = validate_pae_over_nl80211(rdev, info); 13152 13153 if (r < 0) 13154 return r; 13155 13156 setup.control_port_over_nl80211 = true; 13157 } 13158 13159 err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg); 13160 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) 13161 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 13162 13163 return err; 13164 } 13165 13166 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info) 13167 { 13168 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13169 struct net_device *dev = info->user_ptr[1]; 13170 13171 return cfg80211_leave_mesh(rdev, dev); 13172 } 13173 13174 #ifdef CONFIG_PM 13175 static int nl80211_send_wowlan_patterns(struct sk_buff *msg, 13176 struct cfg80211_registered_device *rdev) 13177 { 13178 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config; 13179 struct nlattr *nl_pats, *nl_pat; 13180 int i, pat_len; 13181 13182 if (!wowlan->n_patterns) 13183 return 0; 13184 13185 nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN); 13186 if (!nl_pats) 13187 return -ENOBUFS; 13188 13189 for (i = 0; i < wowlan->n_patterns; i++) { 13190 nl_pat = nla_nest_start_noflag(msg, i + 1); 13191 if (!nl_pat) 13192 return -ENOBUFS; 13193 pat_len = wowlan->patterns[i].pattern_len; 13194 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8), 13195 wowlan->patterns[i].mask) || 13196 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 13197 wowlan->patterns[i].pattern) || 13198 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 13199 wowlan->patterns[i].pkt_offset)) 13200 return -ENOBUFS; 13201 nla_nest_end(msg, nl_pat); 13202 } 13203 nla_nest_end(msg, nl_pats); 13204 13205 return 0; 13206 } 13207 13208 static int nl80211_send_wowlan_tcp(struct sk_buff *msg, 13209 struct cfg80211_wowlan_tcp *tcp) 13210 { 13211 struct nlattr *nl_tcp; 13212 13213 if (!tcp) 13214 return 0; 13215 13216 nl_tcp = nla_nest_start_noflag(msg, 13217 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 13218 if (!nl_tcp) 13219 return -ENOBUFS; 13220 13221 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) || 13222 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) || 13223 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) || 13224 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) || 13225 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) || 13226 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 13227 tcp->payload_len, tcp->payload) || 13228 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 13229 tcp->data_interval) || 13230 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 13231 tcp->wake_len, tcp->wake_data) || 13232 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK, 13233 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask)) 13234 return -ENOBUFS; 13235 13236 if (tcp->payload_seq.len && 13237 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ, 13238 sizeof(tcp->payload_seq), &tcp->payload_seq)) 13239 return -ENOBUFS; 13240 13241 if (tcp->payload_tok.len && 13242 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 13243 sizeof(tcp->payload_tok) + tcp->tokens_size, 13244 &tcp->payload_tok)) 13245 return -ENOBUFS; 13246 13247 nla_nest_end(msg, nl_tcp); 13248 13249 return 0; 13250 } 13251 13252 static int nl80211_send_wowlan_nd(struct sk_buff *msg, 13253 struct cfg80211_sched_scan_request *req) 13254 { 13255 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan; 13256 int i; 13257 13258 if (!req) 13259 return 0; 13260 13261 nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT); 13262 if (!nd) 13263 return -ENOBUFS; 13264 13265 if (req->n_scan_plans == 1 && 13266 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL, 13267 req->scan_plans[0].interval * 1000)) 13268 return -ENOBUFS; 13269 13270 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay)) 13271 return -ENOBUFS; 13272 13273 if (req->relative_rssi_set) { 13274 struct nl80211_bss_select_rssi_adjust rssi_adjust; 13275 13276 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI, 13277 req->relative_rssi)) 13278 return -ENOBUFS; 13279 13280 rssi_adjust.band = req->rssi_adjust.band; 13281 rssi_adjust.delta = req->rssi_adjust.delta; 13282 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST, 13283 sizeof(rssi_adjust), &rssi_adjust)) 13284 return -ENOBUFS; 13285 } 13286 13287 freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 13288 if (!freqs) 13289 return -ENOBUFS; 13290 13291 for (i = 0; i < req->n_channels; i++) { 13292 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 13293 return -ENOBUFS; 13294 } 13295 13296 nla_nest_end(msg, freqs); 13297 13298 if (req->n_match_sets) { 13299 matches = nla_nest_start_noflag(msg, 13300 NL80211_ATTR_SCHED_SCAN_MATCH); 13301 if (!matches) 13302 return -ENOBUFS; 13303 13304 for (i = 0; i < req->n_match_sets; i++) { 13305 match = nla_nest_start_noflag(msg, i); 13306 if (!match) 13307 return -ENOBUFS; 13308 13309 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID, 13310 req->match_sets[i].ssid.ssid_len, 13311 req->match_sets[i].ssid.ssid)) 13312 return -ENOBUFS; 13313 nla_nest_end(msg, match); 13314 } 13315 nla_nest_end(msg, matches); 13316 } 13317 13318 scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS); 13319 if (!scan_plans) 13320 return -ENOBUFS; 13321 13322 for (i = 0; i < req->n_scan_plans; i++) { 13323 scan_plan = nla_nest_start_noflag(msg, i + 1); 13324 if (!scan_plan) 13325 return -ENOBUFS; 13326 13327 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL, 13328 req->scan_plans[i].interval) || 13329 (req->scan_plans[i].iterations && 13330 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS, 13331 req->scan_plans[i].iterations))) 13332 return -ENOBUFS; 13333 nla_nest_end(msg, scan_plan); 13334 } 13335 nla_nest_end(msg, scan_plans); 13336 13337 nla_nest_end(msg, nd); 13338 13339 return 0; 13340 } 13341 13342 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info) 13343 { 13344 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13345 struct sk_buff *msg; 13346 void *hdr; 13347 u32 size = NLMSG_DEFAULT_SIZE; 13348 13349 if (!rdev->wiphy.wowlan) 13350 return -EOPNOTSUPP; 13351 13352 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) { 13353 /* adjust size to have room for all the data */ 13354 size += rdev->wiphy.wowlan_config->tcp->tokens_size + 13355 rdev->wiphy.wowlan_config->tcp->payload_len + 13356 rdev->wiphy.wowlan_config->tcp->wake_len + 13357 rdev->wiphy.wowlan_config->tcp->wake_len / 8; 13358 } 13359 13360 msg = nlmsg_new(size, GFP_KERNEL); 13361 if (!msg) 13362 return -ENOMEM; 13363 13364 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13365 NL80211_CMD_GET_WOWLAN); 13366 if (!hdr) 13367 goto nla_put_failure; 13368 13369 if (rdev->wiphy.wowlan_config) { 13370 struct nlattr *nl_wowlan; 13371 13372 nl_wowlan = nla_nest_start_noflag(msg, 13373 NL80211_ATTR_WOWLAN_TRIGGERS); 13374 if (!nl_wowlan) 13375 goto nla_put_failure; 13376 13377 if ((rdev->wiphy.wowlan_config->any && 13378 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 13379 (rdev->wiphy.wowlan_config->disconnect && 13380 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 13381 (rdev->wiphy.wowlan_config->magic_pkt && 13382 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 13383 (rdev->wiphy.wowlan_config->gtk_rekey_failure && 13384 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 13385 (rdev->wiphy.wowlan_config->eap_identity_req && 13386 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 13387 (rdev->wiphy.wowlan_config->four_way_handshake && 13388 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 13389 (rdev->wiphy.wowlan_config->rfkill_release && 13390 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 13391 goto nla_put_failure; 13392 13393 if (nl80211_send_wowlan_patterns(msg, rdev)) 13394 goto nla_put_failure; 13395 13396 if (nl80211_send_wowlan_tcp(msg, 13397 rdev->wiphy.wowlan_config->tcp)) 13398 goto nla_put_failure; 13399 13400 if (nl80211_send_wowlan_nd( 13401 msg, 13402 rdev->wiphy.wowlan_config->nd_config)) 13403 goto nla_put_failure; 13404 13405 nla_nest_end(msg, nl_wowlan); 13406 } 13407 13408 genlmsg_end(msg, hdr); 13409 return genlmsg_reply(msg, info); 13410 13411 nla_put_failure: 13412 nlmsg_free(msg); 13413 return -ENOBUFS; 13414 } 13415 13416 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev, 13417 struct nlattr *attr, 13418 struct cfg80211_wowlan *trig) 13419 { 13420 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP]; 13421 struct cfg80211_wowlan_tcp *cfg; 13422 struct nl80211_wowlan_tcp_data_token *tok = NULL; 13423 struct nl80211_wowlan_tcp_data_seq *seq = NULL; 13424 u32 size; 13425 u32 data_size, wake_size, tokens_size = 0, wake_mask_size; 13426 int err, port; 13427 13428 if (!rdev->wiphy.wowlan->tcp) 13429 return -EINVAL; 13430 13431 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr, 13432 nl80211_wowlan_tcp_policy, NULL); 13433 if (err) 13434 return err; 13435 13436 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] || 13437 !tb[NL80211_WOWLAN_TCP_DST_IPV4] || 13438 !tb[NL80211_WOWLAN_TCP_DST_MAC] || 13439 !tb[NL80211_WOWLAN_TCP_DST_PORT] || 13440 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] || 13441 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] || 13442 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] || 13443 !tb[NL80211_WOWLAN_TCP_WAKE_MASK]) 13444 return -EINVAL; 13445 13446 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]); 13447 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max) 13448 return -EINVAL; 13449 13450 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) > 13451 rdev->wiphy.wowlan->tcp->data_interval_max || 13452 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0) 13453 return -EINVAL; 13454 13455 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]); 13456 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max) 13457 return -EINVAL; 13458 13459 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]); 13460 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8)) 13461 return -EINVAL; 13462 13463 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) { 13464 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13465 13466 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13467 tokens_size = tokln - sizeof(*tok); 13468 13469 if (!tok->len || tokens_size % tok->len) 13470 return -EINVAL; 13471 if (!rdev->wiphy.wowlan->tcp->tok) 13472 return -EINVAL; 13473 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len) 13474 return -EINVAL; 13475 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len) 13476 return -EINVAL; 13477 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize) 13478 return -EINVAL; 13479 if (tok->offset + tok->len > data_size) 13480 return -EINVAL; 13481 } 13482 13483 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) { 13484 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]); 13485 if (!rdev->wiphy.wowlan->tcp->seq) 13486 return -EINVAL; 13487 if (seq->len == 0 || seq->len > 4) 13488 return -EINVAL; 13489 if (seq->len + seq->offset > data_size) 13490 return -EINVAL; 13491 } 13492 13493 size = sizeof(*cfg); 13494 size += data_size; 13495 size += wake_size + wake_mask_size; 13496 size += tokens_size; 13497 13498 cfg = kzalloc(size, GFP_KERNEL); 13499 if (!cfg) 13500 return -ENOMEM; 13501 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]); 13502 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]); 13503 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]), 13504 ETH_ALEN); 13505 if (tb[NL80211_WOWLAN_TCP_SRC_PORT]) 13506 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]); 13507 else 13508 port = 0; 13509 #ifdef CONFIG_INET 13510 /* allocate a socket and port for it and use it */ 13511 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM, 13512 IPPROTO_TCP, &cfg->sock, 1); 13513 if (err) { 13514 kfree(cfg); 13515 return err; 13516 } 13517 if (inet_csk_get_port(cfg->sock->sk, port)) { 13518 sock_release(cfg->sock); 13519 kfree(cfg); 13520 return -EADDRINUSE; 13521 } 13522 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num; 13523 #else 13524 if (!port) { 13525 kfree(cfg); 13526 return -EINVAL; 13527 } 13528 cfg->src_port = port; 13529 #endif 13530 13531 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]); 13532 cfg->payload_len = data_size; 13533 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size; 13534 memcpy((void *)cfg->payload, 13535 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]), 13536 data_size); 13537 if (seq) 13538 cfg->payload_seq = *seq; 13539 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]); 13540 cfg->wake_len = wake_size; 13541 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size; 13542 memcpy((void *)cfg->wake_data, 13543 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]), 13544 wake_size); 13545 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size + 13546 data_size + wake_size; 13547 memcpy((void *)cfg->wake_mask, 13548 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]), 13549 wake_mask_size); 13550 if (tok) { 13551 cfg->tokens_size = tokens_size; 13552 cfg->payload_tok = *tok; 13553 memcpy(cfg->payload_tok.token_stream, tok->token_stream, 13554 tokens_size); 13555 } 13556 13557 trig->tcp = cfg; 13558 13559 return 0; 13560 } 13561 13562 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev, 13563 const struct wiphy_wowlan_support *wowlan, 13564 struct nlattr *attr, 13565 struct cfg80211_wowlan *trig) 13566 { 13567 struct nlattr **tb; 13568 int err; 13569 13570 tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 13571 if (!tb) 13572 return -ENOMEM; 13573 13574 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) { 13575 err = -EOPNOTSUPP; 13576 goto out; 13577 } 13578 13579 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr, 13580 nl80211_policy, NULL); 13581 if (err) 13582 goto out; 13583 13584 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb, 13585 wowlan->max_nd_match_sets); 13586 err = PTR_ERR_OR_ZERO(trig->nd_config); 13587 if (err) 13588 trig->nd_config = NULL; 13589 13590 out: 13591 kfree(tb); 13592 return err; 13593 } 13594 13595 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info) 13596 { 13597 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13598 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG]; 13599 struct cfg80211_wowlan new_triggers = {}; 13600 struct cfg80211_wowlan *ntrig; 13601 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan; 13602 int err, i; 13603 bool prev_enabled = rdev->wiphy.wowlan_config; 13604 bool regular = false; 13605 13606 if (!wowlan) 13607 return -EOPNOTSUPP; 13608 13609 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) { 13610 cfg80211_rdev_free_wowlan(rdev); 13611 rdev->wiphy.wowlan_config = NULL; 13612 goto set_wakeup; 13613 } 13614 13615 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG, 13616 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS], 13617 nl80211_wowlan_policy, info->extack); 13618 if (err) 13619 return err; 13620 13621 if (tb[NL80211_WOWLAN_TRIG_ANY]) { 13622 if (!(wowlan->flags & WIPHY_WOWLAN_ANY)) 13623 return -EINVAL; 13624 new_triggers.any = true; 13625 } 13626 13627 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) { 13628 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT)) 13629 return -EINVAL; 13630 new_triggers.disconnect = true; 13631 regular = true; 13632 } 13633 13634 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) { 13635 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT)) 13636 return -EINVAL; 13637 new_triggers.magic_pkt = true; 13638 regular = true; 13639 } 13640 13641 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED]) 13642 return -EINVAL; 13643 13644 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) { 13645 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE)) 13646 return -EINVAL; 13647 new_triggers.gtk_rekey_failure = true; 13648 regular = true; 13649 } 13650 13651 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) { 13652 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ)) 13653 return -EINVAL; 13654 new_triggers.eap_identity_req = true; 13655 regular = true; 13656 } 13657 13658 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) { 13659 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE)) 13660 return -EINVAL; 13661 new_triggers.four_way_handshake = true; 13662 regular = true; 13663 } 13664 13665 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) { 13666 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE)) 13667 return -EINVAL; 13668 new_triggers.rfkill_release = true; 13669 regular = true; 13670 } 13671 13672 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) { 13673 struct nlattr *pat; 13674 int n_patterns = 0; 13675 int rem, pat_len, mask_len, pkt_offset; 13676 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 13677 13678 regular = true; 13679 13680 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13681 rem) 13682 n_patterns++; 13683 if (n_patterns > wowlan->n_patterns) 13684 return -EINVAL; 13685 13686 new_triggers.patterns = kcalloc(n_patterns, 13687 sizeof(new_triggers.patterns[0]), 13688 GFP_KERNEL); 13689 if (!new_triggers.patterns) 13690 return -ENOMEM; 13691 13692 new_triggers.n_patterns = n_patterns; 13693 i = 0; 13694 13695 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13696 rem) { 13697 u8 *mask_pat; 13698 13699 err = nla_parse_nested_deprecated(pat_tb, 13700 MAX_NL80211_PKTPAT, 13701 pat, 13702 nl80211_packet_pattern_policy, 13703 info->extack); 13704 if (err) 13705 goto error; 13706 13707 err = -EINVAL; 13708 if (!pat_tb[NL80211_PKTPAT_MASK] || 13709 !pat_tb[NL80211_PKTPAT_PATTERN]) 13710 goto error; 13711 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 13712 mask_len = DIV_ROUND_UP(pat_len, 8); 13713 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 13714 goto error; 13715 if (pat_len > wowlan->pattern_max_len || 13716 pat_len < wowlan->pattern_min_len) 13717 goto error; 13718 13719 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 13720 pkt_offset = 0; 13721 else 13722 pkt_offset = nla_get_u32( 13723 pat_tb[NL80211_PKTPAT_OFFSET]); 13724 if (pkt_offset > wowlan->max_pkt_offset) 13725 goto error; 13726 new_triggers.patterns[i].pkt_offset = pkt_offset; 13727 13728 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 13729 if (!mask_pat) { 13730 err = -ENOMEM; 13731 goto error; 13732 } 13733 new_triggers.patterns[i].mask = mask_pat; 13734 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 13735 mask_len); 13736 mask_pat += mask_len; 13737 new_triggers.patterns[i].pattern = mask_pat; 13738 new_triggers.patterns[i].pattern_len = pat_len; 13739 memcpy(mask_pat, 13740 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 13741 pat_len); 13742 i++; 13743 } 13744 } 13745 13746 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) { 13747 regular = true; 13748 err = nl80211_parse_wowlan_tcp( 13749 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION], 13750 &new_triggers); 13751 if (err) 13752 goto error; 13753 } 13754 13755 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) { 13756 regular = true; 13757 err = nl80211_parse_wowlan_nd( 13758 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT], 13759 &new_triggers); 13760 if (err) 13761 goto error; 13762 } 13763 13764 /* The 'any' trigger means the device continues operating more or less 13765 * as in its normal operation mode and wakes up the host on most of the 13766 * normal interrupts (like packet RX, ...) 13767 * It therefore makes little sense to combine with the more constrained 13768 * wakeup trigger modes. 13769 */ 13770 if (new_triggers.any && regular) { 13771 err = -EINVAL; 13772 goto error; 13773 } 13774 13775 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL); 13776 if (!ntrig) { 13777 err = -ENOMEM; 13778 goto error; 13779 } 13780 cfg80211_rdev_free_wowlan(rdev); 13781 rdev->wiphy.wowlan_config = ntrig; 13782 13783 set_wakeup: 13784 if (rdev->ops->set_wakeup && 13785 prev_enabled != !!rdev->wiphy.wowlan_config) 13786 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config); 13787 13788 return 0; 13789 error: 13790 for (i = 0; i < new_triggers.n_patterns; i++) 13791 kfree(new_triggers.patterns[i].mask); 13792 kfree(new_triggers.patterns); 13793 if (new_triggers.tcp && new_triggers.tcp->sock) 13794 sock_release(new_triggers.tcp->sock); 13795 kfree(new_triggers.tcp); 13796 kfree(new_triggers.nd_config); 13797 return err; 13798 } 13799 #endif 13800 13801 static int nl80211_send_coalesce_rules(struct sk_buff *msg, 13802 struct cfg80211_registered_device *rdev) 13803 { 13804 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules; 13805 int i, j, pat_len; 13806 struct cfg80211_coalesce_rules *rule; 13807 13808 if (!rdev->coalesce->n_rules) 13809 return 0; 13810 13811 nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE); 13812 if (!nl_rules) 13813 return -ENOBUFS; 13814 13815 for (i = 0; i < rdev->coalesce->n_rules; i++) { 13816 nl_rule = nla_nest_start_noflag(msg, i + 1); 13817 if (!nl_rule) 13818 return -ENOBUFS; 13819 13820 rule = &rdev->coalesce->rules[i]; 13821 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY, 13822 rule->delay)) 13823 return -ENOBUFS; 13824 13825 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION, 13826 rule->condition)) 13827 return -ENOBUFS; 13828 13829 nl_pats = nla_nest_start_noflag(msg, 13830 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN); 13831 if (!nl_pats) 13832 return -ENOBUFS; 13833 13834 for (j = 0; j < rule->n_patterns; j++) { 13835 nl_pat = nla_nest_start_noflag(msg, j + 1); 13836 if (!nl_pat) 13837 return -ENOBUFS; 13838 pat_len = rule->patterns[j].pattern_len; 13839 if (nla_put(msg, NL80211_PKTPAT_MASK, 13840 DIV_ROUND_UP(pat_len, 8), 13841 rule->patterns[j].mask) || 13842 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 13843 rule->patterns[j].pattern) || 13844 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 13845 rule->patterns[j].pkt_offset)) 13846 return -ENOBUFS; 13847 nla_nest_end(msg, nl_pat); 13848 } 13849 nla_nest_end(msg, nl_pats); 13850 nla_nest_end(msg, nl_rule); 13851 } 13852 nla_nest_end(msg, nl_rules); 13853 13854 return 0; 13855 } 13856 13857 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info) 13858 { 13859 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13860 struct sk_buff *msg; 13861 void *hdr; 13862 13863 if (!rdev->wiphy.coalesce) 13864 return -EOPNOTSUPP; 13865 13866 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13867 if (!msg) 13868 return -ENOMEM; 13869 13870 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13871 NL80211_CMD_GET_COALESCE); 13872 if (!hdr) 13873 goto nla_put_failure; 13874 13875 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev)) 13876 goto nla_put_failure; 13877 13878 genlmsg_end(msg, hdr); 13879 return genlmsg_reply(msg, info); 13880 13881 nla_put_failure: 13882 nlmsg_free(msg); 13883 return -ENOBUFS; 13884 } 13885 13886 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev) 13887 { 13888 struct cfg80211_coalesce *coalesce = rdev->coalesce; 13889 int i, j; 13890 struct cfg80211_coalesce_rules *rule; 13891 13892 if (!coalesce) 13893 return; 13894 13895 for (i = 0; i < coalesce->n_rules; i++) { 13896 rule = &coalesce->rules[i]; 13897 for (j = 0; j < rule->n_patterns; j++) 13898 kfree(rule->patterns[j].mask); 13899 kfree(rule->patterns); 13900 } 13901 kfree(coalesce->rules); 13902 kfree(coalesce); 13903 rdev->coalesce = NULL; 13904 } 13905 13906 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev, 13907 struct nlattr *rule, 13908 struct cfg80211_coalesce_rules *new_rule) 13909 { 13910 int err, i; 13911 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 13912 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat; 13913 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0; 13914 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 13915 13916 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX, 13917 rule, nl80211_coalesce_policy, NULL); 13918 if (err) 13919 return err; 13920 13921 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY]) 13922 new_rule->delay = 13923 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]); 13924 if (new_rule->delay > coalesce->max_delay) 13925 return -EINVAL; 13926 13927 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION]) 13928 new_rule->condition = 13929 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]); 13930 13931 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN]) 13932 return -EINVAL; 13933 13934 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 13935 rem) 13936 n_patterns++; 13937 if (n_patterns > coalesce->n_patterns) 13938 return -EINVAL; 13939 13940 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]), 13941 GFP_KERNEL); 13942 if (!new_rule->patterns) 13943 return -ENOMEM; 13944 13945 new_rule->n_patterns = n_patterns; 13946 i = 0; 13947 13948 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 13949 rem) { 13950 u8 *mask_pat; 13951 13952 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT, 13953 pat, 13954 nl80211_packet_pattern_policy, 13955 NULL); 13956 if (err) 13957 return err; 13958 13959 if (!pat_tb[NL80211_PKTPAT_MASK] || 13960 !pat_tb[NL80211_PKTPAT_PATTERN]) 13961 return -EINVAL; 13962 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 13963 mask_len = DIV_ROUND_UP(pat_len, 8); 13964 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 13965 return -EINVAL; 13966 if (pat_len > coalesce->pattern_max_len || 13967 pat_len < coalesce->pattern_min_len) 13968 return -EINVAL; 13969 13970 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 13971 pkt_offset = 0; 13972 else 13973 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]); 13974 if (pkt_offset > coalesce->max_pkt_offset) 13975 return -EINVAL; 13976 new_rule->patterns[i].pkt_offset = pkt_offset; 13977 13978 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 13979 if (!mask_pat) 13980 return -ENOMEM; 13981 13982 new_rule->patterns[i].mask = mask_pat; 13983 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 13984 mask_len); 13985 13986 mask_pat += mask_len; 13987 new_rule->patterns[i].pattern = mask_pat; 13988 new_rule->patterns[i].pattern_len = pat_len; 13989 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 13990 pat_len); 13991 i++; 13992 } 13993 13994 return 0; 13995 } 13996 13997 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info) 13998 { 13999 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14000 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 14001 struct cfg80211_coalesce new_coalesce = {}; 14002 struct cfg80211_coalesce *n_coalesce; 14003 int err, rem_rule, n_rules = 0, i, j; 14004 struct nlattr *rule; 14005 struct cfg80211_coalesce_rules *tmp_rule; 14006 14007 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce) 14008 return -EOPNOTSUPP; 14009 14010 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) { 14011 cfg80211_rdev_free_coalesce(rdev); 14012 rdev_set_coalesce(rdev, NULL); 14013 return 0; 14014 } 14015 14016 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 14017 rem_rule) 14018 n_rules++; 14019 if (n_rules > coalesce->n_rules) 14020 return -EINVAL; 14021 14022 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]), 14023 GFP_KERNEL); 14024 if (!new_coalesce.rules) 14025 return -ENOMEM; 14026 14027 new_coalesce.n_rules = n_rules; 14028 i = 0; 14029 14030 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 14031 rem_rule) { 14032 err = nl80211_parse_coalesce_rule(rdev, rule, 14033 &new_coalesce.rules[i]); 14034 if (err) 14035 goto error; 14036 14037 i++; 14038 } 14039 14040 err = rdev_set_coalesce(rdev, &new_coalesce); 14041 if (err) 14042 goto error; 14043 14044 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL); 14045 if (!n_coalesce) { 14046 err = -ENOMEM; 14047 goto error; 14048 } 14049 cfg80211_rdev_free_coalesce(rdev); 14050 rdev->coalesce = n_coalesce; 14051 14052 return 0; 14053 error: 14054 for (i = 0; i < new_coalesce.n_rules; i++) { 14055 tmp_rule = &new_coalesce.rules[i]; 14056 for (j = 0; j < tmp_rule->n_patterns; j++) 14057 kfree(tmp_rule->patterns[j].mask); 14058 kfree(tmp_rule->patterns); 14059 } 14060 kfree(new_coalesce.rules); 14061 14062 return err; 14063 } 14064 14065 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info) 14066 { 14067 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14068 struct net_device *dev = info->user_ptr[1]; 14069 struct wireless_dev *wdev = dev->ieee80211_ptr; 14070 struct nlattr *tb[NUM_NL80211_REKEY_DATA]; 14071 struct cfg80211_gtk_rekey_data rekey_data = {}; 14072 int err; 14073 14074 if (!info->attrs[NL80211_ATTR_REKEY_DATA]) 14075 return -EINVAL; 14076 14077 err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA, 14078 info->attrs[NL80211_ATTR_REKEY_DATA], 14079 nl80211_rekey_policy, info->extack); 14080 if (err) 14081 return err; 14082 14083 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] || 14084 !tb[NL80211_REKEY_DATA_KCK]) 14085 return -EINVAL; 14086 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN && 14087 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14088 nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN)) 14089 return -ERANGE; 14090 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN && 14091 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14092 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) && 14093 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 && 14094 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32)) 14095 return -ERANGE; 14096 14097 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]); 14098 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]); 14099 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]); 14100 rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]); 14101 rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]); 14102 if (tb[NL80211_REKEY_DATA_AKM]) 14103 rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]); 14104 14105 if (!wdev->connected) 14106 return -ENOTCONN; 14107 14108 if (!rdev->ops->set_rekey_data) 14109 return -EOPNOTSUPP; 14110 14111 return rdev_set_rekey_data(rdev, dev, &rekey_data); 14112 } 14113 14114 static int nl80211_register_unexpected_frame(struct sk_buff *skb, 14115 struct genl_info *info) 14116 { 14117 struct net_device *dev = info->user_ptr[1]; 14118 struct wireless_dev *wdev = dev->ieee80211_ptr; 14119 14120 if (wdev->iftype != NL80211_IFTYPE_AP && 14121 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14122 return -EINVAL; 14123 14124 if (wdev->ap_unexpected_nlportid) 14125 return -EBUSY; 14126 14127 wdev->ap_unexpected_nlportid = info->snd_portid; 14128 return 0; 14129 } 14130 14131 static int nl80211_probe_client(struct sk_buff *skb, 14132 struct genl_info *info) 14133 { 14134 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14135 struct net_device *dev = info->user_ptr[1]; 14136 struct wireless_dev *wdev = dev->ieee80211_ptr; 14137 struct sk_buff *msg; 14138 void *hdr; 14139 const u8 *addr; 14140 u64 cookie; 14141 int err; 14142 14143 if (wdev->iftype != NL80211_IFTYPE_AP && 14144 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14145 return -EOPNOTSUPP; 14146 14147 if (!info->attrs[NL80211_ATTR_MAC]) 14148 return -EINVAL; 14149 14150 if (!rdev->ops->probe_client) 14151 return -EOPNOTSUPP; 14152 14153 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14154 if (!msg) 14155 return -ENOMEM; 14156 14157 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14158 NL80211_CMD_PROBE_CLIENT); 14159 if (!hdr) { 14160 err = -ENOBUFS; 14161 goto free_msg; 14162 } 14163 14164 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 14165 14166 err = rdev_probe_client(rdev, dev, addr, &cookie); 14167 if (err) 14168 goto free_msg; 14169 14170 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14171 NL80211_ATTR_PAD)) 14172 goto nla_put_failure; 14173 14174 genlmsg_end(msg, hdr); 14175 14176 return genlmsg_reply(msg, info); 14177 14178 nla_put_failure: 14179 err = -ENOBUFS; 14180 free_msg: 14181 nlmsg_free(msg); 14182 return err; 14183 } 14184 14185 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info) 14186 { 14187 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14188 struct cfg80211_beacon_registration *reg, *nreg; 14189 int rv; 14190 14191 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS)) 14192 return -EOPNOTSUPP; 14193 14194 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL); 14195 if (!nreg) 14196 return -ENOMEM; 14197 14198 /* First, check if already registered. */ 14199 spin_lock_bh(&rdev->beacon_registrations_lock); 14200 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 14201 if (reg->nlportid == info->snd_portid) { 14202 rv = -EALREADY; 14203 goto out_err; 14204 } 14205 } 14206 /* Add it to the list */ 14207 nreg->nlportid = info->snd_portid; 14208 list_add(&nreg->list, &rdev->beacon_registrations); 14209 14210 spin_unlock_bh(&rdev->beacon_registrations_lock); 14211 14212 return 0; 14213 out_err: 14214 spin_unlock_bh(&rdev->beacon_registrations_lock); 14215 kfree(nreg); 14216 return rv; 14217 } 14218 14219 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info) 14220 { 14221 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14222 struct wireless_dev *wdev = info->user_ptr[1]; 14223 int err; 14224 14225 if (!rdev->ops->start_p2p_device) 14226 return -EOPNOTSUPP; 14227 14228 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14229 return -EOPNOTSUPP; 14230 14231 if (wdev_running(wdev)) 14232 return 0; 14233 14234 if (rfkill_blocked(rdev->wiphy.rfkill)) 14235 return -ERFKILL; 14236 14237 err = rdev_start_p2p_device(rdev, wdev); 14238 if (err) 14239 return err; 14240 14241 wdev->is_running = true; 14242 rdev->opencount++; 14243 14244 return 0; 14245 } 14246 14247 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info) 14248 { 14249 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14250 struct wireless_dev *wdev = info->user_ptr[1]; 14251 14252 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14253 return -EOPNOTSUPP; 14254 14255 if (!rdev->ops->stop_p2p_device) 14256 return -EOPNOTSUPP; 14257 14258 cfg80211_stop_p2p_device(rdev, wdev); 14259 14260 return 0; 14261 } 14262 14263 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info) 14264 { 14265 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14266 struct wireless_dev *wdev = info->user_ptr[1]; 14267 struct cfg80211_nan_conf conf = {}; 14268 int err; 14269 14270 if (wdev->iftype != NL80211_IFTYPE_NAN) 14271 return -EOPNOTSUPP; 14272 14273 if (wdev_running(wdev)) 14274 return -EEXIST; 14275 14276 if (rfkill_blocked(rdev->wiphy.rfkill)) 14277 return -ERFKILL; 14278 14279 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) 14280 return -EINVAL; 14281 14282 conf.master_pref = 14283 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14284 14285 if (info->attrs[NL80211_ATTR_BANDS]) { 14286 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14287 14288 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14289 return -EOPNOTSUPP; 14290 14291 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14292 return -EINVAL; 14293 14294 conf.bands = bands; 14295 } 14296 14297 err = rdev_start_nan(rdev, wdev, &conf); 14298 if (err) 14299 return err; 14300 14301 wdev->is_running = true; 14302 rdev->opencount++; 14303 14304 return 0; 14305 } 14306 14307 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info) 14308 { 14309 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14310 struct wireless_dev *wdev = info->user_ptr[1]; 14311 14312 if (wdev->iftype != NL80211_IFTYPE_NAN) 14313 return -EOPNOTSUPP; 14314 14315 cfg80211_stop_nan(rdev, wdev); 14316 14317 return 0; 14318 } 14319 14320 static int validate_nan_filter(struct nlattr *filter_attr) 14321 { 14322 struct nlattr *attr; 14323 int len = 0, n_entries = 0, rem; 14324 14325 nla_for_each_nested(attr, filter_attr, rem) { 14326 len += nla_len(attr); 14327 n_entries++; 14328 } 14329 14330 if (len >= U8_MAX) 14331 return -EINVAL; 14332 14333 return n_entries; 14334 } 14335 14336 static int handle_nan_filter(struct nlattr *attr_filter, 14337 struct cfg80211_nan_func *func, 14338 bool tx) 14339 { 14340 struct nlattr *attr; 14341 int n_entries, rem, i; 14342 struct cfg80211_nan_func_filter *filter; 14343 14344 n_entries = validate_nan_filter(attr_filter); 14345 if (n_entries < 0) 14346 return n_entries; 14347 14348 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters)); 14349 14350 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL); 14351 if (!filter) 14352 return -ENOMEM; 14353 14354 i = 0; 14355 nla_for_each_nested(attr, attr_filter, rem) { 14356 filter[i].filter = nla_memdup(attr, GFP_KERNEL); 14357 if (!filter[i].filter) 14358 goto err; 14359 14360 filter[i].len = nla_len(attr); 14361 i++; 14362 } 14363 if (tx) { 14364 func->num_tx_filters = n_entries; 14365 func->tx_filters = filter; 14366 } else { 14367 func->num_rx_filters = n_entries; 14368 func->rx_filters = filter; 14369 } 14370 14371 return 0; 14372 14373 err: 14374 i = 0; 14375 nla_for_each_nested(attr, attr_filter, rem) { 14376 kfree(filter[i].filter); 14377 i++; 14378 } 14379 kfree(filter); 14380 return -ENOMEM; 14381 } 14382 14383 static int nl80211_nan_add_func(struct sk_buff *skb, 14384 struct genl_info *info) 14385 { 14386 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14387 struct wireless_dev *wdev = info->user_ptr[1]; 14388 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr; 14389 struct cfg80211_nan_func *func; 14390 struct sk_buff *msg = NULL; 14391 void *hdr = NULL; 14392 int err = 0; 14393 14394 if (wdev->iftype != NL80211_IFTYPE_NAN) 14395 return -EOPNOTSUPP; 14396 14397 if (!wdev_running(wdev)) 14398 return -ENOTCONN; 14399 14400 if (!info->attrs[NL80211_ATTR_NAN_FUNC]) 14401 return -EINVAL; 14402 14403 err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX, 14404 info->attrs[NL80211_ATTR_NAN_FUNC], 14405 nl80211_nan_func_policy, 14406 info->extack); 14407 if (err) 14408 return err; 14409 14410 func = kzalloc(sizeof(*func), GFP_KERNEL); 14411 if (!func) 14412 return -ENOMEM; 14413 14414 func->cookie = cfg80211_assign_cookie(rdev); 14415 14416 if (!tb[NL80211_NAN_FUNC_TYPE]) { 14417 err = -EINVAL; 14418 goto out; 14419 } 14420 14421 14422 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]); 14423 14424 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) { 14425 err = -EINVAL; 14426 goto out; 14427 } 14428 14429 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]), 14430 sizeof(func->service_id)); 14431 14432 func->close_range = 14433 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]); 14434 14435 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) { 14436 func->serv_spec_info_len = 14437 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]); 14438 func->serv_spec_info = 14439 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]), 14440 func->serv_spec_info_len, 14441 GFP_KERNEL); 14442 if (!func->serv_spec_info) { 14443 err = -ENOMEM; 14444 goto out; 14445 } 14446 } 14447 14448 if (tb[NL80211_NAN_FUNC_TTL]) 14449 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]); 14450 14451 switch (func->type) { 14452 case NL80211_NAN_FUNC_PUBLISH: 14453 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) { 14454 err = -EINVAL; 14455 goto out; 14456 } 14457 14458 func->publish_type = 14459 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]); 14460 func->publish_bcast = 14461 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]); 14462 14463 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) && 14464 func->publish_bcast) { 14465 err = -EINVAL; 14466 goto out; 14467 } 14468 break; 14469 case NL80211_NAN_FUNC_SUBSCRIBE: 14470 func->subscribe_active = 14471 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]); 14472 break; 14473 case NL80211_NAN_FUNC_FOLLOW_UP: 14474 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] || 14475 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] || 14476 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) { 14477 err = -EINVAL; 14478 goto out; 14479 } 14480 14481 func->followup_id = 14482 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]); 14483 func->followup_reqid = 14484 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]); 14485 memcpy(func->followup_dest.addr, 14486 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]), 14487 sizeof(func->followup_dest.addr)); 14488 if (func->ttl) { 14489 err = -EINVAL; 14490 goto out; 14491 } 14492 break; 14493 default: 14494 err = -EINVAL; 14495 goto out; 14496 } 14497 14498 if (tb[NL80211_NAN_FUNC_SRF]) { 14499 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR]; 14500 14501 err = nla_parse_nested_deprecated(srf_tb, 14502 NL80211_NAN_SRF_ATTR_MAX, 14503 tb[NL80211_NAN_FUNC_SRF], 14504 nl80211_nan_srf_policy, 14505 info->extack); 14506 if (err) 14507 goto out; 14508 14509 func->srf_include = 14510 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]); 14511 14512 if (srf_tb[NL80211_NAN_SRF_BF]) { 14513 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] || 14514 !srf_tb[NL80211_NAN_SRF_BF_IDX]) { 14515 err = -EINVAL; 14516 goto out; 14517 } 14518 14519 func->srf_bf_len = 14520 nla_len(srf_tb[NL80211_NAN_SRF_BF]); 14521 func->srf_bf = 14522 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]), 14523 func->srf_bf_len, GFP_KERNEL); 14524 if (!func->srf_bf) { 14525 err = -ENOMEM; 14526 goto out; 14527 } 14528 14529 func->srf_bf_idx = 14530 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]); 14531 } else { 14532 struct nlattr *attr, *mac_attr = 14533 srf_tb[NL80211_NAN_SRF_MAC_ADDRS]; 14534 int n_entries, rem, i = 0; 14535 14536 if (!mac_attr) { 14537 err = -EINVAL; 14538 goto out; 14539 } 14540 14541 n_entries = validate_acl_mac_addrs(mac_attr); 14542 if (n_entries <= 0) { 14543 err = -EINVAL; 14544 goto out; 14545 } 14546 14547 func->srf_num_macs = n_entries; 14548 func->srf_macs = 14549 kcalloc(n_entries, sizeof(*func->srf_macs), 14550 GFP_KERNEL); 14551 if (!func->srf_macs) { 14552 err = -ENOMEM; 14553 goto out; 14554 } 14555 14556 nla_for_each_nested(attr, mac_attr, rem) 14557 memcpy(func->srf_macs[i++].addr, nla_data(attr), 14558 sizeof(*func->srf_macs)); 14559 } 14560 } 14561 14562 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) { 14563 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER], 14564 func, true); 14565 if (err) 14566 goto out; 14567 } 14568 14569 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) { 14570 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER], 14571 func, false); 14572 if (err) 14573 goto out; 14574 } 14575 14576 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14577 if (!msg) { 14578 err = -ENOMEM; 14579 goto out; 14580 } 14581 14582 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14583 NL80211_CMD_ADD_NAN_FUNCTION); 14584 /* This can't really happen - we just allocated 4KB */ 14585 if (WARN_ON(!hdr)) { 14586 err = -ENOMEM; 14587 goto out; 14588 } 14589 14590 err = rdev_add_nan_func(rdev, wdev, func); 14591 out: 14592 if (err < 0) { 14593 cfg80211_free_nan_func(func); 14594 nlmsg_free(msg); 14595 return err; 14596 } 14597 14598 /* propagate the instance id and cookie to userspace */ 14599 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie, 14600 NL80211_ATTR_PAD)) 14601 goto nla_put_failure; 14602 14603 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14604 if (!func_attr) 14605 goto nla_put_failure; 14606 14607 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, 14608 func->instance_id)) 14609 goto nla_put_failure; 14610 14611 nla_nest_end(msg, func_attr); 14612 14613 genlmsg_end(msg, hdr); 14614 return genlmsg_reply(msg, info); 14615 14616 nla_put_failure: 14617 nlmsg_free(msg); 14618 return -ENOBUFS; 14619 } 14620 14621 static int nl80211_nan_del_func(struct sk_buff *skb, 14622 struct genl_info *info) 14623 { 14624 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14625 struct wireless_dev *wdev = info->user_ptr[1]; 14626 u64 cookie; 14627 14628 if (wdev->iftype != NL80211_IFTYPE_NAN) 14629 return -EOPNOTSUPP; 14630 14631 if (!wdev_running(wdev)) 14632 return -ENOTCONN; 14633 14634 if (!info->attrs[NL80211_ATTR_COOKIE]) 14635 return -EINVAL; 14636 14637 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 14638 14639 rdev_del_nan_func(rdev, wdev, cookie); 14640 14641 return 0; 14642 } 14643 14644 static int nl80211_nan_change_config(struct sk_buff *skb, 14645 struct genl_info *info) 14646 { 14647 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14648 struct wireless_dev *wdev = info->user_ptr[1]; 14649 struct cfg80211_nan_conf conf = {}; 14650 u32 changed = 0; 14651 14652 if (wdev->iftype != NL80211_IFTYPE_NAN) 14653 return -EOPNOTSUPP; 14654 14655 if (!wdev_running(wdev)) 14656 return -ENOTCONN; 14657 14658 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) { 14659 conf.master_pref = 14660 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14661 if (conf.master_pref <= 1 || conf.master_pref == 255) 14662 return -EINVAL; 14663 14664 changed |= CFG80211_NAN_CONF_CHANGED_PREF; 14665 } 14666 14667 if (info->attrs[NL80211_ATTR_BANDS]) { 14668 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14669 14670 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14671 return -EOPNOTSUPP; 14672 14673 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14674 return -EINVAL; 14675 14676 conf.bands = bands; 14677 changed |= CFG80211_NAN_CONF_CHANGED_BANDS; 14678 } 14679 14680 if (!changed) 14681 return -EINVAL; 14682 14683 return rdev_nan_change_conf(rdev, wdev, &conf, changed); 14684 } 14685 14686 void cfg80211_nan_match(struct wireless_dev *wdev, 14687 struct cfg80211_nan_match_params *match, gfp_t gfp) 14688 { 14689 struct wiphy *wiphy = wdev->wiphy; 14690 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14691 struct nlattr *match_attr, *local_func_attr, *peer_func_attr; 14692 struct sk_buff *msg; 14693 void *hdr; 14694 14695 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr)) 14696 return; 14697 14698 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14699 if (!msg) 14700 return; 14701 14702 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH); 14703 if (!hdr) { 14704 nlmsg_free(msg); 14705 return; 14706 } 14707 14708 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14709 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14710 wdev->netdev->ifindex)) || 14711 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14712 NL80211_ATTR_PAD)) 14713 goto nla_put_failure; 14714 14715 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie, 14716 NL80211_ATTR_PAD) || 14717 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr)) 14718 goto nla_put_failure; 14719 14720 match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH); 14721 if (!match_attr) 14722 goto nla_put_failure; 14723 14724 local_func_attr = nla_nest_start_noflag(msg, 14725 NL80211_NAN_MATCH_FUNC_LOCAL); 14726 if (!local_func_attr) 14727 goto nla_put_failure; 14728 14729 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id)) 14730 goto nla_put_failure; 14731 14732 nla_nest_end(msg, local_func_attr); 14733 14734 peer_func_attr = nla_nest_start_noflag(msg, 14735 NL80211_NAN_MATCH_FUNC_PEER); 14736 if (!peer_func_attr) 14737 goto nla_put_failure; 14738 14739 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) || 14740 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id)) 14741 goto nla_put_failure; 14742 14743 if (match->info && match->info_len && 14744 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len, 14745 match->info)) 14746 goto nla_put_failure; 14747 14748 nla_nest_end(msg, peer_func_attr); 14749 nla_nest_end(msg, match_attr); 14750 genlmsg_end(msg, hdr); 14751 14752 if (!wdev->owner_nlportid) 14753 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14754 msg, 0, NL80211_MCGRP_NAN, gfp); 14755 else 14756 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14757 wdev->owner_nlportid); 14758 14759 return; 14760 14761 nla_put_failure: 14762 nlmsg_free(msg); 14763 } 14764 EXPORT_SYMBOL(cfg80211_nan_match); 14765 14766 void cfg80211_nan_func_terminated(struct wireless_dev *wdev, 14767 u8 inst_id, 14768 enum nl80211_nan_func_term_reason reason, 14769 u64 cookie, gfp_t gfp) 14770 { 14771 struct wiphy *wiphy = wdev->wiphy; 14772 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14773 struct sk_buff *msg; 14774 struct nlattr *func_attr; 14775 void *hdr; 14776 14777 if (WARN_ON(!inst_id)) 14778 return; 14779 14780 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14781 if (!msg) 14782 return; 14783 14784 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION); 14785 if (!hdr) { 14786 nlmsg_free(msg); 14787 return; 14788 } 14789 14790 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14791 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14792 wdev->netdev->ifindex)) || 14793 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14794 NL80211_ATTR_PAD)) 14795 goto nla_put_failure; 14796 14797 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14798 NL80211_ATTR_PAD)) 14799 goto nla_put_failure; 14800 14801 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14802 if (!func_attr) 14803 goto nla_put_failure; 14804 14805 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) || 14806 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason)) 14807 goto nla_put_failure; 14808 14809 nla_nest_end(msg, func_attr); 14810 genlmsg_end(msg, hdr); 14811 14812 if (!wdev->owner_nlportid) 14813 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14814 msg, 0, NL80211_MCGRP_NAN, gfp); 14815 else 14816 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14817 wdev->owner_nlportid); 14818 14819 return; 14820 14821 nla_put_failure: 14822 nlmsg_free(msg); 14823 } 14824 EXPORT_SYMBOL(cfg80211_nan_func_terminated); 14825 14826 static int nl80211_get_protocol_features(struct sk_buff *skb, 14827 struct genl_info *info) 14828 { 14829 void *hdr; 14830 struct sk_buff *msg; 14831 14832 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14833 if (!msg) 14834 return -ENOMEM; 14835 14836 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14837 NL80211_CMD_GET_PROTOCOL_FEATURES); 14838 if (!hdr) 14839 goto nla_put_failure; 14840 14841 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES, 14842 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP)) 14843 goto nla_put_failure; 14844 14845 genlmsg_end(msg, hdr); 14846 return genlmsg_reply(msg, info); 14847 14848 nla_put_failure: 14849 kfree_skb(msg); 14850 return -ENOBUFS; 14851 } 14852 14853 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info) 14854 { 14855 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14856 struct cfg80211_update_ft_ies_params ft_params; 14857 struct net_device *dev = info->user_ptr[1]; 14858 14859 if (!rdev->ops->update_ft_ies) 14860 return -EOPNOTSUPP; 14861 14862 if (!info->attrs[NL80211_ATTR_MDID] || 14863 !info->attrs[NL80211_ATTR_IE]) 14864 return -EINVAL; 14865 14866 memset(&ft_params, 0, sizeof(ft_params)); 14867 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]); 14868 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 14869 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 14870 14871 return rdev_update_ft_ies(rdev, dev, &ft_params); 14872 } 14873 14874 static int nl80211_crit_protocol_start(struct sk_buff *skb, 14875 struct genl_info *info) 14876 { 14877 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14878 struct wireless_dev *wdev = info->user_ptr[1]; 14879 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC; 14880 u16 duration; 14881 int ret; 14882 14883 if (!rdev->ops->crit_proto_start) 14884 return -EOPNOTSUPP; 14885 14886 if (WARN_ON(!rdev->ops->crit_proto_stop)) 14887 return -EINVAL; 14888 14889 if (rdev->crit_proto_nlportid) 14890 return -EBUSY; 14891 14892 /* determine protocol if provided */ 14893 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID]) 14894 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]); 14895 14896 if (proto >= NUM_NL80211_CRIT_PROTO) 14897 return -EINVAL; 14898 14899 /* timeout must be provided */ 14900 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]) 14901 return -EINVAL; 14902 14903 duration = 14904 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]); 14905 14906 ret = rdev_crit_proto_start(rdev, wdev, proto, duration); 14907 if (!ret) 14908 rdev->crit_proto_nlportid = info->snd_portid; 14909 14910 return ret; 14911 } 14912 14913 static int nl80211_crit_protocol_stop(struct sk_buff *skb, 14914 struct genl_info *info) 14915 { 14916 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14917 struct wireless_dev *wdev = info->user_ptr[1]; 14918 14919 if (!rdev->ops->crit_proto_stop) 14920 return -EOPNOTSUPP; 14921 14922 if (rdev->crit_proto_nlportid) { 14923 rdev->crit_proto_nlportid = 0; 14924 rdev_crit_proto_stop(rdev, wdev); 14925 } 14926 return 0; 14927 } 14928 14929 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd, 14930 struct nlattr *attr, 14931 struct netlink_ext_ack *extack) 14932 { 14933 if (vcmd->policy == VENDOR_CMD_RAW_DATA) { 14934 if (attr->nla_type & NLA_F_NESTED) { 14935 NL_SET_ERR_MSG_ATTR(extack, attr, 14936 "unexpected nested data"); 14937 return -EINVAL; 14938 } 14939 14940 return 0; 14941 } 14942 14943 if (!(attr->nla_type & NLA_F_NESTED)) { 14944 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data"); 14945 return -EINVAL; 14946 } 14947 14948 return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack); 14949 } 14950 14951 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info) 14952 { 14953 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14954 struct wireless_dev *wdev = 14955 __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 14956 info->attrs); 14957 int i, err; 14958 u32 vid, subcmd; 14959 14960 if (!rdev->wiphy.vendor_commands) 14961 return -EOPNOTSUPP; 14962 14963 if (IS_ERR(wdev)) { 14964 err = PTR_ERR(wdev); 14965 if (err != -EINVAL) 14966 return err; 14967 wdev = NULL; 14968 } else if (wdev->wiphy != &rdev->wiphy) { 14969 return -EINVAL; 14970 } 14971 14972 if (!info->attrs[NL80211_ATTR_VENDOR_ID] || 14973 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD]) 14974 return -EINVAL; 14975 14976 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]); 14977 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]); 14978 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 14979 const struct wiphy_vendor_command *vcmd; 14980 void *data = NULL; 14981 int len = 0; 14982 14983 vcmd = &rdev->wiphy.vendor_commands[i]; 14984 14985 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 14986 continue; 14987 14988 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 14989 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 14990 if (!wdev) 14991 return -EINVAL; 14992 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 14993 !wdev->netdev) 14994 return -EINVAL; 14995 14996 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 14997 if (!wdev_running(wdev)) 14998 return -ENETDOWN; 14999 } 15000 } else { 15001 wdev = NULL; 15002 } 15003 15004 if (!vcmd->doit) 15005 return -EOPNOTSUPP; 15006 15007 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) { 15008 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]); 15009 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]); 15010 15011 err = nl80211_vendor_check_policy(vcmd, 15012 info->attrs[NL80211_ATTR_VENDOR_DATA], 15013 info->extack); 15014 if (err) 15015 return err; 15016 } 15017 15018 rdev->cur_cmd_info = info; 15019 err = vcmd->doit(&rdev->wiphy, wdev, data, len); 15020 rdev->cur_cmd_info = NULL; 15021 return err; 15022 } 15023 15024 return -EOPNOTSUPP; 15025 } 15026 15027 static int nl80211_prepare_vendor_dump(struct sk_buff *skb, 15028 struct netlink_callback *cb, 15029 struct cfg80211_registered_device **rdev, 15030 struct wireless_dev **wdev) 15031 { 15032 struct nlattr **attrbuf; 15033 u32 vid, subcmd; 15034 unsigned int i; 15035 int vcmd_idx = -1; 15036 int err; 15037 void *data = NULL; 15038 unsigned int data_len = 0; 15039 15040 if (cb->args[0]) { 15041 /* subtract the 1 again here */ 15042 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 15043 struct wireless_dev *tmp; 15044 15045 if (!wiphy) 15046 return -ENODEV; 15047 *rdev = wiphy_to_rdev(wiphy); 15048 *wdev = NULL; 15049 15050 if (cb->args[1]) { 15051 list_for_each_entry(tmp, &wiphy->wdev_list, list) { 15052 if (tmp->identifier == cb->args[1] - 1) { 15053 *wdev = tmp; 15054 break; 15055 } 15056 } 15057 } 15058 15059 /* keep rtnl locked in successful case */ 15060 return 0; 15061 } 15062 15063 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 15064 if (!attrbuf) 15065 return -ENOMEM; 15066 15067 err = nlmsg_parse_deprecated(cb->nlh, 15068 GENL_HDRLEN + nl80211_fam.hdrsize, 15069 attrbuf, nl80211_fam.maxattr, 15070 nl80211_policy, NULL); 15071 if (err) 15072 goto out; 15073 15074 if (!attrbuf[NL80211_ATTR_VENDOR_ID] || 15075 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) { 15076 err = -EINVAL; 15077 goto out; 15078 } 15079 15080 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf); 15081 if (IS_ERR(*wdev)) 15082 *wdev = NULL; 15083 15084 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 15085 if (IS_ERR(*rdev)) { 15086 err = PTR_ERR(*rdev); 15087 goto out; 15088 } 15089 15090 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]); 15091 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]); 15092 15093 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) { 15094 const struct wiphy_vendor_command *vcmd; 15095 15096 vcmd = &(*rdev)->wiphy.vendor_commands[i]; 15097 15098 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 15099 continue; 15100 15101 if (!vcmd->dumpit) { 15102 err = -EOPNOTSUPP; 15103 goto out; 15104 } 15105 15106 vcmd_idx = i; 15107 break; 15108 } 15109 15110 if (vcmd_idx < 0) { 15111 err = -EOPNOTSUPP; 15112 goto out; 15113 } 15114 15115 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) { 15116 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15117 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15118 15119 err = nl80211_vendor_check_policy( 15120 &(*rdev)->wiphy.vendor_commands[vcmd_idx], 15121 attrbuf[NL80211_ATTR_VENDOR_DATA], 15122 cb->extack); 15123 if (err) 15124 goto out; 15125 } 15126 15127 /* 0 is the first index - add 1 to parse only once */ 15128 cb->args[0] = (*rdev)->wiphy_idx + 1; 15129 /* add 1 to know if it was NULL */ 15130 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0; 15131 cb->args[2] = vcmd_idx; 15132 cb->args[3] = (unsigned long)data; 15133 cb->args[4] = data_len; 15134 15135 /* keep rtnl locked in successful case */ 15136 err = 0; 15137 out: 15138 kfree(attrbuf); 15139 return err; 15140 } 15141 15142 static int nl80211_vendor_cmd_dump(struct sk_buff *skb, 15143 struct netlink_callback *cb) 15144 { 15145 struct cfg80211_registered_device *rdev; 15146 struct wireless_dev *wdev; 15147 unsigned int vcmd_idx; 15148 const struct wiphy_vendor_command *vcmd; 15149 void *data; 15150 int data_len; 15151 int err; 15152 struct nlattr *vendor_data; 15153 15154 rtnl_lock(); 15155 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev); 15156 if (err) 15157 goto out; 15158 15159 vcmd_idx = cb->args[2]; 15160 data = (void *)cb->args[3]; 15161 data_len = cb->args[4]; 15162 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx]; 15163 15164 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 15165 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 15166 if (!wdev) { 15167 err = -EINVAL; 15168 goto out; 15169 } 15170 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 15171 !wdev->netdev) { 15172 err = -EINVAL; 15173 goto out; 15174 } 15175 15176 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 15177 if (!wdev_running(wdev)) { 15178 err = -ENETDOWN; 15179 goto out; 15180 } 15181 } 15182 } 15183 15184 while (1) { 15185 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 15186 cb->nlh->nlmsg_seq, NLM_F_MULTI, 15187 NL80211_CMD_VENDOR); 15188 if (!hdr) 15189 break; 15190 15191 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15192 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 15193 wdev_id(wdev), 15194 NL80211_ATTR_PAD))) { 15195 genlmsg_cancel(skb, hdr); 15196 break; 15197 } 15198 15199 vendor_data = nla_nest_start_noflag(skb, 15200 NL80211_ATTR_VENDOR_DATA); 15201 if (!vendor_data) { 15202 genlmsg_cancel(skb, hdr); 15203 break; 15204 } 15205 15206 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len, 15207 (unsigned long *)&cb->args[5]); 15208 nla_nest_end(skb, vendor_data); 15209 15210 if (err == -ENOBUFS || err == -ENOENT) { 15211 genlmsg_cancel(skb, hdr); 15212 break; 15213 } else if (err <= 0) { 15214 genlmsg_cancel(skb, hdr); 15215 goto out; 15216 } 15217 15218 genlmsg_end(skb, hdr); 15219 } 15220 15221 err = skb->len; 15222 out: 15223 rtnl_unlock(); 15224 return err; 15225 } 15226 15227 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy, 15228 enum nl80211_commands cmd, 15229 enum nl80211_attrs attr, 15230 int approxlen) 15231 { 15232 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15233 15234 if (WARN_ON(!rdev->cur_cmd_info)) 15235 return NULL; 15236 15237 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen, 15238 rdev->cur_cmd_info->snd_portid, 15239 rdev->cur_cmd_info->snd_seq, 15240 cmd, attr, NULL, GFP_KERNEL); 15241 } 15242 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb); 15243 15244 int cfg80211_vendor_cmd_reply(struct sk_buff *skb) 15245 { 15246 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 15247 void *hdr = ((void **)skb->cb)[1]; 15248 struct nlattr *data = ((void **)skb->cb)[2]; 15249 15250 /* clear CB data for netlink core to own from now on */ 15251 memset(skb->cb, 0, sizeof(skb->cb)); 15252 15253 if (WARN_ON(!rdev->cur_cmd_info)) { 15254 kfree_skb(skb); 15255 return -EINVAL; 15256 } 15257 15258 nla_nest_end(skb, data); 15259 genlmsg_end(skb, hdr); 15260 return genlmsg_reply(skb, rdev->cur_cmd_info); 15261 } 15262 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply); 15263 15264 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy) 15265 { 15266 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15267 15268 if (WARN_ON(!rdev->cur_cmd_info)) 15269 return 0; 15270 15271 return rdev->cur_cmd_info->snd_portid; 15272 } 15273 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender); 15274 15275 static int nl80211_set_qos_map(struct sk_buff *skb, 15276 struct genl_info *info) 15277 { 15278 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15279 struct cfg80211_qos_map *qos_map = NULL; 15280 struct net_device *dev = info->user_ptr[1]; 15281 u8 *pos, len, num_des, des_len, des; 15282 int ret; 15283 15284 if (!rdev->ops->set_qos_map) 15285 return -EOPNOTSUPP; 15286 15287 if (info->attrs[NL80211_ATTR_QOS_MAP]) { 15288 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]); 15289 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]); 15290 15291 if (len % 2) 15292 return -EINVAL; 15293 15294 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL); 15295 if (!qos_map) 15296 return -ENOMEM; 15297 15298 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1; 15299 if (num_des) { 15300 des_len = num_des * 15301 sizeof(struct cfg80211_dscp_exception); 15302 memcpy(qos_map->dscp_exception, pos, des_len); 15303 qos_map->num_des = num_des; 15304 for (des = 0; des < num_des; des++) { 15305 if (qos_map->dscp_exception[des].up > 7) { 15306 kfree(qos_map); 15307 return -EINVAL; 15308 } 15309 } 15310 pos += des_len; 15311 } 15312 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN); 15313 } 15314 15315 ret = nl80211_key_allowed(dev->ieee80211_ptr); 15316 if (!ret) 15317 ret = rdev_set_qos_map(rdev, dev, qos_map); 15318 15319 kfree(qos_map); 15320 return ret; 15321 } 15322 15323 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info) 15324 { 15325 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15326 struct net_device *dev = info->user_ptr[1]; 15327 struct wireless_dev *wdev = dev->ieee80211_ptr; 15328 const u8 *peer; 15329 u8 tsid, up; 15330 u16 admitted_time = 0; 15331 15332 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)) 15333 return -EOPNOTSUPP; 15334 15335 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] || 15336 !info->attrs[NL80211_ATTR_USER_PRIO]) 15337 return -EINVAL; 15338 15339 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15340 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]); 15341 15342 /* WMM uses TIDs 0-7 even for TSPEC */ 15343 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) { 15344 /* TODO: handle 802.11 TSPEC/admission control 15345 * need more attributes for that (e.g. BA session requirement); 15346 * change the WMM adminssion test above to allow both then 15347 */ 15348 return -EINVAL; 15349 } 15350 15351 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15352 15353 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) { 15354 admitted_time = 15355 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]); 15356 if (!admitted_time) 15357 return -EINVAL; 15358 } 15359 15360 switch (wdev->iftype) { 15361 case NL80211_IFTYPE_STATION: 15362 case NL80211_IFTYPE_P2P_CLIENT: 15363 if (wdev->connected) 15364 break; 15365 return -ENOTCONN; 15366 default: 15367 return -EOPNOTSUPP; 15368 } 15369 15370 return rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time); 15371 } 15372 15373 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info) 15374 { 15375 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15376 struct net_device *dev = info->user_ptr[1]; 15377 const u8 *peer; 15378 u8 tsid; 15379 15380 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC]) 15381 return -EINVAL; 15382 15383 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15384 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15385 15386 return rdev_del_tx_ts(rdev, dev, tsid, peer); 15387 } 15388 15389 static int nl80211_tdls_channel_switch(struct sk_buff *skb, 15390 struct genl_info *info) 15391 { 15392 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15393 struct net_device *dev = info->user_ptr[1]; 15394 struct wireless_dev *wdev = dev->ieee80211_ptr; 15395 struct cfg80211_chan_def chandef = {}; 15396 const u8 *addr; 15397 u8 oper_class; 15398 int err; 15399 15400 if (!rdev->ops->tdls_channel_switch || 15401 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15402 return -EOPNOTSUPP; 15403 15404 switch (dev->ieee80211_ptr->iftype) { 15405 case NL80211_IFTYPE_STATION: 15406 case NL80211_IFTYPE_P2P_CLIENT: 15407 break; 15408 default: 15409 return -EOPNOTSUPP; 15410 } 15411 15412 if (!info->attrs[NL80211_ATTR_MAC] || 15413 !info->attrs[NL80211_ATTR_OPER_CLASS]) 15414 return -EINVAL; 15415 15416 err = nl80211_parse_chandef(rdev, info, &chandef); 15417 if (err) 15418 return err; 15419 15420 /* 15421 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012 15422 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the 15423 * specification is not defined for them. 15424 */ 15425 if (chandef.chan->band == NL80211_BAND_2GHZ && 15426 chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 15427 chandef.width != NL80211_CHAN_WIDTH_20) 15428 return -EINVAL; 15429 15430 /* we will be active on the TDLS link */ 15431 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 15432 wdev->iftype)) 15433 return -EINVAL; 15434 15435 /* don't allow switching to DFS channels */ 15436 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype)) 15437 return -EINVAL; 15438 15439 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15440 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]); 15441 15442 return rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef); 15443 } 15444 15445 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb, 15446 struct genl_info *info) 15447 { 15448 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15449 struct net_device *dev = info->user_ptr[1]; 15450 const u8 *addr; 15451 15452 if (!rdev->ops->tdls_channel_switch || 15453 !rdev->ops->tdls_cancel_channel_switch || 15454 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15455 return -EOPNOTSUPP; 15456 15457 switch (dev->ieee80211_ptr->iftype) { 15458 case NL80211_IFTYPE_STATION: 15459 case NL80211_IFTYPE_P2P_CLIENT: 15460 break; 15461 default: 15462 return -EOPNOTSUPP; 15463 } 15464 15465 if (!info->attrs[NL80211_ATTR_MAC]) 15466 return -EINVAL; 15467 15468 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15469 15470 rdev_tdls_cancel_channel_switch(rdev, dev, addr); 15471 15472 return 0; 15473 } 15474 15475 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb, 15476 struct genl_info *info) 15477 { 15478 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15479 struct net_device *dev = info->user_ptr[1]; 15480 struct wireless_dev *wdev = dev->ieee80211_ptr; 15481 const struct nlattr *nla; 15482 bool enabled; 15483 15484 if (!rdev->ops->set_multicast_to_unicast) 15485 return -EOPNOTSUPP; 15486 15487 if (wdev->iftype != NL80211_IFTYPE_AP && 15488 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15489 return -EOPNOTSUPP; 15490 15491 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED]; 15492 enabled = nla_get_flag(nla); 15493 15494 return rdev_set_multicast_to_unicast(rdev, dev, enabled); 15495 } 15496 15497 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info) 15498 { 15499 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15500 struct net_device *dev = info->user_ptr[1]; 15501 struct wireless_dev *wdev = dev->ieee80211_ptr; 15502 struct cfg80211_pmk_conf pmk_conf = {}; 15503 15504 if (wdev->iftype != NL80211_IFTYPE_STATION && 15505 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15506 return -EOPNOTSUPP; 15507 15508 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15509 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15510 return -EOPNOTSUPP; 15511 15512 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK]) 15513 return -EINVAL; 15514 15515 if (!wdev->connected) 15516 return -ENOTCONN; 15517 15518 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15519 if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN)) 15520 return -EINVAL; 15521 15522 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 15523 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 15524 if (pmk_conf.pmk_len != WLAN_PMK_LEN && 15525 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) 15526 return -EINVAL; 15527 15528 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) 15529 pmk_conf.pmk_r0_name = 15530 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]); 15531 15532 return rdev_set_pmk(rdev, dev, &pmk_conf); 15533 } 15534 15535 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info) 15536 { 15537 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15538 struct net_device *dev = info->user_ptr[1]; 15539 struct wireless_dev *wdev = dev->ieee80211_ptr; 15540 const u8 *aa; 15541 15542 if (wdev->iftype != NL80211_IFTYPE_STATION && 15543 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15544 return -EOPNOTSUPP; 15545 15546 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15547 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15548 return -EOPNOTSUPP; 15549 15550 if (!info->attrs[NL80211_ATTR_MAC]) 15551 return -EINVAL; 15552 15553 aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15554 return rdev_del_pmk(rdev, dev, aa); 15555 } 15556 15557 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info) 15558 { 15559 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15560 struct net_device *dev = info->user_ptr[1]; 15561 struct cfg80211_external_auth_params params; 15562 15563 if (!rdev->ops->external_auth) 15564 return -EOPNOTSUPP; 15565 15566 if (!info->attrs[NL80211_ATTR_SSID] && 15567 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 15568 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 15569 return -EINVAL; 15570 15571 if (!info->attrs[NL80211_ATTR_BSSID]) 15572 return -EINVAL; 15573 15574 if (!info->attrs[NL80211_ATTR_STATUS_CODE]) 15575 return -EINVAL; 15576 15577 memset(¶ms, 0, sizeof(params)); 15578 15579 if (info->attrs[NL80211_ATTR_SSID]) { 15580 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 15581 if (params.ssid.ssid_len == 0) 15582 return -EINVAL; 15583 memcpy(params.ssid.ssid, 15584 nla_data(info->attrs[NL80211_ATTR_SSID]), 15585 params.ssid.ssid_len); 15586 } 15587 15588 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]), 15589 ETH_ALEN); 15590 15591 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15592 15593 if (info->attrs[NL80211_ATTR_PMKID]) 15594 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 15595 15596 return rdev_external_auth(rdev, dev, ¶ms); 15597 } 15598 15599 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info) 15600 { 15601 bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK]; 15602 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15603 struct net_device *dev = info->user_ptr[1]; 15604 struct wireless_dev *wdev = dev->ieee80211_ptr; 15605 const u8 *buf; 15606 size_t len; 15607 u8 *dest; 15608 u16 proto; 15609 bool noencrypt; 15610 u64 cookie = 0; 15611 int link_id; 15612 int err; 15613 15614 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15615 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 15616 return -EOPNOTSUPP; 15617 15618 if (!rdev->ops->tx_control_port) 15619 return -EOPNOTSUPP; 15620 15621 if (!info->attrs[NL80211_ATTR_FRAME] || 15622 !info->attrs[NL80211_ATTR_MAC] || 15623 !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 15624 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing"); 15625 return -EINVAL; 15626 } 15627 15628 switch (wdev->iftype) { 15629 case NL80211_IFTYPE_AP: 15630 case NL80211_IFTYPE_P2P_GO: 15631 case NL80211_IFTYPE_MESH_POINT: 15632 break; 15633 case NL80211_IFTYPE_ADHOC: 15634 if (wdev->u.ibss.current_bss) 15635 break; 15636 return -ENOTCONN; 15637 case NL80211_IFTYPE_STATION: 15638 case NL80211_IFTYPE_P2P_CLIENT: 15639 if (wdev->connected) 15640 break; 15641 return -ENOTCONN; 15642 default: 15643 return -EOPNOTSUPP; 15644 } 15645 15646 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15647 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15648 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15649 proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 15650 noencrypt = 15651 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]); 15652 15653 link_id = nl80211_link_id_or_invalid(info->attrs); 15654 15655 err = rdev_tx_control_port(rdev, dev, buf, len, 15656 dest, cpu_to_be16(proto), noencrypt, link_id, 15657 dont_wait_for_ack ? NULL : &cookie); 15658 if (!err && !dont_wait_for_ack) 15659 nl_set_extack_cookie_u64(info->extack, cookie); 15660 return err; 15661 } 15662 15663 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb, 15664 struct genl_info *info) 15665 { 15666 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15667 struct net_device *dev = info->user_ptr[1]; 15668 struct wireless_dev *wdev = dev->ieee80211_ptr; 15669 struct cfg80211_ftm_responder_stats ftm_stats = {}; 15670 unsigned int link_id = nl80211_link_id(info->attrs); 15671 struct sk_buff *msg; 15672 void *hdr; 15673 struct nlattr *ftm_stats_attr; 15674 int err; 15675 15676 if (wdev->iftype != NL80211_IFTYPE_AP || 15677 !wdev->links[link_id].ap.beacon_interval) 15678 return -EOPNOTSUPP; 15679 15680 err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats); 15681 if (err) 15682 return err; 15683 15684 if (!ftm_stats.filled) 15685 return -ENODATA; 15686 15687 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15688 if (!msg) 15689 return -ENOMEM; 15690 15691 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15692 NL80211_CMD_GET_FTM_RESPONDER_STATS); 15693 if (!hdr) 15694 goto nla_put_failure; 15695 15696 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 15697 goto nla_put_failure; 15698 15699 ftm_stats_attr = nla_nest_start_noflag(msg, 15700 NL80211_ATTR_FTM_RESPONDER_STATS); 15701 if (!ftm_stats_attr) 15702 goto nla_put_failure; 15703 15704 #define SET_FTM(field, name, type) \ 15705 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15706 nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \ 15707 ftm_stats.field)) \ 15708 goto nla_put_failure; } while (0) 15709 #define SET_FTM_U64(field, name) \ 15710 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15711 nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \ 15712 ftm_stats.field, NL80211_FTM_STATS_PAD)) \ 15713 goto nla_put_failure; } while (0) 15714 15715 SET_FTM(success_num, SUCCESS_NUM, u32); 15716 SET_FTM(partial_num, PARTIAL_NUM, u32); 15717 SET_FTM(failed_num, FAILED_NUM, u32); 15718 SET_FTM(asap_num, ASAP_NUM, u32); 15719 SET_FTM(non_asap_num, NON_ASAP_NUM, u32); 15720 SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC); 15721 SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32); 15722 SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32); 15723 SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32); 15724 #undef SET_FTM 15725 15726 nla_nest_end(msg, ftm_stats_attr); 15727 15728 genlmsg_end(msg, hdr); 15729 return genlmsg_reply(msg, info); 15730 15731 nla_put_failure: 15732 nlmsg_free(msg); 15733 return -ENOBUFS; 15734 } 15735 15736 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info) 15737 { 15738 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15739 struct cfg80211_update_owe_info owe_info; 15740 struct net_device *dev = info->user_ptr[1]; 15741 15742 if (!rdev->ops->update_owe_info) 15743 return -EOPNOTSUPP; 15744 15745 if (!info->attrs[NL80211_ATTR_STATUS_CODE] || 15746 !info->attrs[NL80211_ATTR_MAC]) 15747 return -EINVAL; 15748 15749 memset(&owe_info, 0, sizeof(owe_info)); 15750 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15751 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN); 15752 15753 if (info->attrs[NL80211_ATTR_IE]) { 15754 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 15755 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 15756 } 15757 15758 return rdev_update_owe_info(rdev, dev, &owe_info); 15759 } 15760 15761 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info) 15762 { 15763 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15764 struct net_device *dev = info->user_ptr[1]; 15765 struct wireless_dev *wdev = dev->ieee80211_ptr; 15766 struct station_info sinfo = {}; 15767 const u8 *buf; 15768 size_t len; 15769 u8 *dest; 15770 int err; 15771 15772 if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station) 15773 return -EOPNOTSUPP; 15774 15775 if (!info->attrs[NL80211_ATTR_MAC] || 15776 !info->attrs[NL80211_ATTR_FRAME]) { 15777 GENL_SET_ERR_MSG(info, "Frame or MAC missing"); 15778 return -EINVAL; 15779 } 15780 15781 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 15782 return -EOPNOTSUPP; 15783 15784 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15785 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15786 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15787 15788 if (len < sizeof(struct ethhdr)) 15789 return -EINVAL; 15790 15791 if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) || 15792 !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr)) 15793 return -EINVAL; 15794 15795 err = rdev_get_station(rdev, dev, dest, &sinfo); 15796 if (err) 15797 return err; 15798 15799 cfg80211_sinfo_release_content(&sinfo); 15800 15801 return rdev_probe_mesh_link(rdev, dev, dest, buf, len); 15802 } 15803 15804 static int parse_tid_conf(struct cfg80211_registered_device *rdev, 15805 struct nlattr *attrs[], struct net_device *dev, 15806 struct cfg80211_tid_cfg *tid_conf, 15807 struct genl_info *info, const u8 *peer, 15808 unsigned int link_id) 15809 { 15810 struct netlink_ext_ack *extack = info->extack; 15811 u64 mask; 15812 int err; 15813 15814 if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS]) 15815 return -EINVAL; 15816 15817 tid_conf->config_override = 15818 nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]); 15819 tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]); 15820 15821 if (tid_conf->config_override) { 15822 if (rdev->ops->reset_tid_config) { 15823 err = rdev_reset_tid_config(rdev, dev, peer, 15824 tid_conf->tids); 15825 if (err) 15826 return err; 15827 } else { 15828 return -EINVAL; 15829 } 15830 } 15831 15832 if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) { 15833 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK); 15834 tid_conf->noack = 15835 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]); 15836 } 15837 15838 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) { 15839 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT); 15840 tid_conf->retry_short = 15841 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]); 15842 15843 if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count) 15844 return -EINVAL; 15845 } 15846 15847 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) { 15848 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG); 15849 tid_conf->retry_long = 15850 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]); 15851 15852 if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count) 15853 return -EINVAL; 15854 } 15855 15856 if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) { 15857 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL); 15858 tid_conf->ampdu = 15859 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]); 15860 } 15861 15862 if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) { 15863 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL); 15864 tid_conf->rtscts = 15865 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]); 15866 } 15867 15868 if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) { 15869 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL); 15870 tid_conf->amsdu = 15871 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]); 15872 } 15873 15874 if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) { 15875 u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr; 15876 15877 tid_conf->txrate_type = nla_get_u8(attrs[idx]); 15878 15879 if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) { 15880 attr = NL80211_TID_CONFIG_ATTR_TX_RATE; 15881 err = nl80211_parse_tx_bitrate_mask(info, attrs, attr, 15882 &tid_conf->txrate_mask, dev, 15883 true, link_id); 15884 if (err) 15885 return err; 15886 15887 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE); 15888 } 15889 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE); 15890 } 15891 15892 if (peer) 15893 mask = rdev->wiphy.tid_config_support.peer; 15894 else 15895 mask = rdev->wiphy.tid_config_support.vif; 15896 15897 if (tid_conf->mask & ~mask) { 15898 NL_SET_ERR_MSG(extack, "unsupported TID configuration"); 15899 return -EOPNOTSUPP; 15900 } 15901 15902 return 0; 15903 } 15904 15905 static int nl80211_set_tid_config(struct sk_buff *skb, 15906 struct genl_info *info) 15907 { 15908 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15909 struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1]; 15910 unsigned int link_id = nl80211_link_id(info->attrs); 15911 struct net_device *dev = info->user_ptr[1]; 15912 struct cfg80211_tid_config *tid_config; 15913 struct nlattr *tid; 15914 int conf_idx = 0, rem_conf; 15915 int ret = -EINVAL; 15916 u32 num_conf = 0; 15917 15918 if (!info->attrs[NL80211_ATTR_TID_CONFIG]) 15919 return -EINVAL; 15920 15921 if (!rdev->ops->set_tid_config) 15922 return -EOPNOTSUPP; 15923 15924 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 15925 rem_conf) 15926 num_conf++; 15927 15928 tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf), 15929 GFP_KERNEL); 15930 if (!tid_config) 15931 return -ENOMEM; 15932 15933 tid_config->n_tid_conf = num_conf; 15934 15935 if (info->attrs[NL80211_ATTR_MAC]) 15936 tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15937 15938 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 15939 rem_conf) { 15940 ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX, 15941 tid, NULL, NULL); 15942 15943 if (ret) 15944 goto bad_tid_conf; 15945 15946 ret = parse_tid_conf(rdev, attrs, dev, 15947 &tid_config->tid_conf[conf_idx], 15948 info, tid_config->peer, link_id); 15949 if (ret) 15950 goto bad_tid_conf; 15951 15952 conf_idx++; 15953 } 15954 15955 ret = rdev_set_tid_config(rdev, dev, tid_config); 15956 15957 bad_tid_conf: 15958 kfree(tid_config); 15959 return ret; 15960 } 15961 15962 static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info) 15963 { 15964 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15965 struct cfg80211_color_change_settings params = {}; 15966 struct net_device *dev = info->user_ptr[1]; 15967 struct wireless_dev *wdev = dev->ieee80211_ptr; 15968 struct nlattr **tb; 15969 u16 offset; 15970 int err; 15971 15972 if (!rdev->ops->color_change) 15973 return -EOPNOTSUPP; 15974 15975 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15976 NL80211_EXT_FEATURE_BSS_COLOR)) 15977 return -EOPNOTSUPP; 15978 15979 if (wdev->iftype != NL80211_IFTYPE_AP) 15980 return -EOPNOTSUPP; 15981 15982 if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] || 15983 !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] || 15984 !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS]) 15985 return -EINVAL; 15986 15987 params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]); 15988 params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]); 15989 15990 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_next, 15991 info->extack); 15992 if (err) 15993 return err; 15994 15995 tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL); 15996 if (!tb) 15997 return -ENOMEM; 15998 15999 err = nla_parse_nested(tb, NL80211_ATTR_MAX, 16000 info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS], 16001 nl80211_policy, info->extack); 16002 if (err) 16003 goto out; 16004 16005 err = nl80211_parse_beacon(rdev, tb, ¶ms.beacon_color_change, 16006 info->extack); 16007 if (err) 16008 goto out; 16009 16010 if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 16011 err = -EINVAL; 16012 goto out; 16013 } 16014 16015 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) { 16016 err = -EINVAL; 16017 goto out; 16018 } 16019 16020 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 16021 if (offset >= params.beacon_color_change.tail_len) { 16022 err = -EINVAL; 16023 goto out; 16024 } 16025 16026 if (params.beacon_color_change.tail[offset] != params.count) { 16027 err = -EINVAL; 16028 goto out; 16029 } 16030 16031 params.counter_offset_beacon = offset; 16032 16033 if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 16034 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) != 16035 sizeof(u16)) { 16036 err = -EINVAL; 16037 goto out; 16038 } 16039 16040 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 16041 if (offset >= params.beacon_color_change.probe_resp_len) { 16042 err = -EINVAL; 16043 goto out; 16044 } 16045 16046 if (params.beacon_color_change.probe_resp[offset] != 16047 params.count) { 16048 err = -EINVAL; 16049 goto out; 16050 } 16051 16052 params.counter_offset_presp = offset; 16053 } 16054 16055 err = rdev_color_change(rdev, dev, ¶ms); 16056 16057 out: 16058 kfree(params.beacon_next.mbssid_ies); 16059 kfree(params.beacon_color_change.mbssid_ies); 16060 kfree(params.beacon_next.rnr_ies); 16061 kfree(params.beacon_color_change.rnr_ies); 16062 kfree(tb); 16063 return err; 16064 } 16065 16066 static int nl80211_set_fils_aad(struct sk_buff *skb, 16067 struct genl_info *info) 16068 { 16069 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16070 struct net_device *dev = info->user_ptr[1]; 16071 struct cfg80211_fils_aad fils_aad = {}; 16072 u8 *nonces; 16073 16074 if (!info->attrs[NL80211_ATTR_MAC] || 16075 !info->attrs[NL80211_ATTR_FILS_KEK] || 16076 !info->attrs[NL80211_ATTR_FILS_NONCES]) 16077 return -EINVAL; 16078 16079 fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16080 fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 16081 fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 16082 nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 16083 fils_aad.snonce = nonces; 16084 fils_aad.anonce = nonces + FILS_NONCE_LEN; 16085 16086 return rdev_set_fils_aad(rdev, dev, &fils_aad); 16087 } 16088 16089 static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info) 16090 { 16091 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16092 unsigned int link_id = nl80211_link_id(info->attrs); 16093 struct net_device *dev = info->user_ptr[1]; 16094 struct wireless_dev *wdev = dev->ieee80211_ptr; 16095 int ret; 16096 16097 if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO)) 16098 return -EINVAL; 16099 16100 switch (wdev->iftype) { 16101 case NL80211_IFTYPE_AP: 16102 break; 16103 default: 16104 return -EINVAL; 16105 } 16106 16107 if (!info->attrs[NL80211_ATTR_MAC] || 16108 !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC]))) 16109 return -EINVAL; 16110 16111 wdev->valid_links |= BIT(link_id); 16112 ether_addr_copy(wdev->links[link_id].addr, 16113 nla_data(info->attrs[NL80211_ATTR_MAC])); 16114 16115 ret = rdev_add_intf_link(rdev, wdev, link_id); 16116 if (ret) { 16117 wdev->valid_links &= ~BIT(link_id); 16118 eth_zero_addr(wdev->links[link_id].addr); 16119 } 16120 16121 return ret; 16122 } 16123 16124 static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info) 16125 { 16126 unsigned int link_id = nl80211_link_id(info->attrs); 16127 struct net_device *dev = info->user_ptr[1]; 16128 struct wireless_dev *wdev = dev->ieee80211_ptr; 16129 16130 /* cannot remove if there's no link */ 16131 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16132 return -EINVAL; 16133 16134 switch (wdev->iftype) { 16135 case NL80211_IFTYPE_AP: 16136 break; 16137 default: 16138 return -EINVAL; 16139 } 16140 16141 cfg80211_remove_link(wdev, link_id); 16142 16143 return 0; 16144 } 16145 16146 static int 16147 nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info, 16148 bool add) 16149 { 16150 struct link_station_parameters params = {}; 16151 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16152 struct net_device *dev = info->user_ptr[1]; 16153 int err; 16154 16155 if ((add && !rdev->ops->add_link_station) || 16156 (!add && !rdev->ops->mod_link_station)) 16157 return -EOPNOTSUPP; 16158 16159 if (add && !info->attrs[NL80211_ATTR_MAC]) 16160 return -EINVAL; 16161 16162 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 16163 return -EINVAL; 16164 16165 if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 16166 return -EINVAL; 16167 16168 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16169 16170 if (info->attrs[NL80211_ATTR_MAC]) { 16171 params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 16172 if (!is_valid_ether_addr(params.link_mac)) 16173 return -EINVAL; 16174 } 16175 16176 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16177 return -EINVAL; 16178 16179 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16180 16181 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 16182 params.supported_rates = 16183 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16184 params.supported_rates_len = 16185 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16186 } 16187 16188 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 16189 params.ht_capa = 16190 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 16191 16192 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 16193 params.vht_capa = 16194 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 16195 16196 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 16197 params.he_capa = 16198 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16199 params.he_capa_len = 16200 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16201 16202 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 16203 params.eht_capa = 16204 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16205 params.eht_capa_len = 16206 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16207 16208 if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa, 16209 (const u8 *)params.eht_capa, 16210 params.eht_capa_len, 16211 false)) 16212 return -EINVAL; 16213 } 16214 } 16215 16216 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 16217 params.he_6ghz_capa = 16218 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 16219 16220 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 16221 params.opmode_notif_used = true; 16222 params.opmode_notif = 16223 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 16224 } 16225 16226 err = nl80211_parse_sta_txpower_setting(info, ¶ms.txpwr, 16227 ¶ms.txpwr_set); 16228 if (err) 16229 return err; 16230 16231 if (add) 16232 return rdev_add_link_station(rdev, dev, ¶ms); 16233 16234 return rdev_mod_link_station(rdev, dev, ¶ms); 16235 } 16236 16237 static int 16238 nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info) 16239 { 16240 return nl80211_add_mod_link_station(skb, info, true); 16241 } 16242 16243 static int 16244 nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info) 16245 { 16246 return nl80211_add_mod_link_station(skb, info, false); 16247 } 16248 16249 static int 16250 nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info) 16251 { 16252 struct link_station_del_parameters params = {}; 16253 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16254 struct net_device *dev = info->user_ptr[1]; 16255 16256 if (!rdev->ops->del_link_station) 16257 return -EOPNOTSUPP; 16258 16259 if (!info->attrs[NL80211_ATTR_MLD_ADDR] || 16260 !info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16261 return -EINVAL; 16262 16263 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16264 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16265 16266 return rdev_del_link_station(rdev, dev, ¶ms); 16267 } 16268 16269 static int nl80211_set_hw_timestamp(struct sk_buff *skb, 16270 struct genl_info *info) 16271 { 16272 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16273 struct net_device *dev = info->user_ptr[1]; 16274 struct cfg80211_set_hw_timestamp hwts = {}; 16275 16276 if (!rdev->wiphy.hw_timestamp_max_peers) 16277 return -EOPNOTSUPP; 16278 16279 if (!info->attrs[NL80211_ATTR_MAC] && 16280 rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS) 16281 return -EOPNOTSUPP; 16282 16283 if (info->attrs[NL80211_ATTR_MAC]) 16284 hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16285 16286 hwts.enable = 16287 nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]); 16288 16289 return rdev_set_hw_timestamp(rdev, dev, &hwts); 16290 } 16291 16292 static int 16293 nl80211_set_ttlm(struct sk_buff *skb, struct genl_info *info) 16294 { 16295 struct cfg80211_ttlm_params params = {}; 16296 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16297 struct net_device *dev = info->user_ptr[1]; 16298 struct wireless_dev *wdev = dev->ieee80211_ptr; 16299 16300 if (wdev->iftype != NL80211_IFTYPE_STATION && 16301 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 16302 return -EOPNOTSUPP; 16303 16304 if (!wdev->connected) 16305 return -ENOLINK; 16306 16307 if (!info->attrs[NL80211_ATTR_MLO_TTLM_DLINK] || 16308 !info->attrs[NL80211_ATTR_MLO_TTLM_ULINK]) 16309 return -EINVAL; 16310 16311 nla_memcpy(params.dlink, 16312 info->attrs[NL80211_ATTR_MLO_TTLM_DLINK], 16313 sizeof(params.dlink)); 16314 nla_memcpy(params.ulink, 16315 info->attrs[NL80211_ATTR_MLO_TTLM_ULINK], 16316 sizeof(params.ulink)); 16317 16318 return rdev_set_ttlm(rdev, dev, ¶ms); 16319 } 16320 16321 #define NL80211_FLAG_NEED_WIPHY 0x01 16322 #define NL80211_FLAG_NEED_NETDEV 0x02 16323 #define NL80211_FLAG_NEED_RTNL 0x04 16324 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08 16325 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\ 16326 NL80211_FLAG_CHECK_NETDEV_UP) 16327 #define NL80211_FLAG_NEED_WDEV 0x10 16328 /* If a netdev is associated, it must be UP, P2P must be started */ 16329 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\ 16330 NL80211_FLAG_CHECK_NETDEV_UP) 16331 #define NL80211_FLAG_CLEAR_SKB 0x20 16332 #define NL80211_FLAG_NO_WIPHY_MTX 0x40 16333 #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80 16334 #define NL80211_FLAG_MLO_UNSUPPORTED 0x100 16335 16336 #define INTERNAL_FLAG_SELECTORS(__sel) \ 16337 SELECTOR(__sel, NONE, 0) /* must be first */ \ 16338 SELECTOR(__sel, WIPHY, \ 16339 NL80211_FLAG_NEED_WIPHY) \ 16340 SELECTOR(__sel, WDEV, \ 16341 NL80211_FLAG_NEED_WDEV) \ 16342 SELECTOR(__sel, NETDEV, \ 16343 NL80211_FLAG_NEED_NETDEV) \ 16344 SELECTOR(__sel, NETDEV_LINK, \ 16345 NL80211_FLAG_NEED_NETDEV | \ 16346 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16347 SELECTOR(__sel, NETDEV_NO_MLO, \ 16348 NL80211_FLAG_NEED_NETDEV | \ 16349 NL80211_FLAG_MLO_UNSUPPORTED) \ 16350 SELECTOR(__sel, WIPHY_RTNL, \ 16351 NL80211_FLAG_NEED_WIPHY | \ 16352 NL80211_FLAG_NEED_RTNL) \ 16353 SELECTOR(__sel, WIPHY_RTNL_NOMTX, \ 16354 NL80211_FLAG_NEED_WIPHY | \ 16355 NL80211_FLAG_NEED_RTNL | \ 16356 NL80211_FLAG_NO_WIPHY_MTX) \ 16357 SELECTOR(__sel, WDEV_RTNL, \ 16358 NL80211_FLAG_NEED_WDEV | \ 16359 NL80211_FLAG_NEED_RTNL) \ 16360 SELECTOR(__sel, NETDEV_RTNL, \ 16361 NL80211_FLAG_NEED_NETDEV | \ 16362 NL80211_FLAG_NEED_RTNL) \ 16363 SELECTOR(__sel, NETDEV_UP, \ 16364 NL80211_FLAG_NEED_NETDEV_UP) \ 16365 SELECTOR(__sel, NETDEV_UP_LINK, \ 16366 NL80211_FLAG_NEED_NETDEV_UP | \ 16367 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16368 SELECTOR(__sel, NETDEV_UP_NO_MLO, \ 16369 NL80211_FLAG_NEED_NETDEV_UP | \ 16370 NL80211_FLAG_MLO_UNSUPPORTED) \ 16371 SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \ 16372 NL80211_FLAG_NEED_NETDEV_UP | \ 16373 NL80211_FLAG_CLEAR_SKB | \ 16374 NL80211_FLAG_MLO_UNSUPPORTED) \ 16375 SELECTOR(__sel, NETDEV_UP_NOTMX, \ 16376 NL80211_FLAG_NEED_NETDEV_UP | \ 16377 NL80211_FLAG_NO_WIPHY_MTX) \ 16378 SELECTOR(__sel, NETDEV_UP_NOTMX_NOMLO, \ 16379 NL80211_FLAG_NEED_NETDEV_UP | \ 16380 NL80211_FLAG_NO_WIPHY_MTX | \ 16381 NL80211_FLAG_MLO_UNSUPPORTED) \ 16382 SELECTOR(__sel, NETDEV_UP_CLEAR, \ 16383 NL80211_FLAG_NEED_NETDEV_UP | \ 16384 NL80211_FLAG_CLEAR_SKB) \ 16385 SELECTOR(__sel, WDEV_UP, \ 16386 NL80211_FLAG_NEED_WDEV_UP) \ 16387 SELECTOR(__sel, WDEV_UP_LINK, \ 16388 NL80211_FLAG_NEED_WDEV_UP | \ 16389 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16390 SELECTOR(__sel, WDEV_UP_RTNL, \ 16391 NL80211_FLAG_NEED_WDEV_UP | \ 16392 NL80211_FLAG_NEED_RTNL) \ 16393 SELECTOR(__sel, WIPHY_CLEAR, \ 16394 NL80211_FLAG_NEED_WIPHY | \ 16395 NL80211_FLAG_CLEAR_SKB) 16396 16397 enum nl80211_internal_flags_selector { 16398 #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name, 16399 INTERNAL_FLAG_SELECTORS(_) 16400 #undef SELECTOR 16401 }; 16402 16403 static u32 nl80211_internal_flags[] = { 16404 #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value, 16405 INTERNAL_FLAG_SELECTORS(_) 16406 #undef SELECTOR 16407 }; 16408 16409 static int nl80211_pre_doit(const struct genl_split_ops *ops, 16410 struct sk_buff *skb, 16411 struct genl_info *info) 16412 { 16413 struct cfg80211_registered_device *rdev = NULL; 16414 struct wireless_dev *wdev = NULL; 16415 struct net_device *dev = NULL; 16416 u32 internal_flags; 16417 int err; 16418 16419 if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags))) 16420 return -EINVAL; 16421 16422 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16423 16424 rtnl_lock(); 16425 if (internal_flags & NL80211_FLAG_NEED_WIPHY) { 16426 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 16427 if (IS_ERR(rdev)) { 16428 err = PTR_ERR(rdev); 16429 goto out_unlock; 16430 } 16431 info->user_ptr[0] = rdev; 16432 } else if (internal_flags & NL80211_FLAG_NEED_NETDEV || 16433 internal_flags & NL80211_FLAG_NEED_WDEV) { 16434 wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info), 16435 info->attrs); 16436 if (IS_ERR(wdev)) { 16437 err = PTR_ERR(wdev); 16438 goto out_unlock; 16439 } 16440 16441 dev = wdev->netdev; 16442 dev_hold(dev); 16443 rdev = wiphy_to_rdev(wdev->wiphy); 16444 16445 if (internal_flags & NL80211_FLAG_NEED_NETDEV) { 16446 if (!dev) { 16447 err = -EINVAL; 16448 goto out_unlock; 16449 } 16450 16451 info->user_ptr[1] = dev; 16452 } else { 16453 info->user_ptr[1] = wdev; 16454 } 16455 16456 if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP && 16457 !wdev_running(wdev)) { 16458 err = -ENETDOWN; 16459 goto out_unlock; 16460 } 16461 16462 info->user_ptr[0] = rdev; 16463 } 16464 16465 if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) { 16466 struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID]; 16467 16468 if (!wdev) { 16469 err = -EINVAL; 16470 goto out_unlock; 16471 } 16472 16473 /* MLO -> require valid link ID */ 16474 if (wdev->valid_links && 16475 (!link_id || 16476 !(wdev->valid_links & BIT(nla_get_u8(link_id))))) { 16477 err = -EINVAL; 16478 goto out_unlock; 16479 } 16480 16481 /* non-MLO -> no link ID attribute accepted */ 16482 if (!wdev->valid_links && link_id) { 16483 err = -EINVAL; 16484 goto out_unlock; 16485 } 16486 } 16487 16488 if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) { 16489 if (info->attrs[NL80211_ATTR_MLO_LINK_ID] || 16490 (wdev && wdev->valid_links)) { 16491 err = -EINVAL; 16492 goto out_unlock; 16493 } 16494 } 16495 16496 if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16497 wiphy_lock(&rdev->wiphy); 16498 /* we keep the mutex locked until post_doit */ 16499 __release(&rdev->wiphy.mtx); 16500 } 16501 if (!(internal_flags & NL80211_FLAG_NEED_RTNL)) 16502 rtnl_unlock(); 16503 16504 return 0; 16505 out_unlock: 16506 rtnl_unlock(); 16507 dev_put(dev); 16508 return err; 16509 } 16510 16511 static void nl80211_post_doit(const struct genl_split_ops *ops, 16512 struct sk_buff *skb, 16513 struct genl_info *info) 16514 { 16515 u32 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16516 16517 if (info->user_ptr[1]) { 16518 if (internal_flags & NL80211_FLAG_NEED_WDEV) { 16519 struct wireless_dev *wdev = info->user_ptr[1]; 16520 16521 dev_put(wdev->netdev); 16522 } else { 16523 dev_put(info->user_ptr[1]); 16524 } 16525 } 16526 16527 if (info->user_ptr[0] && 16528 !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16529 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16530 16531 /* we kept the mutex locked since pre_doit */ 16532 __acquire(&rdev->wiphy.mtx); 16533 wiphy_unlock(&rdev->wiphy); 16534 } 16535 16536 if (internal_flags & NL80211_FLAG_NEED_RTNL) 16537 rtnl_unlock(); 16538 16539 /* If needed, clear the netlink message payload from the SKB 16540 * as it might contain key data that shouldn't stick around on 16541 * the heap after the SKB is freed. The netlink message header 16542 * is still needed for further processing, so leave it intact. 16543 */ 16544 if (internal_flags & NL80211_FLAG_CLEAR_SKB) { 16545 struct nlmsghdr *nlh = nlmsg_hdr(skb); 16546 16547 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh)); 16548 } 16549 } 16550 16551 static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev, 16552 struct cfg80211_sar_specs *sar_specs, 16553 struct nlattr *spec[], int index) 16554 { 16555 u32 range_index, i; 16556 16557 if (!sar_specs || !spec) 16558 return -EINVAL; 16559 16560 if (!spec[NL80211_SAR_ATTR_SPECS_POWER] || 16561 !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]) 16562 return -EINVAL; 16563 16564 range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]); 16565 16566 /* check if range_index exceeds num_freq_ranges */ 16567 if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges) 16568 return -EINVAL; 16569 16570 /* check if range_index duplicates */ 16571 for (i = 0; i < index; i++) { 16572 if (sar_specs->sub_specs[i].freq_range_index == range_index) 16573 return -EINVAL; 16574 } 16575 16576 sar_specs->sub_specs[index].power = 16577 nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]); 16578 16579 sar_specs->sub_specs[index].freq_range_index = range_index; 16580 16581 return 0; 16582 } 16583 16584 static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info) 16585 { 16586 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16587 struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1]; 16588 struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1]; 16589 struct cfg80211_sar_specs *sar_spec; 16590 enum nl80211_sar_type type; 16591 struct nlattr *spec_list; 16592 u32 specs; 16593 int rem, err; 16594 16595 if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs) 16596 return -EOPNOTSUPP; 16597 16598 if (!info->attrs[NL80211_ATTR_SAR_SPEC]) 16599 return -EINVAL; 16600 16601 nla_parse_nested(tb, NL80211_SAR_ATTR_MAX, 16602 info->attrs[NL80211_ATTR_SAR_SPEC], 16603 NULL, NULL); 16604 16605 if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS]) 16606 return -EINVAL; 16607 16608 type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]); 16609 if (type != rdev->wiphy.sar_capa->type) 16610 return -EINVAL; 16611 16612 specs = 0; 16613 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) 16614 specs++; 16615 16616 if (specs > rdev->wiphy.sar_capa->num_freq_ranges) 16617 return -EINVAL; 16618 16619 sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL); 16620 if (!sar_spec) 16621 return -ENOMEM; 16622 16623 sar_spec->type = type; 16624 specs = 0; 16625 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) { 16626 nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX, 16627 spec_list, NULL, NULL); 16628 16629 switch (type) { 16630 case NL80211_SAR_TYPE_POWER: 16631 if (nl80211_set_sar_sub_specs(rdev, sar_spec, 16632 spec, specs)) { 16633 err = -EINVAL; 16634 goto error; 16635 } 16636 break; 16637 default: 16638 err = -EINVAL; 16639 goto error; 16640 } 16641 specs++; 16642 } 16643 16644 sar_spec->num_sub_specs = specs; 16645 16646 rdev->cur_cmd_info = info; 16647 err = rdev_set_sar_specs(rdev, sar_spec); 16648 rdev->cur_cmd_info = NULL; 16649 error: 16650 kfree(sar_spec); 16651 return err; 16652 } 16653 16654 #define SELECTOR(__sel, name, value) \ 16655 ((__sel) == (value)) ? NL80211_IFL_SEL_##name : 16656 int __missing_selector(void); 16657 #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector() 16658 16659 static const struct genl_ops nl80211_ops[] = { 16660 { 16661 .cmd = NL80211_CMD_GET_WIPHY, 16662 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16663 .doit = nl80211_get_wiphy, 16664 .dumpit = nl80211_dump_wiphy, 16665 .done = nl80211_dump_wiphy_done, 16666 /* can be retrieved by unprivileged users */ 16667 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 16668 }, 16669 }; 16670 16671 static const struct genl_small_ops nl80211_small_ops[] = { 16672 { 16673 .cmd = NL80211_CMD_SET_WIPHY, 16674 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16675 .doit = nl80211_set_wiphy, 16676 .flags = GENL_UNS_ADMIN_PERM, 16677 }, 16678 { 16679 .cmd = NL80211_CMD_GET_INTERFACE, 16680 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16681 .doit = nl80211_get_interface, 16682 .dumpit = nl80211_dump_interface, 16683 /* can be retrieved by unprivileged users */ 16684 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 16685 }, 16686 { 16687 .cmd = NL80211_CMD_SET_INTERFACE, 16688 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16689 .doit = nl80211_set_interface, 16690 .flags = GENL_UNS_ADMIN_PERM, 16691 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 16692 NL80211_FLAG_NEED_RTNL), 16693 }, 16694 { 16695 .cmd = NL80211_CMD_NEW_INTERFACE, 16696 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16697 .doit = nl80211_new_interface, 16698 .flags = GENL_UNS_ADMIN_PERM, 16699 .internal_flags = 16700 IFLAGS(NL80211_FLAG_NEED_WIPHY | 16701 NL80211_FLAG_NEED_RTNL | 16702 /* we take the wiphy mutex later ourselves */ 16703 NL80211_FLAG_NO_WIPHY_MTX), 16704 }, 16705 { 16706 .cmd = NL80211_CMD_DEL_INTERFACE, 16707 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16708 .doit = nl80211_del_interface, 16709 .flags = GENL_UNS_ADMIN_PERM, 16710 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 16711 NL80211_FLAG_NEED_RTNL), 16712 }, 16713 { 16714 .cmd = NL80211_CMD_GET_KEY, 16715 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16716 .doit = nl80211_get_key, 16717 .flags = GENL_UNS_ADMIN_PERM, 16718 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16719 }, 16720 { 16721 .cmd = NL80211_CMD_SET_KEY, 16722 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16723 .doit = nl80211_set_key, 16724 .flags = GENL_UNS_ADMIN_PERM, 16725 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */ 16726 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16727 NL80211_FLAG_CLEAR_SKB), 16728 }, 16729 { 16730 .cmd = NL80211_CMD_NEW_KEY, 16731 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16732 .doit = nl80211_new_key, 16733 .flags = GENL_UNS_ADMIN_PERM, 16734 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16735 NL80211_FLAG_CLEAR_SKB), 16736 }, 16737 { 16738 .cmd = NL80211_CMD_DEL_KEY, 16739 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16740 .doit = nl80211_del_key, 16741 .flags = GENL_UNS_ADMIN_PERM, 16742 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16743 }, 16744 { 16745 .cmd = NL80211_CMD_SET_BEACON, 16746 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16747 .flags = GENL_UNS_ADMIN_PERM, 16748 .doit = nl80211_set_beacon, 16749 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16750 NL80211_FLAG_MLO_VALID_LINK_ID), 16751 }, 16752 { 16753 .cmd = NL80211_CMD_START_AP, 16754 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16755 .flags = GENL_UNS_ADMIN_PERM, 16756 .doit = nl80211_start_ap, 16757 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16758 NL80211_FLAG_MLO_VALID_LINK_ID), 16759 }, 16760 { 16761 .cmd = NL80211_CMD_STOP_AP, 16762 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16763 .flags = GENL_UNS_ADMIN_PERM, 16764 .doit = nl80211_stop_ap, 16765 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16766 NL80211_FLAG_MLO_VALID_LINK_ID), 16767 }, 16768 { 16769 .cmd = NL80211_CMD_GET_STATION, 16770 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16771 .doit = nl80211_get_station, 16772 .dumpit = nl80211_dump_station, 16773 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 16774 }, 16775 { 16776 .cmd = NL80211_CMD_SET_STATION, 16777 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16778 .doit = nl80211_set_station, 16779 .flags = GENL_UNS_ADMIN_PERM, 16780 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16781 }, 16782 { 16783 .cmd = NL80211_CMD_NEW_STATION, 16784 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16785 .doit = nl80211_new_station, 16786 .flags = GENL_UNS_ADMIN_PERM, 16787 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16788 }, 16789 { 16790 .cmd = NL80211_CMD_DEL_STATION, 16791 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16792 .doit = nl80211_del_station, 16793 .flags = GENL_UNS_ADMIN_PERM, 16794 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on 16795 * whether MAC address is passed or not. If MAC address is 16796 * passed, then even during MLO, link ID is not required. 16797 */ 16798 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16799 }, 16800 { 16801 .cmd = NL80211_CMD_GET_MPATH, 16802 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16803 .doit = nl80211_get_mpath, 16804 .dumpit = nl80211_dump_mpath, 16805 .flags = GENL_UNS_ADMIN_PERM, 16806 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16807 }, 16808 { 16809 .cmd = NL80211_CMD_GET_MPP, 16810 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16811 .doit = nl80211_get_mpp, 16812 .dumpit = nl80211_dump_mpp, 16813 .flags = GENL_UNS_ADMIN_PERM, 16814 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16815 }, 16816 { 16817 .cmd = NL80211_CMD_SET_MPATH, 16818 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16819 .doit = nl80211_set_mpath, 16820 .flags = GENL_UNS_ADMIN_PERM, 16821 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16822 }, 16823 { 16824 .cmd = NL80211_CMD_NEW_MPATH, 16825 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16826 .doit = nl80211_new_mpath, 16827 .flags = GENL_UNS_ADMIN_PERM, 16828 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16829 }, 16830 { 16831 .cmd = NL80211_CMD_DEL_MPATH, 16832 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16833 .doit = nl80211_del_mpath, 16834 .flags = GENL_UNS_ADMIN_PERM, 16835 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16836 }, 16837 { 16838 .cmd = NL80211_CMD_SET_BSS, 16839 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16840 .doit = nl80211_set_bss, 16841 .flags = GENL_UNS_ADMIN_PERM, 16842 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16843 NL80211_FLAG_MLO_VALID_LINK_ID), 16844 }, 16845 { 16846 .cmd = NL80211_CMD_GET_REG, 16847 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16848 .doit = nl80211_get_reg_do, 16849 .dumpit = nl80211_get_reg_dump, 16850 /* can be retrieved by unprivileged users */ 16851 }, 16852 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 16853 { 16854 .cmd = NL80211_CMD_SET_REG, 16855 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16856 .doit = nl80211_set_reg, 16857 .flags = GENL_ADMIN_PERM, 16858 }, 16859 #endif 16860 { 16861 .cmd = NL80211_CMD_REQ_SET_REG, 16862 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16863 .doit = nl80211_req_set_reg, 16864 .flags = GENL_ADMIN_PERM, 16865 }, 16866 { 16867 .cmd = NL80211_CMD_RELOAD_REGDB, 16868 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16869 .doit = nl80211_reload_regdb, 16870 .flags = GENL_ADMIN_PERM, 16871 }, 16872 { 16873 .cmd = NL80211_CMD_GET_MESH_CONFIG, 16874 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16875 .doit = nl80211_get_mesh_config, 16876 /* can be retrieved by unprivileged users */ 16877 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16878 }, 16879 { 16880 .cmd = NL80211_CMD_SET_MESH_CONFIG, 16881 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16882 .doit = nl80211_update_mesh_config, 16883 .flags = GENL_UNS_ADMIN_PERM, 16884 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16885 }, 16886 { 16887 .cmd = NL80211_CMD_TRIGGER_SCAN, 16888 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16889 .doit = nl80211_trigger_scan, 16890 .flags = GENL_UNS_ADMIN_PERM, 16891 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 16892 }, 16893 { 16894 .cmd = NL80211_CMD_ABORT_SCAN, 16895 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16896 .doit = nl80211_abort_scan, 16897 .flags = GENL_UNS_ADMIN_PERM, 16898 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 16899 }, 16900 { 16901 .cmd = NL80211_CMD_GET_SCAN, 16902 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16903 .dumpit = nl80211_dump_scan, 16904 }, 16905 { 16906 .cmd = NL80211_CMD_START_SCHED_SCAN, 16907 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16908 .doit = nl80211_start_sched_scan, 16909 .flags = GENL_UNS_ADMIN_PERM, 16910 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16911 }, 16912 { 16913 .cmd = NL80211_CMD_STOP_SCHED_SCAN, 16914 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16915 .doit = nl80211_stop_sched_scan, 16916 .flags = GENL_UNS_ADMIN_PERM, 16917 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16918 }, 16919 { 16920 .cmd = NL80211_CMD_AUTHENTICATE, 16921 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16922 .doit = nl80211_authenticate, 16923 .flags = GENL_UNS_ADMIN_PERM, 16924 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16925 NL80211_FLAG_CLEAR_SKB), 16926 }, 16927 { 16928 .cmd = NL80211_CMD_ASSOCIATE, 16929 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16930 .doit = nl80211_associate, 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_DEAUTHENTICATE, 16937 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16938 .doit = nl80211_deauthenticate, 16939 .flags = GENL_UNS_ADMIN_PERM, 16940 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16941 }, 16942 { 16943 .cmd = NL80211_CMD_DISASSOCIATE, 16944 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16945 .doit = nl80211_disassociate, 16946 .flags = GENL_UNS_ADMIN_PERM, 16947 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16948 }, 16949 { 16950 .cmd = NL80211_CMD_JOIN_IBSS, 16951 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16952 .doit = nl80211_join_ibss, 16953 .flags = GENL_UNS_ADMIN_PERM, 16954 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16955 }, 16956 { 16957 .cmd = NL80211_CMD_LEAVE_IBSS, 16958 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16959 .doit = nl80211_leave_ibss, 16960 .flags = GENL_UNS_ADMIN_PERM, 16961 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16962 }, 16963 #ifdef CONFIG_NL80211_TESTMODE 16964 { 16965 .cmd = NL80211_CMD_TESTMODE, 16966 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16967 .doit = nl80211_testmode_do, 16968 .dumpit = nl80211_testmode_dump, 16969 .flags = GENL_UNS_ADMIN_PERM, 16970 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 16971 }, 16972 #endif 16973 { 16974 .cmd = NL80211_CMD_CONNECT, 16975 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16976 .doit = nl80211_connect, 16977 .flags = GENL_UNS_ADMIN_PERM, 16978 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16979 NL80211_FLAG_CLEAR_SKB), 16980 }, 16981 { 16982 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS, 16983 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16984 .doit = nl80211_update_connect_params, 16985 .flags = GENL_ADMIN_PERM, 16986 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16987 NL80211_FLAG_CLEAR_SKB), 16988 }, 16989 { 16990 .cmd = NL80211_CMD_DISCONNECT, 16991 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16992 .doit = nl80211_disconnect, 16993 .flags = GENL_UNS_ADMIN_PERM, 16994 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16995 }, 16996 { 16997 .cmd = NL80211_CMD_SET_WIPHY_NETNS, 16998 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16999 .doit = nl80211_wiphy_netns, 17000 .flags = GENL_UNS_ADMIN_PERM, 17001 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17002 NL80211_FLAG_NEED_RTNL | 17003 NL80211_FLAG_NO_WIPHY_MTX), 17004 }, 17005 { 17006 .cmd = NL80211_CMD_GET_SURVEY, 17007 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17008 .dumpit = nl80211_dump_survey, 17009 }, 17010 { 17011 .cmd = NL80211_CMD_SET_PMKSA, 17012 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17013 .doit = nl80211_set_pmksa, 17014 .flags = GENL_UNS_ADMIN_PERM, 17015 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17016 NL80211_FLAG_CLEAR_SKB), 17017 }, 17018 { 17019 .cmd = NL80211_CMD_DEL_PMKSA, 17020 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17021 .doit = nl80211_del_pmksa, 17022 .flags = GENL_UNS_ADMIN_PERM, 17023 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17024 }, 17025 { 17026 .cmd = NL80211_CMD_FLUSH_PMKSA, 17027 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17028 .doit = nl80211_flush_pmksa, 17029 .flags = GENL_UNS_ADMIN_PERM, 17030 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17031 }, 17032 { 17033 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL, 17034 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17035 .doit = nl80211_remain_on_channel, 17036 .flags = GENL_UNS_ADMIN_PERM, 17037 /* FIXME: requiring a link ID here is probably not good */ 17038 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17039 NL80211_FLAG_MLO_VALID_LINK_ID), 17040 }, 17041 { 17042 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 17043 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17044 .doit = nl80211_cancel_remain_on_channel, 17045 .flags = GENL_UNS_ADMIN_PERM, 17046 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17047 }, 17048 { 17049 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK, 17050 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17051 .doit = nl80211_set_tx_bitrate_mask, 17052 .flags = GENL_UNS_ADMIN_PERM, 17053 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17054 NL80211_FLAG_MLO_VALID_LINK_ID), 17055 }, 17056 { 17057 .cmd = NL80211_CMD_REGISTER_FRAME, 17058 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17059 .doit = nl80211_register_mgmt, 17060 .flags = GENL_UNS_ADMIN_PERM, 17061 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 17062 }, 17063 { 17064 .cmd = NL80211_CMD_FRAME, 17065 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17066 .doit = nl80211_tx_mgmt, 17067 .flags = GENL_UNS_ADMIN_PERM, 17068 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17069 }, 17070 { 17071 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL, 17072 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17073 .doit = nl80211_tx_mgmt_cancel_wait, 17074 .flags = GENL_UNS_ADMIN_PERM, 17075 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17076 }, 17077 { 17078 .cmd = NL80211_CMD_SET_POWER_SAVE, 17079 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17080 .doit = nl80211_set_power_save, 17081 .flags = GENL_UNS_ADMIN_PERM, 17082 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17083 }, 17084 { 17085 .cmd = NL80211_CMD_GET_POWER_SAVE, 17086 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17087 .doit = nl80211_get_power_save, 17088 /* can be retrieved by unprivileged users */ 17089 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17090 }, 17091 { 17092 .cmd = NL80211_CMD_SET_CQM, 17093 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17094 .doit = nl80211_set_cqm, 17095 .flags = GENL_UNS_ADMIN_PERM, 17096 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17097 }, 17098 { 17099 .cmd = NL80211_CMD_SET_CHANNEL, 17100 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17101 .doit = nl80211_set_channel, 17102 .flags = GENL_UNS_ADMIN_PERM, 17103 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17104 NL80211_FLAG_MLO_VALID_LINK_ID), 17105 }, 17106 { 17107 .cmd = NL80211_CMD_JOIN_MESH, 17108 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17109 .doit = nl80211_join_mesh, 17110 .flags = GENL_UNS_ADMIN_PERM, 17111 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17112 }, 17113 { 17114 .cmd = NL80211_CMD_LEAVE_MESH, 17115 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17116 .doit = nl80211_leave_mesh, 17117 .flags = GENL_UNS_ADMIN_PERM, 17118 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17119 }, 17120 { 17121 .cmd = NL80211_CMD_JOIN_OCB, 17122 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17123 .doit = nl80211_join_ocb, 17124 .flags = GENL_UNS_ADMIN_PERM, 17125 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17126 }, 17127 { 17128 .cmd = NL80211_CMD_LEAVE_OCB, 17129 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17130 .doit = nl80211_leave_ocb, 17131 .flags = GENL_UNS_ADMIN_PERM, 17132 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17133 }, 17134 #ifdef CONFIG_PM 17135 { 17136 .cmd = NL80211_CMD_GET_WOWLAN, 17137 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17138 .doit = nl80211_get_wowlan, 17139 /* can be retrieved by unprivileged users */ 17140 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17141 }, 17142 { 17143 .cmd = NL80211_CMD_SET_WOWLAN, 17144 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17145 .doit = nl80211_set_wowlan, 17146 .flags = GENL_UNS_ADMIN_PERM, 17147 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17148 }, 17149 #endif 17150 { 17151 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD, 17152 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17153 .doit = nl80211_set_rekey_data, 17154 .flags = GENL_UNS_ADMIN_PERM, 17155 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17156 NL80211_FLAG_CLEAR_SKB), 17157 }, 17158 { 17159 .cmd = NL80211_CMD_TDLS_MGMT, 17160 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17161 .doit = nl80211_tdls_mgmt, 17162 .flags = GENL_UNS_ADMIN_PERM, 17163 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17164 NL80211_FLAG_MLO_VALID_LINK_ID), 17165 }, 17166 { 17167 .cmd = NL80211_CMD_TDLS_OPER, 17168 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17169 .doit = nl80211_tdls_oper, 17170 .flags = GENL_UNS_ADMIN_PERM, 17171 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17172 }, 17173 { 17174 .cmd = NL80211_CMD_UNEXPECTED_FRAME, 17175 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17176 .doit = nl80211_register_unexpected_frame, 17177 .flags = GENL_UNS_ADMIN_PERM, 17178 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17179 }, 17180 { 17181 .cmd = NL80211_CMD_PROBE_CLIENT, 17182 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17183 .doit = nl80211_probe_client, 17184 .flags = GENL_UNS_ADMIN_PERM, 17185 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17186 }, 17187 { 17188 .cmd = NL80211_CMD_REGISTER_BEACONS, 17189 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17190 .doit = nl80211_register_beacons, 17191 .flags = GENL_UNS_ADMIN_PERM, 17192 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17193 }, 17194 { 17195 .cmd = NL80211_CMD_SET_NOACK_MAP, 17196 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17197 .doit = nl80211_set_noack_map, 17198 .flags = GENL_UNS_ADMIN_PERM, 17199 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17200 }, 17201 { 17202 .cmd = NL80211_CMD_START_P2P_DEVICE, 17203 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17204 .doit = nl80211_start_p2p_device, 17205 .flags = GENL_UNS_ADMIN_PERM, 17206 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17207 NL80211_FLAG_NEED_RTNL), 17208 }, 17209 { 17210 .cmd = NL80211_CMD_STOP_P2P_DEVICE, 17211 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17212 .doit = nl80211_stop_p2p_device, 17213 .flags = GENL_UNS_ADMIN_PERM, 17214 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17215 NL80211_FLAG_NEED_RTNL), 17216 }, 17217 { 17218 .cmd = NL80211_CMD_START_NAN, 17219 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17220 .doit = nl80211_start_nan, 17221 .flags = GENL_ADMIN_PERM, 17222 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17223 NL80211_FLAG_NEED_RTNL), 17224 }, 17225 { 17226 .cmd = NL80211_CMD_STOP_NAN, 17227 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17228 .doit = nl80211_stop_nan, 17229 .flags = GENL_ADMIN_PERM, 17230 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17231 NL80211_FLAG_NEED_RTNL), 17232 }, 17233 { 17234 .cmd = NL80211_CMD_ADD_NAN_FUNCTION, 17235 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17236 .doit = nl80211_nan_add_func, 17237 .flags = GENL_ADMIN_PERM, 17238 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17239 }, 17240 { 17241 .cmd = NL80211_CMD_DEL_NAN_FUNCTION, 17242 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17243 .doit = nl80211_nan_del_func, 17244 .flags = GENL_ADMIN_PERM, 17245 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17246 }, 17247 { 17248 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG, 17249 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17250 .doit = nl80211_nan_change_config, 17251 .flags = GENL_ADMIN_PERM, 17252 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17253 }, 17254 { 17255 .cmd = NL80211_CMD_SET_MCAST_RATE, 17256 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17257 .doit = nl80211_set_mcast_rate, 17258 .flags = GENL_UNS_ADMIN_PERM, 17259 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17260 }, 17261 { 17262 .cmd = NL80211_CMD_SET_MAC_ACL, 17263 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17264 .doit = nl80211_set_mac_acl, 17265 .flags = GENL_UNS_ADMIN_PERM, 17266 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17267 NL80211_FLAG_MLO_UNSUPPORTED), 17268 }, 17269 { 17270 .cmd = NL80211_CMD_RADAR_DETECT, 17271 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17272 .doit = nl80211_start_radar_detection, 17273 .flags = GENL_UNS_ADMIN_PERM, 17274 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17275 NL80211_FLAG_NO_WIPHY_MTX | 17276 NL80211_FLAG_MLO_UNSUPPORTED), 17277 }, 17278 { 17279 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES, 17280 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17281 .doit = nl80211_get_protocol_features, 17282 }, 17283 { 17284 .cmd = NL80211_CMD_UPDATE_FT_IES, 17285 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17286 .doit = nl80211_update_ft_ies, 17287 .flags = GENL_UNS_ADMIN_PERM, 17288 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17289 }, 17290 { 17291 .cmd = NL80211_CMD_CRIT_PROTOCOL_START, 17292 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17293 .doit = nl80211_crit_protocol_start, 17294 .flags = GENL_UNS_ADMIN_PERM, 17295 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17296 }, 17297 { 17298 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP, 17299 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17300 .doit = nl80211_crit_protocol_stop, 17301 .flags = GENL_UNS_ADMIN_PERM, 17302 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17303 }, 17304 { 17305 .cmd = NL80211_CMD_GET_COALESCE, 17306 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17307 .doit = nl80211_get_coalesce, 17308 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17309 }, 17310 { 17311 .cmd = NL80211_CMD_SET_COALESCE, 17312 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17313 .doit = nl80211_set_coalesce, 17314 .flags = GENL_UNS_ADMIN_PERM, 17315 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17316 }, 17317 { 17318 .cmd = NL80211_CMD_CHANNEL_SWITCH, 17319 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17320 .doit = nl80211_channel_switch, 17321 .flags = GENL_UNS_ADMIN_PERM, 17322 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17323 NL80211_FLAG_MLO_VALID_LINK_ID), 17324 }, 17325 { 17326 .cmd = NL80211_CMD_VENDOR, 17327 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17328 .doit = nl80211_vendor_cmd, 17329 .dumpit = nl80211_vendor_cmd_dump, 17330 .flags = GENL_UNS_ADMIN_PERM, 17331 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17332 NL80211_FLAG_CLEAR_SKB), 17333 }, 17334 { 17335 .cmd = NL80211_CMD_SET_QOS_MAP, 17336 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17337 .doit = nl80211_set_qos_map, 17338 .flags = GENL_UNS_ADMIN_PERM, 17339 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17340 }, 17341 { 17342 .cmd = NL80211_CMD_ADD_TX_TS, 17343 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17344 .doit = nl80211_add_tx_ts, 17345 .flags = GENL_UNS_ADMIN_PERM, 17346 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17347 NL80211_FLAG_MLO_UNSUPPORTED), 17348 }, 17349 { 17350 .cmd = NL80211_CMD_DEL_TX_TS, 17351 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17352 .doit = nl80211_del_tx_ts, 17353 .flags = GENL_UNS_ADMIN_PERM, 17354 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17355 }, 17356 { 17357 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH, 17358 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17359 .doit = nl80211_tdls_channel_switch, 17360 .flags = GENL_UNS_ADMIN_PERM, 17361 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17362 }, 17363 { 17364 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH, 17365 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17366 .doit = nl80211_tdls_cancel_channel_switch, 17367 .flags = GENL_UNS_ADMIN_PERM, 17368 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17369 }, 17370 { 17371 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST, 17372 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17373 .doit = nl80211_set_multicast_to_unicast, 17374 .flags = GENL_UNS_ADMIN_PERM, 17375 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17376 }, 17377 { 17378 .cmd = NL80211_CMD_SET_PMK, 17379 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17380 .doit = nl80211_set_pmk, 17381 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17382 NL80211_FLAG_CLEAR_SKB), 17383 }, 17384 { 17385 .cmd = NL80211_CMD_DEL_PMK, 17386 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17387 .doit = nl80211_del_pmk, 17388 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17389 }, 17390 { 17391 .cmd = NL80211_CMD_EXTERNAL_AUTH, 17392 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17393 .doit = nl80211_external_auth, 17394 .flags = GENL_ADMIN_PERM, 17395 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17396 }, 17397 { 17398 .cmd = NL80211_CMD_CONTROL_PORT_FRAME, 17399 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17400 .doit = nl80211_tx_control_port, 17401 .flags = GENL_UNS_ADMIN_PERM, 17402 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17403 }, 17404 { 17405 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS, 17406 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17407 .doit = nl80211_get_ftm_responder_stats, 17408 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17409 NL80211_FLAG_MLO_VALID_LINK_ID), 17410 }, 17411 { 17412 .cmd = NL80211_CMD_PEER_MEASUREMENT_START, 17413 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17414 .doit = nl80211_pmsr_start, 17415 .flags = GENL_UNS_ADMIN_PERM, 17416 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17417 }, 17418 { 17419 .cmd = NL80211_CMD_NOTIFY_RADAR, 17420 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17421 .doit = nl80211_notify_radar_detection, 17422 .flags = GENL_UNS_ADMIN_PERM, 17423 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17424 }, 17425 { 17426 .cmd = NL80211_CMD_UPDATE_OWE_INFO, 17427 .doit = nl80211_update_owe_info, 17428 .flags = GENL_ADMIN_PERM, 17429 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17430 }, 17431 { 17432 .cmd = NL80211_CMD_PROBE_MESH_LINK, 17433 .doit = nl80211_probe_mesh_link, 17434 .flags = GENL_UNS_ADMIN_PERM, 17435 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17436 }, 17437 { 17438 .cmd = NL80211_CMD_SET_TID_CONFIG, 17439 .doit = nl80211_set_tid_config, 17440 .flags = GENL_UNS_ADMIN_PERM, 17441 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17442 NL80211_FLAG_MLO_VALID_LINK_ID), 17443 }, 17444 { 17445 .cmd = NL80211_CMD_SET_SAR_SPECS, 17446 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17447 .doit = nl80211_set_sar_specs, 17448 .flags = GENL_UNS_ADMIN_PERM, 17449 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17450 NL80211_FLAG_NEED_RTNL), 17451 }, 17452 { 17453 .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST, 17454 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17455 .doit = nl80211_color_change, 17456 .flags = GENL_UNS_ADMIN_PERM, 17457 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17458 }, 17459 { 17460 .cmd = NL80211_CMD_SET_FILS_AAD, 17461 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17462 .doit = nl80211_set_fils_aad, 17463 .flags = GENL_UNS_ADMIN_PERM, 17464 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17465 }, 17466 { 17467 .cmd = NL80211_CMD_ADD_LINK, 17468 .doit = nl80211_add_link, 17469 .flags = GENL_UNS_ADMIN_PERM, 17470 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17471 }, 17472 { 17473 .cmd = NL80211_CMD_REMOVE_LINK, 17474 .doit = nl80211_remove_link, 17475 .flags = GENL_UNS_ADMIN_PERM, 17476 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17477 NL80211_FLAG_MLO_VALID_LINK_ID), 17478 }, 17479 { 17480 .cmd = NL80211_CMD_ADD_LINK_STA, 17481 .doit = nl80211_add_link_station, 17482 .flags = GENL_UNS_ADMIN_PERM, 17483 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17484 NL80211_FLAG_MLO_VALID_LINK_ID), 17485 }, 17486 { 17487 .cmd = NL80211_CMD_MODIFY_LINK_STA, 17488 .doit = nl80211_modify_link_station, 17489 .flags = GENL_UNS_ADMIN_PERM, 17490 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17491 NL80211_FLAG_MLO_VALID_LINK_ID), 17492 }, 17493 { 17494 .cmd = NL80211_CMD_REMOVE_LINK_STA, 17495 .doit = nl80211_remove_link_station, 17496 .flags = GENL_UNS_ADMIN_PERM, 17497 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17498 NL80211_FLAG_MLO_VALID_LINK_ID), 17499 }, 17500 { 17501 .cmd = NL80211_CMD_SET_HW_TIMESTAMP, 17502 .doit = nl80211_set_hw_timestamp, 17503 .flags = GENL_UNS_ADMIN_PERM, 17504 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17505 }, 17506 { 17507 .cmd = NL80211_CMD_SET_TID_TO_LINK_MAPPING, 17508 .doit = nl80211_set_ttlm, 17509 .flags = GENL_UNS_ADMIN_PERM, 17510 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17511 }, 17512 }; 17513 17514 static struct genl_family nl80211_fam __ro_after_init = { 17515 .name = NL80211_GENL_NAME, /* have users key off the name instead */ 17516 .hdrsize = 0, /* no private header */ 17517 .version = 1, /* no particular meaning now */ 17518 .maxattr = NL80211_ATTR_MAX, 17519 .policy = nl80211_policy, 17520 .netnsok = true, 17521 .pre_doit = nl80211_pre_doit, 17522 .post_doit = nl80211_post_doit, 17523 .module = THIS_MODULE, 17524 .ops = nl80211_ops, 17525 .n_ops = ARRAY_SIZE(nl80211_ops), 17526 .small_ops = nl80211_small_ops, 17527 .n_small_ops = ARRAY_SIZE(nl80211_small_ops), 17528 .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1, 17529 .mcgrps = nl80211_mcgrps, 17530 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps), 17531 .parallel_ops = true, 17532 }; 17533 17534 /* notification functions */ 17535 17536 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev, 17537 enum nl80211_commands cmd) 17538 { 17539 struct sk_buff *msg; 17540 struct nl80211_dump_wiphy_state state = {}; 17541 17542 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY && 17543 cmd != NL80211_CMD_DEL_WIPHY); 17544 17545 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17546 if (!msg) 17547 return; 17548 17549 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) { 17550 nlmsg_free(msg); 17551 return; 17552 } 17553 17554 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17555 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17556 } 17557 17558 void nl80211_notify_iface(struct cfg80211_registered_device *rdev, 17559 struct wireless_dev *wdev, 17560 enum nl80211_commands cmd) 17561 { 17562 struct sk_buff *msg; 17563 17564 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17565 if (!msg) 17566 return; 17567 17568 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) { 17569 nlmsg_free(msg); 17570 return; 17571 } 17572 17573 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17574 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17575 } 17576 17577 static int nl80211_add_scan_req(struct sk_buff *msg, 17578 struct cfg80211_registered_device *rdev) 17579 { 17580 struct cfg80211_scan_request *req = rdev->scan_req; 17581 struct nlattr *nest; 17582 int i; 17583 struct cfg80211_scan_info *info; 17584 17585 if (WARN_ON(!req)) 17586 return 0; 17587 17588 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS); 17589 if (!nest) 17590 goto nla_put_failure; 17591 for (i = 0; i < req->n_ssids; i++) { 17592 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid)) 17593 goto nla_put_failure; 17594 } 17595 nla_nest_end(msg, nest); 17596 17597 if (req->flags & NL80211_SCAN_FLAG_FREQ_KHZ) { 17598 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ); 17599 if (!nest) 17600 goto nla_put_failure; 17601 for (i = 0; i < req->n_channels; i++) { 17602 if (nla_put_u32(msg, i, 17603 ieee80211_channel_to_khz(req->channels[i]))) 17604 goto nla_put_failure; 17605 } 17606 nla_nest_end(msg, nest); 17607 } else { 17608 nest = nla_nest_start_noflag(msg, 17609 NL80211_ATTR_SCAN_FREQUENCIES); 17610 if (!nest) 17611 goto nla_put_failure; 17612 for (i = 0; i < req->n_channels; i++) { 17613 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 17614 goto nla_put_failure; 17615 } 17616 nla_nest_end(msg, nest); 17617 } 17618 17619 if (req->ie && 17620 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie)) 17621 goto nla_put_failure; 17622 17623 if (req->flags && 17624 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags)) 17625 goto nla_put_failure; 17626 17627 info = rdev->int_scan_req ? &rdev->int_scan_req->info : 17628 &rdev->scan_req->info; 17629 if (info->scan_start_tsf && 17630 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF, 17631 info->scan_start_tsf, NL80211_BSS_PAD) || 17632 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN, 17633 info->tsf_bssid))) 17634 goto nla_put_failure; 17635 17636 return 0; 17637 nla_put_failure: 17638 return -ENOBUFS; 17639 } 17640 17641 static int nl80211_prep_scan_msg(struct sk_buff *msg, 17642 struct cfg80211_registered_device *rdev, 17643 struct wireless_dev *wdev, 17644 u32 portid, u32 seq, int flags, 17645 u32 cmd) 17646 { 17647 void *hdr; 17648 17649 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 17650 if (!hdr) 17651 return -1; 17652 17653 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17654 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 17655 wdev->netdev->ifindex)) || 17656 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 17657 NL80211_ATTR_PAD)) 17658 goto nla_put_failure; 17659 17660 /* ignore errors and send incomplete event anyway */ 17661 nl80211_add_scan_req(msg, rdev); 17662 17663 genlmsg_end(msg, hdr); 17664 return 0; 17665 17666 nla_put_failure: 17667 genlmsg_cancel(msg, hdr); 17668 return -EMSGSIZE; 17669 } 17670 17671 static int 17672 nl80211_prep_sched_scan_msg(struct sk_buff *msg, 17673 struct cfg80211_sched_scan_request *req, u32 cmd) 17674 { 17675 void *hdr; 17676 17677 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 17678 if (!hdr) 17679 return -1; 17680 17681 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, 17682 wiphy_to_rdev(req->wiphy)->wiphy_idx) || 17683 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) || 17684 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid, 17685 NL80211_ATTR_PAD)) 17686 goto nla_put_failure; 17687 17688 genlmsg_end(msg, hdr); 17689 return 0; 17690 17691 nla_put_failure: 17692 genlmsg_cancel(msg, hdr); 17693 return -EMSGSIZE; 17694 } 17695 17696 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev, 17697 struct wireless_dev *wdev) 17698 { 17699 struct sk_buff *msg; 17700 17701 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17702 if (!msg) 17703 return; 17704 17705 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17706 NL80211_CMD_TRIGGER_SCAN) < 0) { 17707 nlmsg_free(msg); 17708 return; 17709 } 17710 17711 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17712 NL80211_MCGRP_SCAN, GFP_KERNEL); 17713 } 17714 17715 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev, 17716 struct wireless_dev *wdev, bool aborted) 17717 { 17718 struct sk_buff *msg; 17719 17720 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17721 if (!msg) 17722 return NULL; 17723 17724 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17725 aborted ? NL80211_CMD_SCAN_ABORTED : 17726 NL80211_CMD_NEW_SCAN_RESULTS) < 0) { 17727 nlmsg_free(msg); 17728 return NULL; 17729 } 17730 17731 return msg; 17732 } 17733 17734 /* send message created by nl80211_build_scan_msg() */ 17735 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev, 17736 struct sk_buff *msg) 17737 { 17738 if (!msg) 17739 return; 17740 17741 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17742 NL80211_MCGRP_SCAN, GFP_KERNEL); 17743 } 17744 17745 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd) 17746 { 17747 struct sk_buff *msg; 17748 17749 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17750 if (!msg) 17751 return; 17752 17753 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) { 17754 nlmsg_free(msg); 17755 return; 17756 } 17757 17758 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0, 17759 NL80211_MCGRP_SCAN, GFP_KERNEL); 17760 } 17761 17762 static bool nl80211_reg_change_event_fill(struct sk_buff *msg, 17763 struct regulatory_request *request) 17764 { 17765 /* Userspace can always count this one always being set */ 17766 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator)) 17767 goto nla_put_failure; 17768 17769 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') { 17770 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17771 NL80211_REGDOM_TYPE_WORLD)) 17772 goto nla_put_failure; 17773 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') { 17774 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17775 NL80211_REGDOM_TYPE_CUSTOM_WORLD)) 17776 goto nla_put_failure; 17777 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') || 17778 request->intersect) { 17779 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17780 NL80211_REGDOM_TYPE_INTERSECTION)) 17781 goto nla_put_failure; 17782 } else { 17783 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17784 NL80211_REGDOM_TYPE_COUNTRY) || 17785 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, 17786 request->alpha2)) 17787 goto nla_put_failure; 17788 } 17789 17790 if (request->wiphy_idx != WIPHY_IDX_INVALID) { 17791 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx); 17792 17793 if (wiphy && 17794 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx)) 17795 goto nla_put_failure; 17796 17797 if (wiphy && 17798 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 17799 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 17800 goto nla_put_failure; 17801 } 17802 17803 return true; 17804 17805 nla_put_failure: 17806 return false; 17807 } 17808 17809 /* 17810 * This can happen on global regulatory changes or device specific settings 17811 * based on custom regulatory domains. 17812 */ 17813 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id, 17814 struct regulatory_request *request) 17815 { 17816 struct sk_buff *msg; 17817 void *hdr; 17818 17819 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17820 if (!msg) 17821 return; 17822 17823 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id); 17824 if (!hdr) 17825 goto nla_put_failure; 17826 17827 if (!nl80211_reg_change_event_fill(msg, request)) 17828 goto nla_put_failure; 17829 17830 genlmsg_end(msg, hdr); 17831 17832 rcu_read_lock(); 17833 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 17834 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 17835 rcu_read_unlock(); 17836 17837 return; 17838 17839 nla_put_failure: 17840 nlmsg_free(msg); 17841 } 17842 17843 struct nl80211_mlme_event { 17844 enum nl80211_commands cmd; 17845 const u8 *buf; 17846 size_t buf_len; 17847 int uapsd_queues; 17848 const u8 *req_ies; 17849 size_t req_ies_len; 17850 bool reconnect; 17851 }; 17852 17853 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev, 17854 struct net_device *netdev, 17855 const struct nl80211_mlme_event *event, 17856 gfp_t gfp) 17857 { 17858 struct sk_buff *msg; 17859 void *hdr; 17860 17861 msg = nlmsg_new(100 + event->buf_len + event->req_ies_len, gfp); 17862 if (!msg) 17863 return; 17864 17865 hdr = nl80211hdr_put(msg, 0, 0, 0, event->cmd); 17866 if (!hdr) { 17867 nlmsg_free(msg); 17868 return; 17869 } 17870 17871 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17872 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 17873 nla_put(msg, NL80211_ATTR_FRAME, event->buf_len, event->buf) || 17874 (event->req_ies && 17875 nla_put(msg, NL80211_ATTR_REQ_IE, event->req_ies_len, 17876 event->req_ies))) 17877 goto nla_put_failure; 17878 17879 if (event->reconnect && 17880 nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED)) 17881 goto nla_put_failure; 17882 17883 if (event->uapsd_queues >= 0) { 17884 struct nlattr *nla_wmm = 17885 nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME); 17886 if (!nla_wmm) 17887 goto nla_put_failure; 17888 17889 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES, 17890 event->uapsd_queues)) 17891 goto nla_put_failure; 17892 17893 nla_nest_end(msg, nla_wmm); 17894 } 17895 17896 genlmsg_end(msg, hdr); 17897 17898 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17899 NL80211_MCGRP_MLME, gfp); 17900 return; 17901 17902 nla_put_failure: 17903 nlmsg_free(msg); 17904 } 17905 17906 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev, 17907 struct net_device *netdev, const u8 *buf, 17908 size_t len, gfp_t gfp) 17909 { 17910 struct nl80211_mlme_event event = { 17911 .cmd = NL80211_CMD_AUTHENTICATE, 17912 .buf = buf, 17913 .buf_len = len, 17914 .uapsd_queues = -1, 17915 }; 17916 17917 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 17918 } 17919 17920 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev, 17921 struct net_device *netdev, 17922 const struct cfg80211_rx_assoc_resp_data *data) 17923 { 17924 struct nl80211_mlme_event event = { 17925 .cmd = NL80211_CMD_ASSOCIATE, 17926 .buf = data->buf, 17927 .buf_len = data->len, 17928 .uapsd_queues = data->uapsd_queues, 17929 .req_ies = data->req_ies, 17930 .req_ies_len = data->req_ies_len, 17931 }; 17932 17933 nl80211_send_mlme_event(rdev, netdev, &event, GFP_KERNEL); 17934 } 17935 17936 void nl80211_send_deauth(struct cfg80211_registered_device *rdev, 17937 struct net_device *netdev, const u8 *buf, 17938 size_t len, bool reconnect, gfp_t gfp) 17939 { 17940 struct nl80211_mlme_event event = { 17941 .cmd = NL80211_CMD_DEAUTHENTICATE, 17942 .buf = buf, 17943 .buf_len = len, 17944 .reconnect = reconnect, 17945 .uapsd_queues = -1, 17946 }; 17947 17948 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 17949 } 17950 17951 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev, 17952 struct net_device *netdev, const u8 *buf, 17953 size_t len, bool reconnect, gfp_t gfp) 17954 { 17955 struct nl80211_mlme_event event = { 17956 .cmd = NL80211_CMD_DISASSOCIATE, 17957 .buf = buf, 17958 .buf_len = len, 17959 .reconnect = reconnect, 17960 .uapsd_queues = -1, 17961 }; 17962 17963 nl80211_send_mlme_event(rdev, netdev, &event, gfp); 17964 } 17965 17966 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf, 17967 size_t len) 17968 { 17969 struct wireless_dev *wdev = dev->ieee80211_ptr; 17970 struct wiphy *wiphy = wdev->wiphy; 17971 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 17972 const struct ieee80211_mgmt *mgmt = (void *)buf; 17973 struct nl80211_mlme_event event = { 17974 .buf = buf, 17975 .buf_len = len, 17976 .uapsd_queues = -1, 17977 }; 17978 17979 if (WARN_ON(len < 2)) 17980 return; 17981 17982 if (ieee80211_is_deauth(mgmt->frame_control)) { 17983 event.cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE; 17984 } else if (ieee80211_is_disassoc(mgmt->frame_control)) { 17985 event.cmd = NL80211_CMD_UNPROT_DISASSOCIATE; 17986 } else if (ieee80211_is_beacon(mgmt->frame_control)) { 17987 if (wdev->unprot_beacon_reported && 17988 elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000) 17989 return; 17990 event.cmd = NL80211_CMD_UNPROT_BEACON; 17991 wdev->unprot_beacon_reported = jiffies; 17992 } else { 17993 return; 17994 } 17995 17996 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len); 17997 nl80211_send_mlme_event(rdev, dev, &event, GFP_ATOMIC); 17998 } 17999 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt); 18000 18001 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev, 18002 struct net_device *netdev, int cmd, 18003 const u8 *addr, gfp_t gfp) 18004 { 18005 struct sk_buff *msg; 18006 void *hdr; 18007 18008 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18009 if (!msg) 18010 return; 18011 18012 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18013 if (!hdr) { 18014 nlmsg_free(msg); 18015 return; 18016 } 18017 18018 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18019 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18020 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 18021 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 18022 goto nla_put_failure; 18023 18024 genlmsg_end(msg, hdr); 18025 18026 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18027 NL80211_MCGRP_MLME, gfp); 18028 return; 18029 18030 nla_put_failure: 18031 nlmsg_free(msg); 18032 } 18033 18034 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev, 18035 struct net_device *netdev, const u8 *addr, 18036 gfp_t gfp) 18037 { 18038 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE, 18039 addr, gfp); 18040 } 18041 18042 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev, 18043 struct net_device *netdev, const u8 *addr, 18044 gfp_t gfp) 18045 { 18046 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE, 18047 addr, gfp); 18048 } 18049 18050 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev, 18051 struct net_device *netdev, 18052 struct cfg80211_connect_resp_params *cr, 18053 gfp_t gfp) 18054 { 18055 struct sk_buff *msg; 18056 void *hdr; 18057 unsigned int link; 18058 size_t link_info_size = 0; 18059 const u8 *connected_addr = cr->valid_links ? 18060 cr->ap_mld_addr : cr->links[0].bssid; 18061 18062 if (cr->valid_links) { 18063 for_each_valid_link(cr, link) { 18064 /* Nested attribute header */ 18065 link_info_size += NLA_HDRLEN; 18066 /* Link ID */ 18067 link_info_size += nla_total_size(sizeof(u8)); 18068 link_info_size += cr->links[link].addr ? 18069 nla_total_size(ETH_ALEN) : 0; 18070 link_info_size += (cr->links[link].bssid || 18071 cr->links[link].bss) ? 18072 nla_total_size(ETH_ALEN) : 0; 18073 link_info_size += nla_total_size(sizeof(u16)); 18074 } 18075 } 18076 18077 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len + 18078 cr->fils.kek_len + cr->fils.pmk_len + 18079 (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size, 18080 gfp); 18081 if (!msg) 18082 return; 18083 18084 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT); 18085 if (!hdr) { 18086 nlmsg_free(msg); 18087 return; 18088 } 18089 18090 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18091 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18092 (connected_addr && 18093 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) || 18094 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18095 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE : 18096 cr->status) || 18097 (cr->status < 0 && 18098 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 18099 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON, 18100 cr->timeout_reason))) || 18101 (cr->req_ie && 18102 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) || 18103 (cr->resp_ie && 18104 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len, 18105 cr->resp_ie)) || 18106 (cr->fils.update_erp_next_seq_num && 18107 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18108 cr->fils.erp_next_seq_num)) || 18109 (cr->status == WLAN_STATUS_SUCCESS && 18110 ((cr->fils.kek && 18111 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len, 18112 cr->fils.kek)) || 18113 (cr->fils.pmk && 18114 nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) || 18115 (cr->fils.pmkid && 18116 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid))))) 18117 goto nla_put_failure; 18118 18119 if (cr->valid_links) { 18120 int i = 1; 18121 struct nlattr *nested; 18122 18123 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18124 if (!nested) 18125 goto nla_put_failure; 18126 18127 for_each_valid_link(cr, link) { 18128 struct nlattr *nested_mlo_links; 18129 const u8 *bssid = cr->links[link].bss ? 18130 cr->links[link].bss->bssid : 18131 cr->links[link].bssid; 18132 18133 nested_mlo_links = nla_nest_start(msg, i); 18134 if (!nested_mlo_links) 18135 goto nla_put_failure; 18136 18137 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18138 (bssid && 18139 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18140 (cr->links[link].addr && 18141 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18142 cr->links[link].addr)) || 18143 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18144 cr->links[link].status)) 18145 goto nla_put_failure; 18146 18147 nla_nest_end(msg, nested_mlo_links); 18148 i++; 18149 } 18150 nla_nest_end(msg, nested); 18151 } 18152 18153 genlmsg_end(msg, hdr); 18154 18155 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18156 NL80211_MCGRP_MLME, gfp); 18157 return; 18158 18159 nla_put_failure: 18160 nlmsg_free(msg); 18161 } 18162 18163 void nl80211_send_roamed(struct cfg80211_registered_device *rdev, 18164 struct net_device *netdev, 18165 struct cfg80211_roam_info *info, gfp_t gfp) 18166 { 18167 struct sk_buff *msg; 18168 void *hdr; 18169 size_t link_info_size = 0; 18170 unsigned int link; 18171 const u8 *connected_addr = info->ap_mld_addr ? 18172 info->ap_mld_addr : 18173 (info->links[0].bss ? 18174 info->links[0].bss->bssid : 18175 info->links[0].bssid); 18176 18177 if (info->valid_links) { 18178 for_each_valid_link(info, link) { 18179 /* Nested attribute header */ 18180 link_info_size += NLA_HDRLEN; 18181 /* Link ID */ 18182 link_info_size += nla_total_size(sizeof(u8)); 18183 link_info_size += info->links[link].addr ? 18184 nla_total_size(ETH_ALEN) : 0; 18185 link_info_size += (info->links[link].bssid || 18186 info->links[link].bss) ? 18187 nla_total_size(ETH_ALEN) : 0; 18188 } 18189 } 18190 18191 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len + 18192 info->fils.kek_len + info->fils.pmk_len + 18193 (info->fils.pmkid ? WLAN_PMKID_LEN : 0) + 18194 link_info_size, gfp); 18195 if (!msg) 18196 return; 18197 18198 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM); 18199 if (!hdr) { 18200 nlmsg_free(msg); 18201 return; 18202 } 18203 18204 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18205 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18206 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) || 18207 (info->req_ie && 18208 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len, 18209 info->req_ie)) || 18210 (info->resp_ie && 18211 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len, 18212 info->resp_ie)) || 18213 (info->fils.update_erp_next_seq_num && 18214 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18215 info->fils.erp_next_seq_num)) || 18216 (info->fils.kek && 18217 nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len, 18218 info->fils.kek)) || 18219 (info->fils.pmk && 18220 nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) || 18221 (info->fils.pmkid && 18222 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid))) 18223 goto nla_put_failure; 18224 18225 if (info->valid_links) { 18226 int i = 1; 18227 struct nlattr *nested; 18228 18229 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18230 if (!nested) 18231 goto nla_put_failure; 18232 18233 for_each_valid_link(info, link) { 18234 struct nlattr *nested_mlo_links; 18235 const u8 *bssid = info->links[link].bss ? 18236 info->links[link].bss->bssid : 18237 info->links[link].bssid; 18238 18239 nested_mlo_links = nla_nest_start(msg, i); 18240 if (!nested_mlo_links) 18241 goto nla_put_failure; 18242 18243 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18244 (bssid && 18245 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18246 (info->links[link].addr && 18247 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18248 info->links[link].addr))) 18249 goto nla_put_failure; 18250 18251 nla_nest_end(msg, nested_mlo_links); 18252 i++; 18253 } 18254 nla_nest_end(msg, nested); 18255 } 18256 18257 genlmsg_end(msg, hdr); 18258 18259 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18260 NL80211_MCGRP_MLME, gfp); 18261 return; 18262 18263 nla_put_failure: 18264 nlmsg_free(msg); 18265 } 18266 18267 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev, 18268 struct net_device *netdev, const u8 *peer_addr, 18269 const u8 *td_bitmap, u8 td_bitmap_len) 18270 { 18271 struct sk_buff *msg; 18272 void *hdr; 18273 18274 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18275 if (!msg) 18276 return; 18277 18278 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED); 18279 if (!hdr) { 18280 nlmsg_free(msg); 18281 return; 18282 } 18283 18284 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18285 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18286 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr)) 18287 goto nla_put_failure; 18288 18289 if ((td_bitmap_len > 0) && td_bitmap) 18290 if (nla_put(msg, NL80211_ATTR_TD_BITMAP, 18291 td_bitmap_len, td_bitmap)) 18292 goto nla_put_failure; 18293 18294 genlmsg_end(msg, hdr); 18295 18296 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18297 NL80211_MCGRP_MLME, GFP_KERNEL); 18298 return; 18299 18300 nla_put_failure: 18301 nlmsg_free(msg); 18302 } 18303 18304 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev, 18305 struct net_device *netdev, u16 reason, 18306 const u8 *ie, size_t ie_len, bool from_ap) 18307 { 18308 struct sk_buff *msg; 18309 void *hdr; 18310 18311 msg = nlmsg_new(100 + ie_len, GFP_KERNEL); 18312 if (!msg) 18313 return; 18314 18315 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT); 18316 if (!hdr) { 18317 nlmsg_free(msg); 18318 return; 18319 } 18320 18321 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18322 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18323 (reason && 18324 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) || 18325 (from_ap && 18326 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) || 18327 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie))) 18328 goto nla_put_failure; 18329 18330 genlmsg_end(msg, hdr); 18331 18332 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18333 NL80211_MCGRP_MLME, GFP_KERNEL); 18334 return; 18335 18336 nla_put_failure: 18337 nlmsg_free(msg); 18338 } 18339 18340 void cfg80211_links_removed(struct net_device *dev, u16 link_mask) 18341 { 18342 struct wireless_dev *wdev = dev->ieee80211_ptr; 18343 struct wiphy *wiphy = wdev->wiphy; 18344 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18345 struct sk_buff *msg; 18346 struct nlattr *links; 18347 void *hdr; 18348 18349 lockdep_assert_wiphy(wdev->wiphy); 18350 trace_cfg80211_links_removed(dev, link_mask); 18351 18352 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION && 18353 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)) 18354 return; 18355 18356 if (WARN_ON(!wdev->valid_links || !link_mask || 18357 (wdev->valid_links & link_mask) != link_mask || 18358 wdev->valid_links == link_mask)) 18359 return; 18360 18361 cfg80211_wdev_release_link_bsses(wdev, link_mask); 18362 wdev->valid_links &= ~link_mask; 18363 18364 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18365 if (!msg) 18366 return; 18367 18368 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_LINKS_REMOVED); 18369 if (!hdr) { 18370 nlmsg_free(msg); 18371 return; 18372 } 18373 18374 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18375 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 18376 goto nla_put_failure; 18377 18378 links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18379 if (!links) 18380 goto nla_put_failure; 18381 18382 while (link_mask) { 18383 struct nlattr *link; 18384 int link_id = __ffs(link_mask); 18385 18386 link = nla_nest_start(msg, link_id + 1); 18387 if (!link) 18388 goto nla_put_failure; 18389 18390 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 18391 goto nla_put_failure; 18392 18393 nla_nest_end(msg, link); 18394 link_mask &= ~(1 << link_id); 18395 } 18396 18397 nla_nest_end(msg, links); 18398 18399 genlmsg_end(msg, hdr); 18400 18401 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18402 NL80211_MCGRP_MLME, GFP_KERNEL); 18403 return; 18404 18405 nla_put_failure: 18406 nlmsg_free(msg); 18407 } 18408 EXPORT_SYMBOL(cfg80211_links_removed); 18409 18410 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev, 18411 struct net_device *netdev, const u8 *bssid, 18412 gfp_t gfp) 18413 { 18414 struct sk_buff *msg; 18415 void *hdr; 18416 18417 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18418 if (!msg) 18419 return; 18420 18421 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS); 18422 if (!hdr) { 18423 nlmsg_free(msg); 18424 return; 18425 } 18426 18427 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18428 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18429 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 18430 goto nla_put_failure; 18431 18432 genlmsg_end(msg, hdr); 18433 18434 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18435 NL80211_MCGRP_MLME, gfp); 18436 return; 18437 18438 nla_put_failure: 18439 nlmsg_free(msg); 18440 } 18441 18442 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr, 18443 const u8 *ie, u8 ie_len, 18444 int sig_dbm, gfp_t gfp) 18445 { 18446 struct wireless_dev *wdev = dev->ieee80211_ptr; 18447 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18448 struct sk_buff *msg; 18449 void *hdr; 18450 18451 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT)) 18452 return; 18453 18454 trace_cfg80211_notify_new_peer_candidate(dev, addr); 18455 18456 msg = nlmsg_new(100 + ie_len, gfp); 18457 if (!msg) 18458 return; 18459 18460 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE); 18461 if (!hdr) { 18462 nlmsg_free(msg); 18463 return; 18464 } 18465 18466 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18467 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18468 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 18469 (ie_len && ie && 18470 nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) || 18471 (sig_dbm && 18472 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm))) 18473 goto nla_put_failure; 18474 18475 genlmsg_end(msg, hdr); 18476 18477 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18478 NL80211_MCGRP_MLME, gfp); 18479 return; 18480 18481 nla_put_failure: 18482 nlmsg_free(msg); 18483 } 18484 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate); 18485 18486 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev, 18487 struct net_device *netdev, const u8 *addr, 18488 enum nl80211_key_type key_type, int key_id, 18489 const u8 *tsc, gfp_t gfp) 18490 { 18491 struct sk_buff *msg; 18492 void *hdr; 18493 18494 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18495 if (!msg) 18496 return; 18497 18498 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE); 18499 if (!hdr) { 18500 nlmsg_free(msg); 18501 return; 18502 } 18503 18504 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18505 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18506 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) || 18507 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) || 18508 (key_id != -1 && 18509 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) || 18510 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc))) 18511 goto nla_put_failure; 18512 18513 genlmsg_end(msg, hdr); 18514 18515 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18516 NL80211_MCGRP_MLME, gfp); 18517 return; 18518 18519 nla_put_failure: 18520 nlmsg_free(msg); 18521 } 18522 18523 void nl80211_send_beacon_hint_event(struct wiphy *wiphy, 18524 struct ieee80211_channel *channel_before, 18525 struct ieee80211_channel *channel_after) 18526 { 18527 struct sk_buff *msg; 18528 void *hdr; 18529 struct nlattr *nl_freq; 18530 18531 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC); 18532 if (!msg) 18533 return; 18534 18535 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT); 18536 if (!hdr) { 18537 nlmsg_free(msg); 18538 return; 18539 } 18540 18541 /* 18542 * Since we are applying the beacon hint to a wiphy we know its 18543 * wiphy_idx is valid 18544 */ 18545 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 18546 goto nla_put_failure; 18547 18548 /* Before */ 18549 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE); 18550 if (!nl_freq) 18551 goto nla_put_failure; 18552 18553 if (nl80211_msg_put_channel(msg, wiphy, channel_before, false)) 18554 goto nla_put_failure; 18555 nla_nest_end(msg, nl_freq); 18556 18557 /* After */ 18558 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER); 18559 if (!nl_freq) 18560 goto nla_put_failure; 18561 18562 if (nl80211_msg_put_channel(msg, wiphy, channel_after, false)) 18563 goto nla_put_failure; 18564 nla_nest_end(msg, nl_freq); 18565 18566 genlmsg_end(msg, hdr); 18567 18568 rcu_read_lock(); 18569 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 18570 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 18571 rcu_read_unlock(); 18572 18573 return; 18574 18575 nla_put_failure: 18576 nlmsg_free(msg); 18577 } 18578 18579 static void nl80211_send_remain_on_chan_event( 18580 int cmd, struct cfg80211_registered_device *rdev, 18581 struct wireless_dev *wdev, u64 cookie, 18582 struct ieee80211_channel *chan, 18583 unsigned int duration, gfp_t gfp) 18584 { 18585 struct sk_buff *msg; 18586 void *hdr; 18587 18588 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18589 if (!msg) 18590 return; 18591 18592 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18593 if (!hdr) { 18594 nlmsg_free(msg); 18595 return; 18596 } 18597 18598 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18599 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18600 wdev->netdev->ifindex)) || 18601 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18602 NL80211_ATTR_PAD) || 18603 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) || 18604 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 18605 NL80211_CHAN_NO_HT) || 18606 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 18607 NL80211_ATTR_PAD)) 18608 goto nla_put_failure; 18609 18610 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL && 18611 nla_put_u32(msg, NL80211_ATTR_DURATION, duration)) 18612 goto nla_put_failure; 18613 18614 genlmsg_end(msg, hdr); 18615 18616 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18617 NL80211_MCGRP_MLME, gfp); 18618 return; 18619 18620 nla_put_failure: 18621 nlmsg_free(msg); 18622 } 18623 18624 void cfg80211_assoc_comeback(struct net_device *netdev, 18625 const u8 *ap_addr, u32 timeout) 18626 { 18627 struct wireless_dev *wdev = netdev->ieee80211_ptr; 18628 struct wiphy *wiphy = wdev->wiphy; 18629 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18630 struct sk_buff *msg; 18631 void *hdr; 18632 18633 trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout); 18634 18635 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18636 if (!msg) 18637 return; 18638 18639 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK); 18640 if (!hdr) { 18641 nlmsg_free(msg); 18642 return; 18643 } 18644 18645 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18646 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18647 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) || 18648 nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout)) 18649 goto nla_put_failure; 18650 18651 genlmsg_end(msg, hdr); 18652 18653 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18654 NL80211_MCGRP_MLME, GFP_KERNEL); 18655 return; 18656 18657 nla_put_failure: 18658 nlmsg_free(msg); 18659 } 18660 EXPORT_SYMBOL(cfg80211_assoc_comeback); 18661 18662 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie, 18663 struct ieee80211_channel *chan, 18664 unsigned int duration, gfp_t gfp) 18665 { 18666 struct wiphy *wiphy = wdev->wiphy; 18667 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18668 18669 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration); 18670 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL, 18671 rdev, wdev, cookie, chan, 18672 duration, gfp); 18673 } 18674 EXPORT_SYMBOL(cfg80211_ready_on_channel); 18675 18676 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie, 18677 struct ieee80211_channel *chan, 18678 gfp_t gfp) 18679 { 18680 struct wiphy *wiphy = wdev->wiphy; 18681 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18682 18683 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan); 18684 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 18685 rdev, wdev, cookie, chan, 0, gfp); 18686 } 18687 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired); 18688 18689 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie, 18690 struct ieee80211_channel *chan, 18691 gfp_t gfp) 18692 { 18693 struct wiphy *wiphy = wdev->wiphy; 18694 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18695 18696 trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan); 18697 nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL, 18698 rdev, wdev, cookie, chan, 0, gfp); 18699 } 18700 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired); 18701 18702 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr, 18703 struct station_info *sinfo, gfp_t gfp) 18704 { 18705 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18706 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18707 struct sk_buff *msg; 18708 18709 trace_cfg80211_new_sta(dev, mac_addr, sinfo); 18710 18711 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18712 if (!msg) 18713 return; 18714 18715 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0, 18716 rdev, dev, mac_addr, sinfo) < 0) { 18717 nlmsg_free(msg); 18718 return; 18719 } 18720 18721 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18722 NL80211_MCGRP_MLME, gfp); 18723 } 18724 EXPORT_SYMBOL(cfg80211_new_sta); 18725 18726 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr, 18727 struct station_info *sinfo, gfp_t gfp) 18728 { 18729 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18730 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18731 struct sk_buff *msg; 18732 struct station_info empty_sinfo = {}; 18733 18734 if (!sinfo) 18735 sinfo = &empty_sinfo; 18736 18737 trace_cfg80211_del_sta(dev, mac_addr); 18738 18739 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18740 if (!msg) { 18741 cfg80211_sinfo_release_content(sinfo); 18742 return; 18743 } 18744 18745 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0, 18746 rdev, dev, mac_addr, sinfo) < 0) { 18747 nlmsg_free(msg); 18748 return; 18749 } 18750 18751 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18752 NL80211_MCGRP_MLME, gfp); 18753 } 18754 EXPORT_SYMBOL(cfg80211_del_sta_sinfo); 18755 18756 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr, 18757 enum nl80211_connect_failed_reason reason, 18758 gfp_t gfp) 18759 { 18760 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18761 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18762 struct sk_buff *msg; 18763 void *hdr; 18764 18765 msg = nlmsg_new(NLMSG_GOODSIZE, gfp); 18766 if (!msg) 18767 return; 18768 18769 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED); 18770 if (!hdr) { 18771 nlmsg_free(msg); 18772 return; 18773 } 18774 18775 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18776 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 18777 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason)) 18778 goto nla_put_failure; 18779 18780 genlmsg_end(msg, hdr); 18781 18782 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18783 NL80211_MCGRP_MLME, gfp); 18784 return; 18785 18786 nla_put_failure: 18787 nlmsg_free(msg); 18788 } 18789 EXPORT_SYMBOL(cfg80211_conn_failed); 18790 18791 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd, 18792 const u8 *addr, gfp_t gfp) 18793 { 18794 struct wireless_dev *wdev = dev->ieee80211_ptr; 18795 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18796 struct sk_buff *msg; 18797 void *hdr; 18798 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid); 18799 18800 if (!nlportid) 18801 return false; 18802 18803 msg = nlmsg_new(100, gfp); 18804 if (!msg) 18805 return true; 18806 18807 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18808 if (!hdr) { 18809 nlmsg_free(msg); 18810 return true; 18811 } 18812 18813 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18814 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18815 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 18816 goto nla_put_failure; 18817 18818 genlmsg_end(msg, hdr); 18819 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 18820 return true; 18821 18822 nla_put_failure: 18823 nlmsg_free(msg); 18824 return true; 18825 } 18826 18827 bool cfg80211_rx_spurious_frame(struct net_device *dev, 18828 const u8 *addr, gfp_t gfp) 18829 { 18830 struct wireless_dev *wdev = dev->ieee80211_ptr; 18831 bool ret; 18832 18833 trace_cfg80211_rx_spurious_frame(dev, addr); 18834 18835 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 18836 wdev->iftype != NL80211_IFTYPE_P2P_GO)) { 18837 trace_cfg80211_return_bool(false); 18838 return false; 18839 } 18840 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME, 18841 addr, gfp); 18842 trace_cfg80211_return_bool(ret); 18843 return ret; 18844 } 18845 EXPORT_SYMBOL(cfg80211_rx_spurious_frame); 18846 18847 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev, 18848 const u8 *addr, gfp_t gfp) 18849 { 18850 struct wireless_dev *wdev = dev->ieee80211_ptr; 18851 bool ret; 18852 18853 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr); 18854 18855 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 18856 wdev->iftype != NL80211_IFTYPE_P2P_GO && 18857 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) { 18858 trace_cfg80211_return_bool(false); 18859 return false; 18860 } 18861 ret = __nl80211_unexpected_frame(dev, 18862 NL80211_CMD_UNEXPECTED_4ADDR_FRAME, 18863 addr, gfp); 18864 trace_cfg80211_return_bool(ret); 18865 return ret; 18866 } 18867 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame); 18868 18869 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev, 18870 struct wireless_dev *wdev, u32 nlportid, 18871 struct cfg80211_rx_info *info, gfp_t gfp) 18872 { 18873 struct net_device *netdev = wdev->netdev; 18874 struct sk_buff *msg; 18875 void *hdr; 18876 18877 msg = nlmsg_new(100 + info->len, gfp); 18878 if (!msg) 18879 return -ENOMEM; 18880 18881 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 18882 if (!hdr) { 18883 nlmsg_free(msg); 18884 return -ENOMEM; 18885 } 18886 18887 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18888 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18889 netdev->ifindex)) || 18890 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18891 NL80211_ATTR_PAD) || 18892 (info->have_link_id && 18893 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) || 18894 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) || 18895 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) || 18896 (info->sig_dbm && 18897 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) || 18898 nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) || 18899 (info->flags && 18900 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) || 18901 (info->rx_tstamp && nla_put_u64_64bit(msg, 18902 NL80211_ATTR_RX_HW_TIMESTAMP, 18903 info->rx_tstamp, 18904 NL80211_ATTR_PAD)) || 18905 (info->ack_tstamp && nla_put_u64_64bit(msg, 18906 NL80211_ATTR_TX_HW_TIMESTAMP, 18907 info->ack_tstamp, 18908 NL80211_ATTR_PAD))) 18909 goto nla_put_failure; 18910 18911 genlmsg_end(msg, hdr); 18912 18913 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 18914 18915 nla_put_failure: 18916 nlmsg_free(msg); 18917 return -ENOBUFS; 18918 } 18919 18920 static void nl80211_frame_tx_status(struct wireless_dev *wdev, 18921 struct cfg80211_tx_status *status, 18922 gfp_t gfp, enum nl80211_commands command) 18923 { 18924 struct wiphy *wiphy = wdev->wiphy; 18925 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18926 struct net_device *netdev = wdev->netdev; 18927 struct sk_buff *msg; 18928 void *hdr; 18929 18930 if (command == NL80211_CMD_FRAME_TX_STATUS) 18931 trace_cfg80211_mgmt_tx_status(wdev, status->cookie, 18932 status->ack); 18933 else 18934 trace_cfg80211_control_port_tx_status(wdev, status->cookie, 18935 status->ack); 18936 18937 msg = nlmsg_new(100 + status->len, gfp); 18938 if (!msg) 18939 return; 18940 18941 hdr = nl80211hdr_put(msg, 0, 0, 0, command); 18942 if (!hdr) { 18943 nlmsg_free(msg); 18944 return; 18945 } 18946 18947 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18948 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18949 netdev->ifindex)) || 18950 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18951 NL80211_ATTR_PAD) || 18952 nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) || 18953 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie, 18954 NL80211_ATTR_PAD) || 18955 (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) || 18956 (status->tx_tstamp && 18957 nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP, 18958 status->tx_tstamp, NL80211_ATTR_PAD)) || 18959 (status->ack_tstamp && 18960 nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP, 18961 status->ack_tstamp, NL80211_ATTR_PAD))) 18962 goto nla_put_failure; 18963 18964 genlmsg_end(msg, hdr); 18965 18966 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18967 NL80211_MCGRP_MLME, gfp); 18968 return; 18969 18970 nla_put_failure: 18971 nlmsg_free(msg); 18972 } 18973 18974 void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie, 18975 const u8 *buf, size_t len, bool ack, 18976 gfp_t gfp) 18977 { 18978 struct cfg80211_tx_status status = { 18979 .cookie = cookie, 18980 .buf = buf, 18981 .len = len, 18982 .ack = ack 18983 }; 18984 18985 nl80211_frame_tx_status(wdev, &status, gfp, 18986 NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS); 18987 } 18988 EXPORT_SYMBOL(cfg80211_control_port_tx_status); 18989 18990 void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev, 18991 struct cfg80211_tx_status *status, gfp_t gfp) 18992 { 18993 nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS); 18994 } 18995 EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext); 18996 18997 static int __nl80211_rx_control_port(struct net_device *dev, 18998 struct sk_buff *skb, 18999 bool unencrypted, 19000 int link_id, 19001 gfp_t gfp) 19002 { 19003 struct wireless_dev *wdev = dev->ieee80211_ptr; 19004 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19005 struct ethhdr *ehdr = eth_hdr(skb); 19006 const u8 *addr = ehdr->h_source; 19007 u16 proto = be16_to_cpu(skb->protocol); 19008 struct sk_buff *msg; 19009 void *hdr; 19010 struct nlattr *frame; 19011 19012 u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid); 19013 19014 if (!nlportid) 19015 return -ENOENT; 19016 19017 msg = nlmsg_new(100 + skb->len, gfp); 19018 if (!msg) 19019 return -ENOMEM; 19020 19021 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME); 19022 if (!hdr) { 19023 nlmsg_free(msg); 19024 return -ENOBUFS; 19025 } 19026 19027 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19028 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19029 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19030 NL80211_ATTR_PAD) || 19031 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19032 nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) || 19033 (link_id >= 0 && 19034 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) || 19035 (unencrypted && nla_put_flag(msg, 19036 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT))) 19037 goto nla_put_failure; 19038 19039 frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len); 19040 if (!frame) 19041 goto nla_put_failure; 19042 19043 skb_copy_bits(skb, 0, nla_data(frame), skb->len); 19044 genlmsg_end(msg, hdr); 19045 19046 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 19047 19048 nla_put_failure: 19049 nlmsg_free(msg); 19050 return -ENOBUFS; 19051 } 19052 19053 bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb, 19054 bool unencrypted, int link_id) 19055 { 19056 int ret; 19057 19058 trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id); 19059 ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id, 19060 GFP_ATOMIC); 19061 trace_cfg80211_return_bool(ret == 0); 19062 return ret == 0; 19063 } 19064 EXPORT_SYMBOL(cfg80211_rx_control_port); 19065 19066 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev, 19067 const char *mac, gfp_t gfp) 19068 { 19069 struct wireless_dev *wdev = dev->ieee80211_ptr; 19070 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19071 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19072 void **cb; 19073 19074 if (!msg) 19075 return NULL; 19076 19077 cb = (void **)msg->cb; 19078 19079 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM); 19080 if (!cb[0]) { 19081 nlmsg_free(msg); 19082 return NULL; 19083 } 19084 19085 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19086 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19087 goto nla_put_failure; 19088 19089 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 19090 goto nla_put_failure; 19091 19092 cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM); 19093 if (!cb[1]) 19094 goto nla_put_failure; 19095 19096 cb[2] = rdev; 19097 19098 return msg; 19099 nla_put_failure: 19100 nlmsg_free(msg); 19101 return NULL; 19102 } 19103 19104 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp) 19105 { 19106 void **cb = (void **)msg->cb; 19107 struct cfg80211_registered_device *rdev = cb[2]; 19108 19109 nla_nest_end(msg, cb[1]); 19110 genlmsg_end(msg, cb[0]); 19111 19112 memset(msg->cb, 0, sizeof(msg->cb)); 19113 19114 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19115 NL80211_MCGRP_MLME, gfp); 19116 } 19117 19118 void cfg80211_cqm_rssi_notify(struct net_device *dev, 19119 enum nl80211_cqm_rssi_threshold_event rssi_event, 19120 s32 rssi_level, gfp_t gfp) 19121 { 19122 struct wireless_dev *wdev = dev->ieee80211_ptr; 19123 struct cfg80211_cqm_config *cqm_config; 19124 19125 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level); 19126 19127 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW && 19128 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH)) 19129 return; 19130 19131 rcu_read_lock(); 19132 cqm_config = rcu_dereference(wdev->cqm_config); 19133 if (cqm_config) { 19134 cqm_config->last_rssi_event_value = rssi_level; 19135 cqm_config->last_rssi_event_type = rssi_event; 19136 wiphy_work_queue(wdev->wiphy, &wdev->cqm_rssi_work); 19137 } 19138 rcu_read_unlock(); 19139 } 19140 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify); 19141 19142 void cfg80211_cqm_rssi_notify_work(struct wiphy *wiphy, struct wiphy_work *work) 19143 { 19144 struct wireless_dev *wdev = container_of(work, struct wireless_dev, 19145 cqm_rssi_work); 19146 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19147 enum nl80211_cqm_rssi_threshold_event rssi_event; 19148 struct cfg80211_cqm_config *cqm_config; 19149 struct sk_buff *msg; 19150 s32 rssi_level; 19151 19152 cqm_config = wiphy_dereference(wdev->wiphy, wdev->cqm_config); 19153 if (!cqm_config) 19154 return; 19155 19156 if (cqm_config->use_range_api) 19157 cfg80211_cqm_rssi_update(rdev, wdev->netdev, cqm_config); 19158 19159 rssi_level = cqm_config->last_rssi_event_value; 19160 rssi_event = cqm_config->last_rssi_event_type; 19161 19162 msg = cfg80211_prepare_cqm(wdev->netdev, NULL, GFP_KERNEL); 19163 if (!msg) 19164 return; 19165 19166 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT, 19167 rssi_event)) 19168 goto nla_put_failure; 19169 19170 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL, 19171 rssi_level)) 19172 goto nla_put_failure; 19173 19174 cfg80211_send_cqm(msg, GFP_KERNEL); 19175 19176 return; 19177 19178 nla_put_failure: 19179 nlmsg_free(msg); 19180 } 19181 19182 void cfg80211_cqm_txe_notify(struct net_device *dev, 19183 const u8 *peer, u32 num_packets, 19184 u32 rate, u32 intvl, gfp_t gfp) 19185 { 19186 struct sk_buff *msg; 19187 19188 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19189 if (!msg) 19190 return; 19191 19192 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets)) 19193 goto nla_put_failure; 19194 19195 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate)) 19196 goto nla_put_failure; 19197 19198 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl)) 19199 goto nla_put_failure; 19200 19201 cfg80211_send_cqm(msg, gfp); 19202 return; 19203 19204 nla_put_failure: 19205 nlmsg_free(msg); 19206 } 19207 EXPORT_SYMBOL(cfg80211_cqm_txe_notify); 19208 19209 void cfg80211_cqm_pktloss_notify(struct net_device *dev, 19210 const u8 *peer, u32 num_packets, gfp_t gfp) 19211 { 19212 struct sk_buff *msg; 19213 19214 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets); 19215 19216 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19217 if (!msg) 19218 return; 19219 19220 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets)) 19221 goto nla_put_failure; 19222 19223 cfg80211_send_cqm(msg, gfp); 19224 return; 19225 19226 nla_put_failure: 19227 nlmsg_free(msg); 19228 } 19229 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify); 19230 19231 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp) 19232 { 19233 struct sk_buff *msg; 19234 19235 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 19236 if (!msg) 19237 return; 19238 19239 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT)) 19240 goto nla_put_failure; 19241 19242 cfg80211_send_cqm(msg, gfp); 19243 return; 19244 19245 nla_put_failure: 19246 nlmsg_free(msg); 19247 } 19248 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify); 19249 19250 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev, 19251 struct net_device *netdev, const u8 *bssid, 19252 const u8 *replay_ctr, gfp_t gfp) 19253 { 19254 struct sk_buff *msg; 19255 struct nlattr *rekey_attr; 19256 void *hdr; 19257 19258 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19259 if (!msg) 19260 return; 19261 19262 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD); 19263 if (!hdr) { 19264 nlmsg_free(msg); 19265 return; 19266 } 19267 19268 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19269 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19270 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 19271 goto nla_put_failure; 19272 19273 rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA); 19274 if (!rekey_attr) 19275 goto nla_put_failure; 19276 19277 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR, 19278 NL80211_REPLAY_CTR_LEN, replay_ctr)) 19279 goto nla_put_failure; 19280 19281 nla_nest_end(msg, rekey_attr); 19282 19283 genlmsg_end(msg, hdr); 19284 19285 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19286 NL80211_MCGRP_MLME, gfp); 19287 return; 19288 19289 nla_put_failure: 19290 nlmsg_free(msg); 19291 } 19292 19293 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid, 19294 const u8 *replay_ctr, gfp_t gfp) 19295 { 19296 struct wireless_dev *wdev = dev->ieee80211_ptr; 19297 struct wiphy *wiphy = wdev->wiphy; 19298 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19299 19300 trace_cfg80211_gtk_rekey_notify(dev, bssid); 19301 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp); 19302 } 19303 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify); 19304 19305 static void 19306 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev, 19307 struct net_device *netdev, int index, 19308 const u8 *bssid, bool preauth, gfp_t gfp) 19309 { 19310 struct sk_buff *msg; 19311 struct nlattr *attr; 19312 void *hdr; 19313 19314 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19315 if (!msg) 19316 return; 19317 19318 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE); 19319 if (!hdr) { 19320 nlmsg_free(msg); 19321 return; 19322 } 19323 19324 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19325 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19326 goto nla_put_failure; 19327 19328 attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE); 19329 if (!attr) 19330 goto nla_put_failure; 19331 19332 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) || 19333 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) || 19334 (preauth && 19335 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH))) 19336 goto nla_put_failure; 19337 19338 nla_nest_end(msg, attr); 19339 19340 genlmsg_end(msg, hdr); 19341 19342 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19343 NL80211_MCGRP_MLME, gfp); 19344 return; 19345 19346 nla_put_failure: 19347 nlmsg_free(msg); 19348 } 19349 19350 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index, 19351 const u8 *bssid, bool preauth, gfp_t gfp) 19352 { 19353 struct wireless_dev *wdev = dev->ieee80211_ptr; 19354 struct wiphy *wiphy = wdev->wiphy; 19355 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19356 19357 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth); 19358 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp); 19359 } 19360 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify); 19361 19362 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev, 19363 struct net_device *netdev, 19364 unsigned int link_id, 19365 struct cfg80211_chan_def *chandef, 19366 gfp_t gfp, 19367 enum nl80211_commands notif, 19368 u8 count, bool quiet) 19369 { 19370 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19371 struct sk_buff *msg; 19372 void *hdr; 19373 19374 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19375 if (!msg) 19376 return; 19377 19378 hdr = nl80211hdr_put(msg, 0, 0, 0, notif); 19379 if (!hdr) { 19380 nlmsg_free(msg); 19381 return; 19382 } 19383 19384 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19385 goto nla_put_failure; 19386 19387 if (wdev->valid_links && 19388 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19389 goto nla_put_failure; 19390 19391 if (nl80211_send_chandef(msg, chandef)) 19392 goto nla_put_failure; 19393 19394 if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) { 19395 if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)) 19396 goto nla_put_failure; 19397 if (quiet && 19398 nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX)) 19399 goto nla_put_failure; 19400 } 19401 19402 genlmsg_end(msg, hdr); 19403 19404 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19405 NL80211_MCGRP_MLME, gfp); 19406 return; 19407 19408 nla_put_failure: 19409 nlmsg_free(msg); 19410 } 19411 19412 void cfg80211_ch_switch_notify(struct net_device *dev, 19413 struct cfg80211_chan_def *chandef, 19414 unsigned int link_id) 19415 { 19416 struct wireless_dev *wdev = dev->ieee80211_ptr; 19417 struct wiphy *wiphy = wdev->wiphy; 19418 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19419 19420 lockdep_assert_wiphy(wdev->wiphy); 19421 WARN_INVALID_LINK_ID(wdev, link_id); 19422 19423 trace_cfg80211_ch_switch_notify(dev, chandef, link_id); 19424 19425 switch (wdev->iftype) { 19426 case NL80211_IFTYPE_STATION: 19427 case NL80211_IFTYPE_P2P_CLIENT: 19428 if (!WARN_ON(!wdev->links[link_id].client.current_bss)) 19429 cfg80211_update_assoc_bss_entry(wdev, link_id, 19430 chandef->chan); 19431 break; 19432 case NL80211_IFTYPE_MESH_POINT: 19433 wdev->u.mesh.chandef = *chandef; 19434 wdev->u.mesh.preset_chandef = *chandef; 19435 break; 19436 case NL80211_IFTYPE_AP: 19437 case NL80211_IFTYPE_P2P_GO: 19438 wdev->links[link_id].ap.chandef = *chandef; 19439 break; 19440 case NL80211_IFTYPE_ADHOC: 19441 wdev->u.ibss.chandef = *chandef; 19442 break; 19443 default: 19444 WARN_ON(1); 19445 break; 19446 } 19447 19448 cfg80211_schedule_channels_check(wdev); 19449 cfg80211_sched_dfs_chan_update(rdev); 19450 19451 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19452 NL80211_CMD_CH_SWITCH_NOTIFY, 0, false); 19453 } 19454 EXPORT_SYMBOL(cfg80211_ch_switch_notify); 19455 19456 void cfg80211_ch_switch_started_notify(struct net_device *dev, 19457 struct cfg80211_chan_def *chandef, 19458 unsigned int link_id, u8 count, 19459 bool quiet) 19460 { 19461 struct wireless_dev *wdev = dev->ieee80211_ptr; 19462 struct wiphy *wiphy = wdev->wiphy; 19463 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19464 19465 lockdep_assert_wiphy(wdev->wiphy); 19466 WARN_INVALID_LINK_ID(wdev, link_id); 19467 19468 trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id); 19469 19470 19471 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19472 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, 19473 count, quiet); 19474 } 19475 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify); 19476 19477 int cfg80211_bss_color_notify(struct net_device *dev, 19478 enum nl80211_commands cmd, u8 count, 19479 u64 color_bitmap) 19480 { 19481 struct wireless_dev *wdev = dev->ieee80211_ptr; 19482 struct wiphy *wiphy = wdev->wiphy; 19483 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19484 struct sk_buff *msg; 19485 void *hdr; 19486 19487 lockdep_assert_wiphy(wdev->wiphy); 19488 19489 trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap); 19490 19491 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19492 if (!msg) 19493 return -ENOMEM; 19494 19495 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19496 if (!hdr) 19497 goto nla_put_failure; 19498 19499 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19500 goto nla_put_failure; 19501 19502 if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED && 19503 nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count)) 19504 goto nla_put_failure; 19505 19506 if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION && 19507 nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP, 19508 color_bitmap, NL80211_ATTR_PAD)) 19509 goto nla_put_failure; 19510 19511 genlmsg_end(msg, hdr); 19512 19513 return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 19514 msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL); 19515 19516 nla_put_failure: 19517 nlmsg_free(msg); 19518 return -EINVAL; 19519 } 19520 EXPORT_SYMBOL(cfg80211_bss_color_notify); 19521 19522 void 19523 nl80211_radar_notify(struct cfg80211_registered_device *rdev, 19524 const struct cfg80211_chan_def *chandef, 19525 enum nl80211_radar_event event, 19526 struct net_device *netdev, gfp_t gfp) 19527 { 19528 struct sk_buff *msg; 19529 void *hdr; 19530 19531 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19532 if (!msg) 19533 return; 19534 19535 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT); 19536 if (!hdr) { 19537 nlmsg_free(msg); 19538 return; 19539 } 19540 19541 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19542 goto nla_put_failure; 19543 19544 /* NOP and radar events don't need a netdev parameter */ 19545 if (netdev) { 19546 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19547 19548 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19549 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19550 NL80211_ATTR_PAD)) 19551 goto nla_put_failure; 19552 } 19553 19554 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event)) 19555 goto nla_put_failure; 19556 19557 if (nl80211_send_chandef(msg, chandef)) 19558 goto nla_put_failure; 19559 19560 genlmsg_end(msg, hdr); 19561 19562 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19563 NL80211_MCGRP_MLME, gfp); 19564 return; 19565 19566 nla_put_failure: 19567 nlmsg_free(msg); 19568 } 19569 19570 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac, 19571 struct sta_opmode_info *sta_opmode, 19572 gfp_t gfp) 19573 { 19574 struct sk_buff *msg; 19575 struct wireless_dev *wdev = dev->ieee80211_ptr; 19576 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19577 void *hdr; 19578 19579 if (WARN_ON(!mac)) 19580 return; 19581 19582 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19583 if (!msg) 19584 return; 19585 19586 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED); 19587 if (!hdr) { 19588 nlmsg_free(msg); 19589 return; 19590 } 19591 19592 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19593 goto nla_put_failure; 19594 19595 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19596 goto nla_put_failure; 19597 19598 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 19599 goto nla_put_failure; 19600 19601 if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) && 19602 nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode)) 19603 goto nla_put_failure; 19604 19605 if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) && 19606 nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw)) 19607 goto nla_put_failure; 19608 19609 if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) && 19610 nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss)) 19611 goto nla_put_failure; 19612 19613 genlmsg_end(msg, hdr); 19614 19615 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19616 NL80211_MCGRP_MLME, gfp); 19617 19618 return; 19619 19620 nla_put_failure: 19621 nlmsg_free(msg); 19622 } 19623 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify); 19624 19625 void cfg80211_probe_status(struct net_device *dev, const u8 *addr, 19626 u64 cookie, bool acked, s32 ack_signal, 19627 bool is_valid_ack_signal, gfp_t gfp) 19628 { 19629 struct wireless_dev *wdev = dev->ieee80211_ptr; 19630 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19631 struct sk_buff *msg; 19632 void *hdr; 19633 19634 trace_cfg80211_probe_status(dev, addr, cookie, acked); 19635 19636 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19637 19638 if (!msg) 19639 return; 19640 19641 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT); 19642 if (!hdr) { 19643 nlmsg_free(msg); 19644 return; 19645 } 19646 19647 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19648 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19649 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19650 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 19651 NL80211_ATTR_PAD) || 19652 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) || 19653 (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL, 19654 ack_signal))) 19655 goto nla_put_failure; 19656 19657 genlmsg_end(msg, hdr); 19658 19659 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19660 NL80211_MCGRP_MLME, gfp); 19661 return; 19662 19663 nla_put_failure: 19664 nlmsg_free(msg); 19665 } 19666 EXPORT_SYMBOL(cfg80211_probe_status); 19667 19668 void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame, 19669 size_t len, int freq, int sig_dbm) 19670 { 19671 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19672 struct sk_buff *msg; 19673 void *hdr; 19674 struct cfg80211_beacon_registration *reg; 19675 19676 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm); 19677 19678 spin_lock_bh(&rdev->beacon_registrations_lock); 19679 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 19680 msg = nlmsg_new(len + 100, GFP_ATOMIC); 19681 if (!msg) { 19682 spin_unlock_bh(&rdev->beacon_registrations_lock); 19683 return; 19684 } 19685 19686 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 19687 if (!hdr) 19688 goto nla_put_failure; 19689 19690 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19691 (freq && 19692 (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 19693 KHZ_TO_MHZ(freq)) || 19694 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 19695 freq % 1000))) || 19696 (sig_dbm && 19697 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 19698 nla_put(msg, NL80211_ATTR_FRAME, len, frame)) 19699 goto nla_put_failure; 19700 19701 genlmsg_end(msg, hdr); 19702 19703 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid); 19704 } 19705 spin_unlock_bh(&rdev->beacon_registrations_lock); 19706 return; 19707 19708 nla_put_failure: 19709 spin_unlock_bh(&rdev->beacon_registrations_lock); 19710 nlmsg_free(msg); 19711 } 19712 EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz); 19713 19714 #ifdef CONFIG_PM 19715 static int cfg80211_net_detect_results(struct sk_buff *msg, 19716 struct cfg80211_wowlan_wakeup *wakeup) 19717 { 19718 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect; 19719 struct nlattr *nl_results, *nl_match, *nl_freqs; 19720 int i, j; 19721 19722 nl_results = nla_nest_start_noflag(msg, 19723 NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS); 19724 if (!nl_results) 19725 return -EMSGSIZE; 19726 19727 for (i = 0; i < nd->n_matches; i++) { 19728 struct cfg80211_wowlan_nd_match *match = nd->matches[i]; 19729 19730 nl_match = nla_nest_start_noflag(msg, i); 19731 if (!nl_match) 19732 break; 19733 19734 /* The SSID attribute is optional in nl80211, but for 19735 * simplicity reasons it's always present in the 19736 * cfg80211 structure. If a driver can't pass the 19737 * SSID, that needs to be changed. A zero length SSID 19738 * is still a valid SSID (wildcard), so it cannot be 19739 * used for this purpose. 19740 */ 19741 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len, 19742 match->ssid.ssid)) { 19743 nla_nest_cancel(msg, nl_match); 19744 goto out; 19745 } 19746 19747 if (match->n_channels) { 19748 nl_freqs = nla_nest_start_noflag(msg, 19749 NL80211_ATTR_SCAN_FREQUENCIES); 19750 if (!nl_freqs) { 19751 nla_nest_cancel(msg, nl_match); 19752 goto out; 19753 } 19754 19755 for (j = 0; j < match->n_channels; j++) { 19756 if (nla_put_u32(msg, j, match->channels[j])) { 19757 nla_nest_cancel(msg, nl_freqs); 19758 nla_nest_cancel(msg, nl_match); 19759 goto out; 19760 } 19761 } 19762 19763 nla_nest_end(msg, nl_freqs); 19764 } 19765 19766 nla_nest_end(msg, nl_match); 19767 } 19768 19769 out: 19770 nla_nest_end(msg, nl_results); 19771 return 0; 19772 } 19773 19774 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev, 19775 struct cfg80211_wowlan_wakeup *wakeup, 19776 gfp_t gfp) 19777 { 19778 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19779 struct sk_buff *msg; 19780 void *hdr; 19781 int size = 200; 19782 19783 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup); 19784 19785 if (wakeup) 19786 size += wakeup->packet_present_len; 19787 19788 msg = nlmsg_new(size, gfp); 19789 if (!msg) 19790 return; 19791 19792 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN); 19793 if (!hdr) 19794 goto free_msg; 19795 19796 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19797 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19798 NL80211_ATTR_PAD)) 19799 goto free_msg; 19800 19801 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 19802 wdev->netdev->ifindex)) 19803 goto free_msg; 19804 19805 if (wakeup) { 19806 struct nlattr *reasons; 19807 19808 reasons = nla_nest_start_noflag(msg, 19809 NL80211_ATTR_WOWLAN_TRIGGERS); 19810 if (!reasons) 19811 goto free_msg; 19812 19813 if (wakeup->disconnect && 19814 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) 19815 goto free_msg; 19816 if (wakeup->magic_pkt && 19817 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) 19818 goto free_msg; 19819 if (wakeup->gtk_rekey_failure && 19820 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) 19821 goto free_msg; 19822 if (wakeup->eap_identity_req && 19823 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) 19824 goto free_msg; 19825 if (wakeup->four_way_handshake && 19826 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) 19827 goto free_msg; 19828 if (wakeup->rfkill_release && 19829 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)) 19830 goto free_msg; 19831 19832 if (wakeup->pattern_idx >= 0 && 19833 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 19834 wakeup->pattern_idx)) 19835 goto free_msg; 19836 19837 if (wakeup->tcp_match && 19838 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH)) 19839 goto free_msg; 19840 19841 if (wakeup->tcp_connlost && 19842 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST)) 19843 goto free_msg; 19844 19845 if (wakeup->tcp_nomoretokens && 19846 nla_put_flag(msg, 19847 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS)) 19848 goto free_msg; 19849 19850 if (wakeup->unprot_deauth_disassoc && 19851 nla_put_flag(msg, 19852 NL80211_WOWLAN_TRIG_UNPROTECTED_DEAUTH_DISASSOC)) 19853 goto free_msg; 19854 19855 if (wakeup->packet) { 19856 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211; 19857 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN; 19858 19859 if (!wakeup->packet_80211) { 19860 pkt_attr = 19861 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023; 19862 len_attr = 19863 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN; 19864 } 19865 19866 if (wakeup->packet_len && 19867 nla_put_u32(msg, len_attr, wakeup->packet_len)) 19868 goto free_msg; 19869 19870 if (nla_put(msg, pkt_attr, wakeup->packet_present_len, 19871 wakeup->packet)) 19872 goto free_msg; 19873 } 19874 19875 if (wakeup->net_detect && 19876 cfg80211_net_detect_results(msg, wakeup)) 19877 goto free_msg; 19878 19879 nla_nest_end(msg, reasons); 19880 } 19881 19882 genlmsg_end(msg, hdr); 19883 19884 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19885 NL80211_MCGRP_MLME, gfp); 19886 return; 19887 19888 free_msg: 19889 nlmsg_free(msg); 19890 } 19891 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup); 19892 #endif 19893 19894 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer, 19895 enum nl80211_tdls_operation oper, 19896 u16 reason_code, gfp_t gfp) 19897 { 19898 struct wireless_dev *wdev = dev->ieee80211_ptr; 19899 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19900 struct sk_buff *msg; 19901 void *hdr; 19902 19903 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper, 19904 reason_code); 19905 19906 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19907 if (!msg) 19908 return; 19909 19910 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER); 19911 if (!hdr) { 19912 nlmsg_free(msg); 19913 return; 19914 } 19915 19916 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19917 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19918 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) || 19919 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) || 19920 (reason_code > 0 && 19921 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code))) 19922 goto nla_put_failure; 19923 19924 genlmsg_end(msg, hdr); 19925 19926 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19927 NL80211_MCGRP_MLME, gfp); 19928 return; 19929 19930 nla_put_failure: 19931 nlmsg_free(msg); 19932 } 19933 EXPORT_SYMBOL(cfg80211_tdls_oper_request); 19934 19935 static int nl80211_netlink_notify(struct notifier_block * nb, 19936 unsigned long state, 19937 void *_notify) 19938 { 19939 struct netlink_notify *notify = _notify; 19940 struct cfg80211_registered_device *rdev; 19941 struct wireless_dev *wdev; 19942 struct cfg80211_beacon_registration *reg, *tmp; 19943 19944 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC) 19945 return NOTIFY_DONE; 19946 19947 rcu_read_lock(); 19948 19949 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 19950 struct cfg80211_sched_scan_request *sched_scan_req; 19951 19952 list_for_each_entry_rcu(sched_scan_req, 19953 &rdev->sched_scan_req_list, 19954 list) { 19955 if (sched_scan_req->owner_nlportid == notify->portid) { 19956 sched_scan_req->nl_owner_dead = true; 19957 wiphy_work_queue(&rdev->wiphy, 19958 &rdev->sched_scan_stop_wk); 19959 } 19960 } 19961 19962 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) { 19963 cfg80211_mlme_unregister_socket(wdev, notify->portid); 19964 19965 if (wdev->owner_nlportid == notify->portid) { 19966 wdev->nl_owner_dead = true; 19967 schedule_work(&rdev->destroy_work); 19968 } else if (wdev->conn_owner_nlportid == notify->portid) { 19969 schedule_work(&wdev->disconnect_wk); 19970 } 19971 19972 cfg80211_release_pmsr(wdev, notify->portid); 19973 } 19974 19975 spin_lock_bh(&rdev->beacon_registrations_lock); 19976 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations, 19977 list) { 19978 if (reg->nlportid == notify->portid) { 19979 list_del(®->list); 19980 kfree(reg); 19981 break; 19982 } 19983 } 19984 spin_unlock_bh(&rdev->beacon_registrations_lock); 19985 } 19986 19987 rcu_read_unlock(); 19988 19989 /* 19990 * It is possible that the user space process that is controlling the 19991 * indoor setting disappeared, so notify the regulatory core. 19992 */ 19993 regulatory_netlink_notify(notify->portid); 19994 return NOTIFY_OK; 19995 } 19996 19997 static struct notifier_block nl80211_netlink_notifier = { 19998 .notifier_call = nl80211_netlink_notify, 19999 }; 20000 20001 void cfg80211_ft_event(struct net_device *netdev, 20002 struct cfg80211_ft_event_params *ft_event) 20003 { 20004 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 20005 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20006 struct sk_buff *msg; 20007 void *hdr; 20008 20009 trace_cfg80211_ft_event(wiphy, netdev, ft_event); 20010 20011 if (!ft_event->target_ap) 20012 return; 20013 20014 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len, 20015 GFP_KERNEL); 20016 if (!msg) 20017 return; 20018 20019 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT); 20020 if (!hdr) 20021 goto out; 20022 20023 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20024 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20025 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap)) 20026 goto out; 20027 20028 if (ft_event->ies && 20029 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies)) 20030 goto out; 20031 if (ft_event->ric_ies && 20032 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len, 20033 ft_event->ric_ies)) 20034 goto out; 20035 20036 genlmsg_end(msg, hdr); 20037 20038 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20039 NL80211_MCGRP_MLME, GFP_KERNEL); 20040 return; 20041 out: 20042 nlmsg_free(msg); 20043 } 20044 EXPORT_SYMBOL(cfg80211_ft_event); 20045 20046 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp) 20047 { 20048 struct cfg80211_registered_device *rdev; 20049 struct sk_buff *msg; 20050 void *hdr; 20051 u32 nlportid; 20052 20053 rdev = wiphy_to_rdev(wdev->wiphy); 20054 if (!rdev->crit_proto_nlportid) 20055 return; 20056 20057 nlportid = rdev->crit_proto_nlportid; 20058 rdev->crit_proto_nlportid = 0; 20059 20060 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20061 if (!msg) 20062 return; 20063 20064 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP); 20065 if (!hdr) 20066 goto nla_put_failure; 20067 20068 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20069 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20070 NL80211_ATTR_PAD)) 20071 goto nla_put_failure; 20072 20073 genlmsg_end(msg, hdr); 20074 20075 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 20076 return; 20077 20078 nla_put_failure: 20079 nlmsg_free(msg); 20080 } 20081 EXPORT_SYMBOL(cfg80211_crit_proto_stopped); 20082 20083 void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id) 20084 { 20085 struct wiphy *wiphy = wdev->wiphy; 20086 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20087 struct sk_buff *msg; 20088 void *hdr; 20089 20090 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 20091 if (!msg) 20092 return; 20093 20094 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP); 20095 if (!hdr) 20096 goto out; 20097 20098 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20099 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 20100 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 20101 NL80211_ATTR_PAD) || 20102 (wdev->valid_links && 20103 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 20104 goto out; 20105 20106 genlmsg_end(msg, hdr); 20107 20108 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 20109 NL80211_MCGRP_MLME, GFP_KERNEL); 20110 return; 20111 out: 20112 nlmsg_free(msg); 20113 } 20114 20115 int cfg80211_external_auth_request(struct net_device *dev, 20116 struct cfg80211_external_auth_params *params, 20117 gfp_t gfp) 20118 { 20119 struct wireless_dev *wdev = dev->ieee80211_ptr; 20120 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 20121 struct sk_buff *msg; 20122 void *hdr; 20123 20124 if (!wdev->conn_owner_nlportid) 20125 return -EINVAL; 20126 20127 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20128 if (!msg) 20129 return -ENOMEM; 20130 20131 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH); 20132 if (!hdr) 20133 goto nla_put_failure; 20134 20135 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20136 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 20137 nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) || 20138 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION, 20139 params->action) || 20140 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) || 20141 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len, 20142 params->ssid.ssid) || 20143 (!is_zero_ether_addr(params->mld_addr) && 20144 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr))) 20145 goto nla_put_failure; 20146 20147 genlmsg_end(msg, hdr); 20148 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 20149 wdev->conn_owner_nlportid); 20150 return 0; 20151 20152 nla_put_failure: 20153 nlmsg_free(msg); 20154 return -ENOBUFS; 20155 } 20156 EXPORT_SYMBOL(cfg80211_external_auth_request); 20157 20158 void cfg80211_update_owe_info_event(struct net_device *netdev, 20159 struct cfg80211_update_owe_info *owe_info, 20160 gfp_t gfp) 20161 { 20162 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 20163 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 20164 struct sk_buff *msg; 20165 void *hdr; 20166 20167 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info); 20168 20169 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 20170 if (!msg) 20171 return; 20172 20173 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO); 20174 if (!hdr) 20175 goto nla_put_failure; 20176 20177 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20178 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20179 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer)) 20180 goto nla_put_failure; 20181 20182 if (!owe_info->ie_len || 20183 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie)) 20184 goto nla_put_failure; 20185 20186 if (owe_info->assoc_link_id != -1) { 20187 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 20188 owe_info->assoc_link_id)) 20189 goto nla_put_failure; 20190 20191 if (!is_zero_ether_addr(owe_info->peer_mld_addr) && 20192 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 20193 owe_info->peer_mld_addr)) 20194 goto nla_put_failure; 20195 } 20196 20197 genlmsg_end(msg, hdr); 20198 20199 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20200 NL80211_MCGRP_MLME, gfp); 20201 return; 20202 20203 nla_put_failure: 20204 genlmsg_cancel(msg, hdr); 20205 nlmsg_free(msg); 20206 } 20207 EXPORT_SYMBOL(cfg80211_update_owe_info_event); 20208 20209 void cfg80211_schedule_channels_check(struct wireless_dev *wdev) 20210 { 20211 struct wiphy *wiphy = wdev->wiphy; 20212 20213 /* Schedule channels check if NO_IR or DFS relaxations are supported */ 20214 if (wdev->iftype == NL80211_IFTYPE_STATION && 20215 (wiphy_ext_feature_isset(wiphy, 20216 NL80211_EXT_FEATURE_DFS_CONCURRENT) || 20217 (IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) && 20218 wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR))) 20219 reg_check_channels(); 20220 } 20221 EXPORT_SYMBOL(cfg80211_schedule_channels_check); 20222 20223 /* initialisation/exit functions */ 20224 20225 int __init nl80211_init(void) 20226 { 20227 int err; 20228 20229 err = genl_register_family(&nl80211_fam); 20230 if (err) 20231 return err; 20232 20233 err = netlink_register_notifier(&nl80211_netlink_notifier); 20234 if (err) 20235 goto err_out; 20236 20237 return 0; 20238 err_out: 20239 genl_unregister_family(&nl80211_fam); 20240 return err; 20241 } 20242 20243 void nl80211_exit(void) 20244 { 20245 netlink_unregister_notifier(&nl80211_netlink_notifier); 20246 genl_unregister_family(&nl80211_fam); 20247 } 20248