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-2022 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 list_for_each_entry(rdev, &cfg80211_rdev_list, list) { 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 }; 327 328 static const struct nla_policy 329 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = { 330 [NL80211_PMSR_TYPE_FTM] = 331 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy), 332 }; 333 334 static const struct nla_policy 335 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = { 336 [NL80211_PMSR_REQ_ATTR_DATA] = 337 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy), 338 [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG }, 339 }; 340 341 static const struct nla_policy 342 nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = { 343 [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR, 344 [NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy), 345 [NL80211_PMSR_PEER_ATTR_REQ] = 346 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy), 347 [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT }, 348 }; 349 350 static const struct nla_policy 351 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = { 352 [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT }, 353 [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT }, 354 [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT }, 355 [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT }, 356 [NL80211_PMSR_ATTR_PEERS] = 357 NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy), 358 }; 359 360 static const struct nla_policy 361 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = { 362 [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] = 363 NLA_POLICY_RANGE(NLA_U8, 1, 20), 364 [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] = 365 NLA_POLICY_RANGE(NLA_U8, 1, 20), 366 [NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] = 367 NLA_POLICY_RANGE(NLA_U8, 1, 20), 368 [NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] = 369 NLA_POLICY_EXACT_LEN(8), 370 [NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] = 371 NLA_POLICY_EXACT_LEN(8), 372 [NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 }, 373 }; 374 375 static const struct nla_policy 376 he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = { 377 [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63), 378 [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG }, 379 [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG }, 380 }; 381 382 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = { 383 [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY, 384 .len = NL80211_MAX_SUPP_RATES }, 385 [NL80211_TXRATE_HT] = { .type = NLA_BINARY, 386 .len = NL80211_MAX_SUPP_HT_RATES }, 387 [NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)), 388 [NL80211_TXRATE_GI] = { .type = NLA_U8 }, 389 [NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)), 390 [NL80211_TXRATE_HE_GI] = NLA_POLICY_RANGE(NLA_U8, 391 NL80211_RATE_INFO_HE_GI_0_8, 392 NL80211_RATE_INFO_HE_GI_3_2), 393 [NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8, 394 NL80211_RATE_INFO_HE_1XLTF, 395 NL80211_RATE_INFO_HE_4XLTF), 396 }; 397 398 static const struct nla_policy 399 nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = { 400 [NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 }, 401 [NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 }, 402 [NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG }, 403 [NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff), 404 [NL80211_TID_CONFIG_ATTR_NOACK] = 405 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 406 [NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 407 [NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 408 [NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] = 409 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 410 [NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] = 411 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 412 [NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] = 413 NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE), 414 [NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] = 415 NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED), 416 [NL80211_TID_CONFIG_ATTR_TX_RATE] = 417 NLA_POLICY_NESTED(nl80211_txattr_policy), 418 }; 419 420 static const struct nla_policy 421 nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = { 422 [NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000), 423 [NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000), 424 [NL80211_FILS_DISCOVERY_ATTR_TMPL] = 425 NLA_POLICY_RANGE(NLA_BINARY, 426 NL80211_FILS_DISCOVERY_TMPL_MIN_LEN, 427 IEEE80211_MAX_DATA_LEN), 428 }; 429 430 static const struct nla_policy 431 nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = { 432 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20), 433 [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY, 434 .len = IEEE80211_MAX_DATA_LEN } 435 }; 436 437 static const struct nla_policy 438 sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = { 439 [NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 }, 440 [NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 }, 441 }; 442 443 static const struct nla_policy 444 sar_policy[NL80211_SAR_ATTR_MAX + 1] = { 445 [NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE), 446 [NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy), 447 }; 448 449 static const struct nla_policy 450 nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = { 451 [NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2), 452 [NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] = 453 NLA_POLICY_MIN(NLA_U8, 1), 454 [NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 }, 455 [NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 }, 456 [NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG }, 457 }; 458 459 static const struct nla_policy 460 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = { 461 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 }, 462 [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 }, 463 }; 464 465 static struct netlink_range_validation nl80211_punct_bitmap_range = { 466 .min = 0, 467 .max = 0xffff, 468 }; 469 470 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = { 471 [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD }, 472 [NL80211_ATTR_WIPHY] = { .type = NLA_U32 }, 473 [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING, 474 .len = 20-1 }, 475 [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED }, 476 477 [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 }, 478 [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 }, 479 [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8, 480 NL80211_EDMG_CHANNELS_MIN, 481 NL80211_EDMG_CHANNELS_MAX), 482 [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8, 483 NL80211_EDMG_BW_CONFIG_MIN, 484 NL80211_EDMG_BW_CONFIG_MAX), 485 486 [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 }, 487 [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 }, 488 [NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 489 [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 }, 490 491 [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1), 492 [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1), 493 [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 }, 494 [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 }, 495 [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 }, 496 [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG }, 497 498 [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX), 499 [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 }, 500 [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 }, 501 502 [NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 503 [NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 504 505 [NL80211_ATTR_KEY] = { .type = NLA_NESTED, }, 506 [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY, 507 .len = WLAN_MAX_KEY_LEN }, 508 [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7), 509 [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 }, 510 [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG }, 511 [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 512 [NL80211_ATTR_KEY_TYPE] = 513 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES), 514 515 [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 }, 516 [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 }, 517 [NL80211_ATTR_BEACON_HEAD] = 518 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head, 519 IEEE80211_MAX_DATA_LEN), 520 [NL80211_ATTR_BEACON_TAIL] = 521 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 522 IEEE80211_MAX_DATA_LEN), 523 [NL80211_ATTR_STA_AID] = 524 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 525 [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED }, 526 [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 }, 527 [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY, 528 .len = NL80211_MAX_SUPP_RATES }, 529 [NL80211_ATTR_STA_PLINK_ACTION] = 530 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1), 531 [NL80211_ATTR_STA_TX_POWER_SETTING] = 532 NLA_POLICY_RANGE(NLA_U8, 533 NL80211_TX_POWER_AUTOMATIC, 534 NL80211_TX_POWER_FIXED), 535 [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 }, 536 [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 }, 537 [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ }, 538 [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY, 539 .len = IEEE80211_MAX_MESH_ID_LEN }, 540 [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT, 541 542 /* allow 3 for NUL-termination, we used to declare this NLA_STRING */ 543 [NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3), 544 [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED }, 545 546 [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 }, 547 [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 }, 548 [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 }, 549 [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY, 550 .len = NL80211_MAX_SUPP_RATES }, 551 [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 }, 552 553 [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED }, 554 [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG }, 555 556 [NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN), 557 558 [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 }, 559 [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY, 560 validate_ie_attr, 561 IEEE80211_MAX_DATA_LEN), 562 [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED }, 563 [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED }, 564 565 [NL80211_ATTR_SSID] = { .type = NLA_BINARY, 566 .len = IEEE80211_MAX_SSID_LEN }, 567 [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 }, 568 [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 }, 569 [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG }, 570 [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG }, 571 [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32, 572 NL80211_MFP_NO, 573 NL80211_MFP_OPTIONAL), 574 [NL80211_ATTR_STA_FLAGS2] = 575 NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)), 576 [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG }, 577 [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 }, 578 [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG }, 579 [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG }, 580 [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG }, 581 [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 }, 582 [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 }, 583 [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 }, 584 [NL80211_ATTR_PID] = { .type = NLA_U32 }, 585 [NL80211_ATTR_4ADDR] = { .type = NLA_U8 }, 586 [NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN), 587 [NL80211_ATTR_DURATION] = { .type = NLA_U32 }, 588 [NL80211_ATTR_COOKIE] = { .type = NLA_U64 }, 589 [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED }, 590 [NL80211_ATTR_FRAME] = { .type = NLA_BINARY, 591 .len = IEEE80211_MAX_DATA_LEN }, 592 [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, }, 593 [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32, 594 NL80211_PS_DISABLED, 595 NL80211_PS_ENABLED), 596 [NL80211_ATTR_CQM] = { .type = NLA_NESTED, }, 597 [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG }, 598 [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 }, 599 [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 }, 600 [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 }, 601 [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 }, 602 [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 }, 603 [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 }, 604 [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 }, 605 [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG }, 606 [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 607 [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED }, 608 [NL80211_ATTR_STA_PLINK_STATE] = 609 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1), 610 [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 }, 611 [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG }, 612 [NL80211_ATTR_MESH_PEER_AID] = 613 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 614 [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 }, 615 [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED }, 616 [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED }, 617 [NL80211_ATTR_HIDDEN_SSID] = 618 NLA_POLICY_RANGE(NLA_U32, 619 NL80211_HIDDEN_SSID_NOT_IN_USE, 620 NL80211_HIDDEN_SSID_ZERO_CONTENTS), 621 [NL80211_ATTR_IE_PROBE_RESP] = 622 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 623 IEEE80211_MAX_DATA_LEN), 624 [NL80211_ATTR_IE_ASSOC_RESP] = 625 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 626 IEEE80211_MAX_DATA_LEN), 627 [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG }, 628 [NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy), 629 [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED }, 630 [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG }, 631 [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 }, 632 [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 }, 633 [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 }, 634 [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG }, 635 [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG }, 636 [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG }, 637 [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG }, 638 [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY, 639 .len = IEEE80211_MAX_DATA_LEN }, 640 [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 }, 641 [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG }, 642 [NL80211_ATTR_HT_CAPABILITY_MASK] = { 643 .len = NL80211_HT_CAPABILITY_LEN 644 }, 645 [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 }, 646 [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 }, 647 [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 }, 648 [NL80211_ATTR_WDEV] = { .type = NLA_U64 }, 649 [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 }, 650 651 /* need to include at least Auth Transaction and Status Code */ 652 [NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4), 653 654 [NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN), 655 [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 }, 656 [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127), 657 [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1), 658 [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = 659 NLA_POLICY_RANGE(NLA_U32, 660 NL80211_MESH_POWER_UNKNOWN + 1, 661 NL80211_MESH_POWER_MAX), 662 [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 }, 663 [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED }, 664 [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 }, 665 [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, }, 666 [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, }, 667 [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG }, 668 [NL80211_ATTR_VHT_CAPABILITY_MASK] = { 669 .len = NL80211_VHT_CAPABILITY_LEN, 670 }, 671 [NL80211_ATTR_MDID] = { .type = NLA_U16 }, 672 [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY, 673 .len = IEEE80211_MAX_DATA_LEN }, 674 [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 }, 675 [NL80211_ATTR_MAX_CRIT_PROT_DURATION] = 676 NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION), 677 [NL80211_ATTR_PEER_AID] = 678 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID), 679 [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 }, 680 [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG }, 681 [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED }, 682 [NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY }, 683 [NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY }, 684 [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2), 685 /* 686 * The value of the Length field of the Supported Operating 687 * Classes element is between 2 and 253. 688 */ 689 [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = 690 NLA_POLICY_RANGE(NLA_BINARY, 2, 253), 691 [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG }, 692 [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 }, 693 [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 }, 694 [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 }, 695 [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY }, 696 [NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY, 697 IEEE80211_QOS_MAP_LEN_MIN, 698 IEEE80211_QOS_MAP_LEN_MAX), 699 [NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 700 [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 }, 701 [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 }, 702 [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG }, 703 [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY }, 704 [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG }, 705 [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1), 706 [NL80211_ATTR_USER_PRIO] = 707 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1), 708 [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 }, 709 [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 }, 710 [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 }, 711 [NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 712 [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG }, 713 [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 }, 714 [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 }, 715 [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG }, 716 [NL80211_ATTR_PBSS] = { .type = NLA_FLAG }, 717 [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED }, 718 [NL80211_ATTR_STA_SUPPORT_P2P_PS] = 719 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1), 720 [NL80211_ATTR_MU_MIMO_GROUP_DATA] = { 721 .len = VHT_MUMIMO_GROUPS_DATA_LEN 722 }, 723 [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 724 [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1), 725 [NL80211_ATTR_BANDS] = { .type = NLA_U32 }, 726 [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED }, 727 [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY, 728 .len = FILS_MAX_KEK_LEN }, 729 [NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN), 730 [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, }, 731 [NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 732 [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 }, 733 [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = { 734 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 735 }, 736 [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 }, 737 [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY, 738 .len = FILS_ERP_MAX_USERNAME_LEN }, 739 [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY, 740 .len = FILS_ERP_MAX_REALM_LEN }, 741 [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 }, 742 [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY, 743 .len = FILS_ERP_MAX_RRK_LEN }, 744 [NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2), 745 [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN }, 746 [NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN), 747 [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG }, 748 [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG }, 749 750 [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 }, 751 [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 }, 752 [NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 }, 753 [NL80211_ATTR_HE_CAPABILITY] = 754 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa, 755 NL80211_HE_MAX_CAPABILITY_LEN), 756 [NL80211_ATTR_FTM_RESPONDER] = 757 NLA_POLICY_NESTED(nl80211_ftm_responder_policy), 758 [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1), 759 [NL80211_ATTR_PEER_MEASUREMENTS] = 760 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy), 761 [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1), 762 [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY, 763 .len = SAE_PASSWORD_MAX_LEN }, 764 [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG }, 765 [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy), 766 [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2), 767 [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy), 768 [NL80211_ATTR_TID_CONFIG] = 769 NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy), 770 [NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG }, 771 [NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1), 772 [NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100), 773 [NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG }, 774 [NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999), 775 [NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED }, 776 [NL80211_ATTR_HE_6GHZ_CAPABILITY] = 777 NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)), 778 [NL80211_ATTR_FILS_DISCOVERY] = 779 NLA_POLICY_NESTED(nl80211_fils_discovery_policy), 780 [NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] = 781 NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy), 782 [NL80211_ATTR_S1G_CAPABILITY] = 783 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 784 [NL80211_ATTR_S1G_CAPABILITY_MASK] = 785 NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN), 786 [NL80211_ATTR_SAE_PWE] = 787 NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK, 788 NL80211_SAE_PWE_BOTH), 789 [NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT }, 790 [NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy), 791 [NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG }, 792 [NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 }, 793 [NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 }, 794 [NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 }, 795 [NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy), 796 [NL80211_ATTR_MBSSID_CONFIG] = 797 NLA_POLICY_NESTED(nl80211_mbssid_config_policy), 798 [NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED }, 799 [NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG }, 800 [NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 }, 801 [NL80211_ATTR_EHT_CAPABILITY] = 802 NLA_POLICY_RANGE(NLA_BINARY, 803 NL80211_EHT_MIN_CAPABILITY_LEN, 804 NL80211_EHT_MAX_CAPABILITY_LEN), 805 [NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG }, 806 [NL80211_ATTR_MLO_LINKS] = 807 NLA_POLICY_NESTED_ARRAY(nl80211_policy), 808 [NL80211_ATTR_MLO_LINK_ID] = 809 NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS), 810 [NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN), 811 [NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG }, 812 [NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT }, 813 [NL80211_ATTR_PUNCT_BITMAP] = 814 NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range), 815 816 [NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS] = { .type = NLA_U16 }, 817 [NL80211_ATTR_HW_TIMESTAMP_ENABLED] = { .type = NLA_FLAG }, 818 [NL80211_ATTR_EMA_RNR_ELEMS] = { .type = NLA_NESTED }, 819 }; 820 821 /* policy for the key attributes */ 822 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = { 823 [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN }, 824 [NL80211_KEY_IDX] = { .type = NLA_U8 }, 825 [NL80211_KEY_CIPHER] = { .type = NLA_U32 }, 826 [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 }, 827 [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG }, 828 [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG }, 829 [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1), 830 [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED }, 831 [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX), 832 }; 833 834 /* policy for the key default flags */ 835 static const struct nla_policy 836 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = { 837 [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG }, 838 [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG }, 839 }; 840 841 #ifdef CONFIG_PM 842 /* policy for WoWLAN attributes */ 843 static const struct nla_policy 844 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = { 845 [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG }, 846 [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG }, 847 [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG }, 848 [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED }, 849 [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG }, 850 [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG }, 851 [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG }, 852 [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG }, 853 [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED }, 854 [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED }, 855 }; 856 857 static const struct nla_policy 858 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = { 859 [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 }, 860 [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 }, 861 [NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 862 [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 }, 863 [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 }, 864 [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 865 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = { 866 .len = sizeof(struct nl80211_wowlan_tcp_data_seq) 867 }, 868 [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = { 869 .len = sizeof(struct nl80211_wowlan_tcp_data_token) 870 }, 871 [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 }, 872 [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1), 873 [NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1), 874 }; 875 #endif /* CONFIG_PM */ 876 877 /* policy for coalesce rule attributes */ 878 static const struct nla_policy 879 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = { 880 [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 }, 881 [NL80211_ATTR_COALESCE_RULE_CONDITION] = 882 NLA_POLICY_RANGE(NLA_U32, 883 NL80211_COALESCE_CONDITION_MATCH, 884 NL80211_COALESCE_CONDITION_NO_MATCH), 885 [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED }, 886 }; 887 888 /* policy for GTK rekey offload attributes */ 889 static const struct nla_policy 890 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = { 891 [NL80211_REKEY_DATA_KEK] = { 892 .type = NLA_BINARY, 893 .len = NL80211_KEK_EXT_LEN 894 }, 895 [NL80211_REKEY_DATA_KCK] = { 896 .type = NLA_BINARY, 897 .len = NL80211_KCK_EXT_LEN_32 898 }, 899 [NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN), 900 [NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 }, 901 }; 902 903 static const struct nla_policy 904 nl80211_match_band_rssi_policy[NUM_NL80211_BANDS] = { 905 [NL80211_BAND_2GHZ] = { .type = NLA_S32 }, 906 [NL80211_BAND_5GHZ] = { .type = NLA_S32 }, 907 [NL80211_BAND_6GHZ] = { .type = NLA_S32 }, 908 [NL80211_BAND_60GHZ] = { .type = NLA_S32 }, 909 [NL80211_BAND_LC] = { .type = NLA_S32 }, 910 }; 911 912 static const struct nla_policy 913 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = { 914 [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY, 915 .len = IEEE80211_MAX_SSID_LEN }, 916 [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 917 [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 }, 918 [NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI] = 919 NLA_POLICY_NESTED(nl80211_match_band_rssi_policy), 920 }; 921 922 static const struct nla_policy 923 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = { 924 [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 }, 925 [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 }, 926 }; 927 928 static const struct nla_policy 929 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = { 930 [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG }, 931 [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 }, 932 [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = { 933 .len = sizeof(struct nl80211_bss_select_rssi_adjust) 934 }, 935 }; 936 937 /* policy for NAN function attributes */ 938 static const struct nla_policy 939 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = { 940 [NL80211_NAN_FUNC_TYPE] = 941 NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE), 942 [NL80211_NAN_FUNC_SERVICE_ID] = { 943 .len = NL80211_NAN_FUNC_SERVICE_ID_LEN }, 944 [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 }, 945 [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG }, 946 [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG }, 947 [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 }, 948 [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 }, 949 [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN), 950 [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG }, 951 [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 }, 952 [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY, 953 .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN }, 954 [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED }, 955 [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED }, 956 [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED }, 957 [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 }, 958 [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 }, 959 }; 960 961 /* policy for Service Response Filter attributes */ 962 static const struct nla_policy 963 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = { 964 [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG }, 965 [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY, 966 .len = NL80211_NAN_FUNC_SRF_MAX_LEN }, 967 [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 }, 968 [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED }, 969 }; 970 971 /* policy for packet pattern attributes */ 972 static const struct nla_policy 973 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = { 974 [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, }, 975 [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, }, 976 [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 }, 977 }; 978 979 static int nl80211_prepare_wdev_dump(struct netlink_callback *cb, 980 struct cfg80211_registered_device **rdev, 981 struct wireless_dev **wdev, 982 struct nlattr **attrbuf) 983 { 984 int err; 985 986 if (!cb->args[0]) { 987 struct nlattr **attrbuf_free = NULL; 988 989 if (!attrbuf) { 990 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 991 GFP_KERNEL); 992 if (!attrbuf) 993 return -ENOMEM; 994 attrbuf_free = attrbuf; 995 } 996 997 err = nlmsg_parse_deprecated(cb->nlh, 998 GENL_HDRLEN + nl80211_fam.hdrsize, 999 attrbuf, nl80211_fam.maxattr, 1000 nl80211_policy, NULL); 1001 if (err) { 1002 kfree(attrbuf_free); 1003 return err; 1004 } 1005 1006 rtnl_lock(); 1007 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk), 1008 attrbuf); 1009 kfree(attrbuf_free); 1010 if (IS_ERR(*wdev)) { 1011 rtnl_unlock(); 1012 return PTR_ERR(*wdev); 1013 } 1014 *rdev = wiphy_to_rdev((*wdev)->wiphy); 1015 mutex_lock(&(*rdev)->wiphy.mtx); 1016 rtnl_unlock(); 1017 /* 0 is the first index - add 1 to parse only once */ 1018 cb->args[0] = (*rdev)->wiphy_idx + 1; 1019 cb->args[1] = (*wdev)->identifier; 1020 } else { 1021 /* subtract the 1 again here */ 1022 struct wiphy *wiphy; 1023 struct wireless_dev *tmp; 1024 1025 rtnl_lock(); 1026 wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 1027 if (!wiphy) { 1028 rtnl_unlock(); 1029 return -ENODEV; 1030 } 1031 *rdev = wiphy_to_rdev(wiphy); 1032 *wdev = NULL; 1033 1034 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) { 1035 if (tmp->identifier == cb->args[1]) { 1036 *wdev = tmp; 1037 break; 1038 } 1039 } 1040 1041 if (!*wdev) { 1042 rtnl_unlock(); 1043 return -ENODEV; 1044 } 1045 mutex_lock(&(*rdev)->wiphy.mtx); 1046 rtnl_unlock(); 1047 } 1048 1049 return 0; 1050 } 1051 1052 /* message building helper */ 1053 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq, 1054 int flags, u8 cmd) 1055 { 1056 /* since there is no private header just add the generic one */ 1057 return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd); 1058 } 1059 1060 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg, 1061 const struct ieee80211_reg_rule *rule) 1062 { 1063 int j; 1064 struct nlattr *nl_wmm_rules = 1065 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM); 1066 1067 if (!nl_wmm_rules) 1068 goto nla_put_failure; 1069 1070 for (j = 0; j < IEEE80211_NUM_ACS; j++) { 1071 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j); 1072 1073 if (!nl_wmm_rule) 1074 goto nla_put_failure; 1075 1076 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN, 1077 rule->wmm_rule.client[j].cw_min) || 1078 nla_put_u16(msg, NL80211_WMMR_CW_MAX, 1079 rule->wmm_rule.client[j].cw_max) || 1080 nla_put_u8(msg, NL80211_WMMR_AIFSN, 1081 rule->wmm_rule.client[j].aifsn) || 1082 nla_put_u16(msg, NL80211_WMMR_TXOP, 1083 rule->wmm_rule.client[j].cot)) 1084 goto nla_put_failure; 1085 1086 nla_nest_end(msg, nl_wmm_rule); 1087 } 1088 nla_nest_end(msg, nl_wmm_rules); 1089 1090 return 0; 1091 1092 nla_put_failure: 1093 return -ENOBUFS; 1094 } 1095 1096 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy, 1097 struct ieee80211_channel *chan, 1098 bool large) 1099 { 1100 /* Some channels must be completely excluded from the 1101 * list to protect old user-space tools from breaking 1102 */ 1103 if (!large && chan->flags & 1104 (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ)) 1105 return 0; 1106 if (!large && chan->freq_offset) 1107 return 0; 1108 1109 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ, 1110 chan->center_freq)) 1111 goto nla_put_failure; 1112 1113 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset)) 1114 goto nla_put_failure; 1115 1116 if ((chan->flags & IEEE80211_CHAN_DISABLED) && 1117 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED)) 1118 goto nla_put_failure; 1119 if (chan->flags & IEEE80211_CHAN_NO_IR) { 1120 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR)) 1121 goto nla_put_failure; 1122 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS)) 1123 goto nla_put_failure; 1124 } 1125 if (chan->flags & IEEE80211_CHAN_RADAR) { 1126 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR)) 1127 goto nla_put_failure; 1128 if (large) { 1129 u32 time; 1130 1131 time = elapsed_jiffies_msecs(chan->dfs_state_entered); 1132 1133 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE, 1134 chan->dfs_state)) 1135 goto nla_put_failure; 1136 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME, 1137 time)) 1138 goto nla_put_failure; 1139 if (nla_put_u32(msg, 1140 NL80211_FREQUENCY_ATTR_DFS_CAC_TIME, 1141 chan->dfs_cac_ms)) 1142 goto nla_put_failure; 1143 } 1144 } 1145 1146 if (large) { 1147 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) && 1148 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS)) 1149 goto nla_put_failure; 1150 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) && 1151 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS)) 1152 goto nla_put_failure; 1153 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) && 1154 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ)) 1155 goto nla_put_failure; 1156 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) && 1157 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ)) 1158 goto nla_put_failure; 1159 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) && 1160 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY)) 1161 goto nla_put_failure; 1162 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) && 1163 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT)) 1164 goto nla_put_failure; 1165 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) && 1166 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ)) 1167 goto nla_put_failure; 1168 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) && 1169 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ)) 1170 goto nla_put_failure; 1171 if ((chan->flags & IEEE80211_CHAN_NO_HE) && 1172 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE)) 1173 goto nla_put_failure; 1174 if ((chan->flags & IEEE80211_CHAN_1MHZ) && 1175 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_1MHZ)) 1176 goto nla_put_failure; 1177 if ((chan->flags & IEEE80211_CHAN_2MHZ) && 1178 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_2MHZ)) 1179 goto nla_put_failure; 1180 if ((chan->flags & IEEE80211_CHAN_4MHZ) && 1181 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_4MHZ)) 1182 goto nla_put_failure; 1183 if ((chan->flags & IEEE80211_CHAN_8MHZ) && 1184 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_8MHZ)) 1185 goto nla_put_failure; 1186 if ((chan->flags & IEEE80211_CHAN_16MHZ) && 1187 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_16MHZ)) 1188 goto nla_put_failure; 1189 if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) && 1190 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ)) 1191 goto nla_put_failure; 1192 if ((chan->flags & IEEE80211_CHAN_NO_EHT) && 1193 nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT)) 1194 goto nla_put_failure; 1195 } 1196 1197 if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER, 1198 DBM_TO_MBM(chan->max_power))) 1199 goto nla_put_failure; 1200 1201 if (large) { 1202 const struct ieee80211_reg_rule *rule = 1203 freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq)); 1204 1205 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) { 1206 if (nl80211_msg_put_wmm_rules(msg, rule)) 1207 goto nla_put_failure; 1208 } 1209 } 1210 1211 return 0; 1212 1213 nla_put_failure: 1214 return -ENOBUFS; 1215 } 1216 1217 static bool nl80211_put_txq_stats(struct sk_buff *msg, 1218 struct cfg80211_txq_stats *txqstats, 1219 int attrtype) 1220 { 1221 struct nlattr *txqattr; 1222 1223 #define PUT_TXQVAL_U32(attr, memb) do { \ 1224 if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \ 1225 nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \ 1226 return false; \ 1227 } while (0) 1228 1229 txqattr = nla_nest_start_noflag(msg, attrtype); 1230 if (!txqattr) 1231 return false; 1232 1233 PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes); 1234 PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets); 1235 PUT_TXQVAL_U32(FLOWS, flows); 1236 PUT_TXQVAL_U32(DROPS, drops); 1237 PUT_TXQVAL_U32(ECN_MARKS, ecn_marks); 1238 PUT_TXQVAL_U32(OVERLIMIT, overlimit); 1239 PUT_TXQVAL_U32(OVERMEMORY, overmemory); 1240 PUT_TXQVAL_U32(COLLISIONS, collisions); 1241 PUT_TXQVAL_U32(TX_BYTES, tx_bytes); 1242 PUT_TXQVAL_U32(TX_PACKETS, tx_packets); 1243 PUT_TXQVAL_U32(MAX_FLOWS, max_flows); 1244 nla_nest_end(msg, txqattr); 1245 1246 #undef PUT_TXQVAL_U32 1247 return true; 1248 } 1249 1250 /* netlink command implementations */ 1251 1252 /** 1253 * nl80211_link_id - return link ID 1254 * @attrs: attributes to look at 1255 * 1256 * Returns: the link ID or 0 if not given 1257 * 1258 * Note this function doesn't do any validation of the link 1259 * ID validity wrt. links that were actually added, so it must 1260 * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID 1261 * or if additional validation is done. 1262 */ 1263 static unsigned int nl80211_link_id(struct nlattr **attrs) 1264 { 1265 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1266 1267 if (!linkid) 1268 return 0; 1269 1270 return nla_get_u8(linkid); 1271 } 1272 1273 static int nl80211_link_id_or_invalid(struct nlattr **attrs) 1274 { 1275 struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID]; 1276 1277 if (!linkid) 1278 return -1; 1279 1280 return nla_get_u8(linkid); 1281 } 1282 1283 struct key_parse { 1284 struct key_params p; 1285 int idx; 1286 int type; 1287 bool def, defmgmt, defbeacon; 1288 bool def_uni, def_multi; 1289 }; 1290 1291 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key, 1292 struct key_parse *k) 1293 { 1294 struct nlattr *tb[NL80211_KEY_MAX + 1]; 1295 int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key, 1296 nl80211_key_policy, 1297 info->extack); 1298 if (err) 1299 return err; 1300 1301 k->def = !!tb[NL80211_KEY_DEFAULT]; 1302 k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT]; 1303 k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON]; 1304 1305 if (k->def) { 1306 k->def_uni = true; 1307 k->def_multi = true; 1308 } 1309 if (k->defmgmt || k->defbeacon) 1310 k->def_multi = true; 1311 1312 if (tb[NL80211_KEY_IDX]) 1313 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]); 1314 1315 if (tb[NL80211_KEY_DATA]) { 1316 k->p.key = nla_data(tb[NL80211_KEY_DATA]); 1317 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]); 1318 } 1319 1320 if (tb[NL80211_KEY_SEQ]) { 1321 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]); 1322 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]); 1323 } 1324 1325 if (tb[NL80211_KEY_CIPHER]) 1326 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]); 1327 1328 if (tb[NL80211_KEY_TYPE]) 1329 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]); 1330 1331 if (tb[NL80211_KEY_DEFAULT_TYPES]) { 1332 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1333 1334 err = nla_parse_nested_deprecated(kdt, 1335 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1336 tb[NL80211_KEY_DEFAULT_TYPES], 1337 nl80211_key_default_policy, 1338 info->extack); 1339 if (err) 1340 return err; 1341 1342 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1343 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1344 } 1345 1346 if (tb[NL80211_KEY_MODE]) 1347 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]); 1348 1349 return 0; 1350 } 1351 1352 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k) 1353 { 1354 if (info->attrs[NL80211_ATTR_KEY_DATA]) { 1355 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]); 1356 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]); 1357 } 1358 1359 if (info->attrs[NL80211_ATTR_KEY_SEQ]) { 1360 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]); 1361 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]); 1362 } 1363 1364 if (info->attrs[NL80211_ATTR_KEY_IDX]) 1365 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 1366 1367 if (info->attrs[NL80211_ATTR_KEY_CIPHER]) 1368 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]); 1369 1370 k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT]; 1371 k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT]; 1372 1373 if (k->def) { 1374 k->def_uni = true; 1375 k->def_multi = true; 1376 } 1377 if (k->defmgmt) 1378 k->def_multi = true; 1379 1380 if (info->attrs[NL80211_ATTR_KEY_TYPE]) 1381 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 1382 1383 if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) { 1384 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES]; 1385 int err = nla_parse_nested_deprecated(kdt, 1386 NUM_NL80211_KEY_DEFAULT_TYPES - 1, 1387 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES], 1388 nl80211_key_default_policy, 1389 info->extack); 1390 if (err) 1391 return err; 1392 1393 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST]; 1394 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST]; 1395 } 1396 1397 return 0; 1398 } 1399 1400 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k) 1401 { 1402 int err; 1403 1404 memset(k, 0, sizeof(*k)); 1405 k->idx = -1; 1406 k->type = -1; 1407 1408 if (info->attrs[NL80211_ATTR_KEY]) 1409 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k); 1410 else 1411 err = nl80211_parse_key_old(info, k); 1412 1413 if (err) 1414 return err; 1415 1416 if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) + 1417 (k->defbeacon ? 1 : 0) > 1) { 1418 GENL_SET_ERR_MSG(info, 1419 "key with multiple default flags is invalid"); 1420 return -EINVAL; 1421 } 1422 1423 if (k->defmgmt || k->defbeacon) { 1424 if (k->def_uni || !k->def_multi) { 1425 GENL_SET_ERR_MSG(info, 1426 "defmgmt/defbeacon key must be mcast"); 1427 return -EINVAL; 1428 } 1429 } 1430 1431 if (k->idx != -1) { 1432 if (k->defmgmt) { 1433 if (k->idx < 4 || k->idx > 5) { 1434 GENL_SET_ERR_MSG(info, 1435 "defmgmt key idx not 4 or 5"); 1436 return -EINVAL; 1437 } 1438 } else if (k->defbeacon) { 1439 if (k->idx < 6 || k->idx > 7) { 1440 GENL_SET_ERR_MSG(info, 1441 "defbeacon key idx not 6 or 7"); 1442 return -EINVAL; 1443 } 1444 } else if (k->def) { 1445 if (k->idx < 0 || k->idx > 3) { 1446 GENL_SET_ERR_MSG(info, "def key idx not 0-3"); 1447 return -EINVAL; 1448 } 1449 } else { 1450 if (k->idx < 0 || k->idx > 7) { 1451 GENL_SET_ERR_MSG(info, "key idx not 0-7"); 1452 return -EINVAL; 1453 } 1454 } 1455 } 1456 1457 return 0; 1458 } 1459 1460 static struct cfg80211_cached_keys * 1461 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev, 1462 struct genl_info *info, bool *no_ht) 1463 { 1464 struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS]; 1465 struct key_parse parse; 1466 struct nlattr *key; 1467 struct cfg80211_cached_keys *result; 1468 int rem, err, def = 0; 1469 bool have_key = false; 1470 1471 nla_for_each_nested(key, keys, rem) { 1472 have_key = true; 1473 break; 1474 } 1475 1476 if (!have_key) 1477 return NULL; 1478 1479 result = kzalloc(sizeof(*result), GFP_KERNEL); 1480 if (!result) 1481 return ERR_PTR(-ENOMEM); 1482 1483 result->def = -1; 1484 1485 nla_for_each_nested(key, keys, rem) { 1486 memset(&parse, 0, sizeof(parse)); 1487 parse.idx = -1; 1488 1489 err = nl80211_parse_key_new(info, key, &parse); 1490 if (err) 1491 goto error; 1492 err = -EINVAL; 1493 if (!parse.p.key) 1494 goto error; 1495 if (parse.idx < 0 || parse.idx > 3) { 1496 GENL_SET_ERR_MSG(info, "key index out of range [0-3]"); 1497 goto error; 1498 } 1499 if (parse.def) { 1500 if (def) { 1501 GENL_SET_ERR_MSG(info, 1502 "only one key can be default"); 1503 goto error; 1504 } 1505 def = 1; 1506 result->def = parse.idx; 1507 if (!parse.def_uni || !parse.def_multi) 1508 goto error; 1509 } else if (parse.defmgmt) 1510 goto error; 1511 err = cfg80211_validate_key_settings(rdev, &parse.p, 1512 parse.idx, false, NULL); 1513 if (err) 1514 goto error; 1515 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 && 1516 parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) { 1517 GENL_SET_ERR_MSG(info, "connect key must be WEP"); 1518 err = -EINVAL; 1519 goto error; 1520 } 1521 result->params[parse.idx].cipher = parse.p.cipher; 1522 result->params[parse.idx].key_len = parse.p.key_len; 1523 result->params[parse.idx].key = result->data[parse.idx]; 1524 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len); 1525 1526 /* must be WEP key if we got here */ 1527 if (no_ht) 1528 *no_ht = true; 1529 } 1530 1531 if (result->def < 0) { 1532 err = -EINVAL; 1533 GENL_SET_ERR_MSG(info, "need a default/TX key"); 1534 goto error; 1535 } 1536 1537 return result; 1538 error: 1539 kfree(result); 1540 return ERR_PTR(err); 1541 } 1542 1543 static int nl80211_key_allowed(struct wireless_dev *wdev) 1544 { 1545 ASSERT_WDEV_LOCK(wdev); 1546 1547 switch (wdev->iftype) { 1548 case NL80211_IFTYPE_AP: 1549 case NL80211_IFTYPE_AP_VLAN: 1550 case NL80211_IFTYPE_P2P_GO: 1551 case NL80211_IFTYPE_MESH_POINT: 1552 break; 1553 case NL80211_IFTYPE_ADHOC: 1554 if (wdev->u.ibss.current_bss) 1555 return 0; 1556 return -ENOLINK; 1557 case NL80211_IFTYPE_STATION: 1558 case NL80211_IFTYPE_P2P_CLIENT: 1559 if (wdev->connected) 1560 return 0; 1561 return -ENOLINK; 1562 case NL80211_IFTYPE_NAN: 1563 if (wiphy_ext_feature_isset(wdev->wiphy, 1564 NL80211_EXT_FEATURE_SECURE_NAN)) 1565 return 0; 1566 return -EINVAL; 1567 case NL80211_IFTYPE_UNSPECIFIED: 1568 case NL80211_IFTYPE_OCB: 1569 case NL80211_IFTYPE_MONITOR: 1570 case NL80211_IFTYPE_P2P_DEVICE: 1571 case NL80211_IFTYPE_WDS: 1572 case NUM_NL80211_IFTYPES: 1573 return -EINVAL; 1574 } 1575 1576 return 0; 1577 } 1578 1579 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy, 1580 u32 freq) 1581 { 1582 struct ieee80211_channel *chan; 1583 1584 chan = ieee80211_get_channel_khz(wiphy, freq); 1585 if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) 1586 return NULL; 1587 return chan; 1588 } 1589 1590 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes) 1591 { 1592 struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr); 1593 int i; 1594 1595 if (!nl_modes) 1596 goto nla_put_failure; 1597 1598 i = 0; 1599 while (ifmodes) { 1600 if ((ifmodes & 1) && nla_put_flag(msg, i)) 1601 goto nla_put_failure; 1602 ifmodes >>= 1; 1603 i++; 1604 } 1605 1606 nla_nest_end(msg, nl_modes); 1607 return 0; 1608 1609 nla_put_failure: 1610 return -ENOBUFS; 1611 } 1612 1613 static int nl80211_put_iface_combinations(struct wiphy *wiphy, 1614 struct sk_buff *msg, 1615 bool large) 1616 { 1617 struct nlattr *nl_combis; 1618 int i, j; 1619 1620 nl_combis = nla_nest_start_noflag(msg, 1621 NL80211_ATTR_INTERFACE_COMBINATIONS); 1622 if (!nl_combis) 1623 goto nla_put_failure; 1624 1625 for (i = 0; i < wiphy->n_iface_combinations; i++) { 1626 const struct ieee80211_iface_combination *c; 1627 struct nlattr *nl_combi, *nl_limits; 1628 1629 c = &wiphy->iface_combinations[i]; 1630 1631 nl_combi = nla_nest_start_noflag(msg, i + 1); 1632 if (!nl_combi) 1633 goto nla_put_failure; 1634 1635 nl_limits = nla_nest_start_noflag(msg, 1636 NL80211_IFACE_COMB_LIMITS); 1637 if (!nl_limits) 1638 goto nla_put_failure; 1639 1640 for (j = 0; j < c->n_limits; j++) { 1641 struct nlattr *nl_limit; 1642 1643 nl_limit = nla_nest_start_noflag(msg, j + 1); 1644 if (!nl_limit) 1645 goto nla_put_failure; 1646 if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, 1647 c->limits[j].max)) 1648 goto nla_put_failure; 1649 if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES, 1650 c->limits[j].types)) 1651 goto nla_put_failure; 1652 nla_nest_end(msg, nl_limit); 1653 } 1654 1655 nla_nest_end(msg, nl_limits); 1656 1657 if (c->beacon_int_infra_match && 1658 nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH)) 1659 goto nla_put_failure; 1660 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS, 1661 c->num_different_channels) || 1662 nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM, 1663 c->max_interfaces)) 1664 goto nla_put_failure; 1665 if (large && 1666 (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS, 1667 c->radar_detect_widths) || 1668 nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS, 1669 c->radar_detect_regions))) 1670 goto nla_put_failure; 1671 if (c->beacon_int_min_gcd && 1672 nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD, 1673 c->beacon_int_min_gcd)) 1674 goto nla_put_failure; 1675 1676 nla_nest_end(msg, nl_combi); 1677 } 1678 1679 nla_nest_end(msg, nl_combis); 1680 1681 return 0; 1682 nla_put_failure: 1683 return -ENOBUFS; 1684 } 1685 1686 #ifdef CONFIG_PM 1687 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev, 1688 struct sk_buff *msg) 1689 { 1690 const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp; 1691 struct nlattr *nl_tcp; 1692 1693 if (!tcp) 1694 return 0; 1695 1696 nl_tcp = nla_nest_start_noflag(msg, 1697 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 1698 if (!nl_tcp) 1699 return -ENOBUFS; 1700 1701 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1702 tcp->data_payload_max)) 1703 return -ENOBUFS; 1704 1705 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 1706 tcp->data_payload_max)) 1707 return -ENOBUFS; 1708 1709 if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ)) 1710 return -ENOBUFS; 1711 1712 if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 1713 sizeof(*tcp->tok), tcp->tok)) 1714 return -ENOBUFS; 1715 1716 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 1717 tcp->data_interval_max)) 1718 return -ENOBUFS; 1719 1720 if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 1721 tcp->wake_payload_max)) 1722 return -ENOBUFS; 1723 1724 nla_nest_end(msg, nl_tcp); 1725 return 0; 1726 } 1727 1728 static int nl80211_send_wowlan(struct sk_buff *msg, 1729 struct cfg80211_registered_device *rdev, 1730 bool large) 1731 { 1732 struct nlattr *nl_wowlan; 1733 1734 if (!rdev->wiphy.wowlan) 1735 return 0; 1736 1737 nl_wowlan = nla_nest_start_noflag(msg, 1738 NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED); 1739 if (!nl_wowlan) 1740 return -ENOBUFS; 1741 1742 if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) && 1743 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 1744 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) && 1745 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 1746 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) && 1747 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 1748 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) && 1749 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) || 1750 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) && 1751 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 1752 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) && 1753 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 1754 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) && 1755 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 1756 ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) && 1757 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 1758 return -ENOBUFS; 1759 1760 if (rdev->wiphy.wowlan->n_patterns) { 1761 struct nl80211_pattern_support pat = { 1762 .max_patterns = rdev->wiphy.wowlan->n_patterns, 1763 .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len, 1764 .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len, 1765 .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset, 1766 }; 1767 1768 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 1769 sizeof(pat), &pat)) 1770 return -ENOBUFS; 1771 } 1772 1773 if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) && 1774 nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT, 1775 rdev->wiphy.wowlan->max_nd_match_sets)) 1776 return -ENOBUFS; 1777 1778 if (large && nl80211_send_wowlan_tcp_caps(rdev, msg)) 1779 return -ENOBUFS; 1780 1781 nla_nest_end(msg, nl_wowlan); 1782 1783 return 0; 1784 } 1785 #endif 1786 1787 static int nl80211_send_coalesce(struct sk_buff *msg, 1788 struct cfg80211_registered_device *rdev) 1789 { 1790 struct nl80211_coalesce_rule_support rule; 1791 1792 if (!rdev->wiphy.coalesce) 1793 return 0; 1794 1795 rule.max_rules = rdev->wiphy.coalesce->n_rules; 1796 rule.max_delay = rdev->wiphy.coalesce->max_delay; 1797 rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns; 1798 rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len; 1799 rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len; 1800 rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset; 1801 1802 if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule)) 1803 return -ENOBUFS; 1804 1805 return 0; 1806 } 1807 1808 static int 1809 nl80211_send_iftype_data(struct sk_buff *msg, 1810 const struct ieee80211_supported_band *sband, 1811 const struct ieee80211_sband_iftype_data *iftdata) 1812 { 1813 const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap; 1814 const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap; 1815 1816 if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES, 1817 iftdata->types_mask)) 1818 return -ENOBUFS; 1819 1820 if (he_cap->has_he) { 1821 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC, 1822 sizeof(he_cap->he_cap_elem.mac_cap_info), 1823 he_cap->he_cap_elem.mac_cap_info) || 1824 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY, 1825 sizeof(he_cap->he_cap_elem.phy_cap_info), 1826 he_cap->he_cap_elem.phy_cap_info) || 1827 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET, 1828 sizeof(he_cap->he_mcs_nss_supp), 1829 &he_cap->he_mcs_nss_supp) || 1830 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE, 1831 sizeof(he_cap->ppe_thres), he_cap->ppe_thres)) 1832 return -ENOBUFS; 1833 } 1834 1835 if (eht_cap->has_eht && he_cap->has_he) { 1836 u8 mcs_nss_size, ppe_thresh_size; 1837 u16 ppe_thres_hdr; 1838 bool is_ap; 1839 1840 is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) || 1841 iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO); 1842 1843 mcs_nss_size = 1844 ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem, 1845 &eht_cap->eht_cap_elem, 1846 is_ap); 1847 1848 ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]); 1849 ppe_thresh_size = 1850 ieee80211_eht_ppe_size(ppe_thres_hdr, 1851 eht_cap->eht_cap_elem.phy_cap_info); 1852 1853 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC, 1854 sizeof(eht_cap->eht_cap_elem.mac_cap_info), 1855 eht_cap->eht_cap_elem.mac_cap_info) || 1856 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY, 1857 sizeof(eht_cap->eht_cap_elem.phy_cap_info), 1858 eht_cap->eht_cap_elem.phy_cap_info) || 1859 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET, 1860 mcs_nss_size, &eht_cap->eht_mcs_nss_supp) || 1861 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE, 1862 ppe_thresh_size, eht_cap->eht_ppe_thres)) 1863 return -ENOBUFS; 1864 } 1865 1866 if (sband->band == NL80211_BAND_6GHZ && 1867 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA, 1868 sizeof(iftdata->he_6ghz_capa), 1869 &iftdata->he_6ghz_capa)) 1870 return -ENOBUFS; 1871 1872 if (iftdata->vendor_elems.data && iftdata->vendor_elems.len && 1873 nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS, 1874 iftdata->vendor_elems.len, iftdata->vendor_elems.data)) 1875 return -ENOBUFS; 1876 1877 return 0; 1878 } 1879 1880 static int nl80211_send_band_rateinfo(struct sk_buff *msg, 1881 struct ieee80211_supported_band *sband, 1882 bool large) 1883 { 1884 struct nlattr *nl_rates, *nl_rate; 1885 struct ieee80211_rate *rate; 1886 int i; 1887 1888 /* add HT info */ 1889 if (sband->ht_cap.ht_supported && 1890 (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET, 1891 sizeof(sband->ht_cap.mcs), 1892 &sband->ht_cap.mcs) || 1893 nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA, 1894 sband->ht_cap.cap) || 1895 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR, 1896 sband->ht_cap.ampdu_factor) || 1897 nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY, 1898 sband->ht_cap.ampdu_density))) 1899 return -ENOBUFS; 1900 1901 /* add VHT info */ 1902 if (sband->vht_cap.vht_supported && 1903 (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET, 1904 sizeof(sband->vht_cap.vht_mcs), 1905 &sband->vht_cap.vht_mcs) || 1906 nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA, 1907 sband->vht_cap.cap))) 1908 return -ENOBUFS; 1909 1910 if (large && sband->n_iftype_data) { 1911 struct nlattr *nl_iftype_data = 1912 nla_nest_start_noflag(msg, 1913 NL80211_BAND_ATTR_IFTYPE_DATA); 1914 int err; 1915 1916 if (!nl_iftype_data) 1917 return -ENOBUFS; 1918 1919 for (i = 0; i < sband->n_iftype_data; i++) { 1920 struct nlattr *iftdata; 1921 1922 iftdata = nla_nest_start_noflag(msg, i + 1); 1923 if (!iftdata) 1924 return -ENOBUFS; 1925 1926 err = nl80211_send_iftype_data(msg, sband, 1927 &sband->iftype_data[i]); 1928 if (err) 1929 return err; 1930 1931 nla_nest_end(msg, iftdata); 1932 } 1933 1934 nla_nest_end(msg, nl_iftype_data); 1935 } 1936 1937 /* add EDMG info */ 1938 if (large && sband->edmg_cap.channels && 1939 (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS, 1940 sband->edmg_cap.channels) || 1941 nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG, 1942 sband->edmg_cap.bw_config))) 1943 1944 return -ENOBUFS; 1945 1946 /* add bitrates */ 1947 nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES); 1948 if (!nl_rates) 1949 return -ENOBUFS; 1950 1951 for (i = 0; i < sband->n_bitrates; i++) { 1952 nl_rate = nla_nest_start_noflag(msg, i); 1953 if (!nl_rate) 1954 return -ENOBUFS; 1955 1956 rate = &sband->bitrates[i]; 1957 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE, 1958 rate->bitrate)) 1959 return -ENOBUFS; 1960 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) && 1961 nla_put_flag(msg, 1962 NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE)) 1963 return -ENOBUFS; 1964 1965 nla_nest_end(msg, nl_rate); 1966 } 1967 1968 nla_nest_end(msg, nl_rates); 1969 1970 /* S1G capabilities */ 1971 if (sband->band == NL80211_BAND_S1GHZ && sband->s1g_cap.s1g && 1972 (nla_put(msg, NL80211_BAND_ATTR_S1G_CAPA, 1973 sizeof(sband->s1g_cap.cap), 1974 sband->s1g_cap.cap) || 1975 nla_put(msg, NL80211_BAND_ATTR_S1G_MCS_NSS_SET, 1976 sizeof(sband->s1g_cap.nss_mcs), 1977 sband->s1g_cap.nss_mcs))) 1978 return -ENOBUFS; 1979 1980 return 0; 1981 } 1982 1983 static int 1984 nl80211_send_mgmt_stypes(struct sk_buff *msg, 1985 const struct ieee80211_txrx_stypes *mgmt_stypes) 1986 { 1987 u16 stypes; 1988 struct nlattr *nl_ftypes, *nl_ifs; 1989 enum nl80211_iftype ift; 1990 int i; 1991 1992 if (!mgmt_stypes) 1993 return 0; 1994 1995 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES); 1996 if (!nl_ifs) 1997 return -ENOBUFS; 1998 1999 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2000 nl_ftypes = nla_nest_start_noflag(msg, ift); 2001 if (!nl_ftypes) 2002 return -ENOBUFS; 2003 i = 0; 2004 stypes = mgmt_stypes[ift].tx; 2005 while (stypes) { 2006 if ((stypes & 1) && 2007 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2008 (i << 4) | IEEE80211_FTYPE_MGMT)) 2009 return -ENOBUFS; 2010 stypes >>= 1; 2011 i++; 2012 } 2013 nla_nest_end(msg, nl_ftypes); 2014 } 2015 2016 nla_nest_end(msg, nl_ifs); 2017 2018 nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES); 2019 if (!nl_ifs) 2020 return -ENOBUFS; 2021 2022 for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) { 2023 nl_ftypes = nla_nest_start_noflag(msg, ift); 2024 if (!nl_ftypes) 2025 return -ENOBUFS; 2026 i = 0; 2027 stypes = mgmt_stypes[ift].rx; 2028 while (stypes) { 2029 if ((stypes & 1) && 2030 nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE, 2031 (i << 4) | IEEE80211_FTYPE_MGMT)) 2032 return -ENOBUFS; 2033 stypes >>= 1; 2034 i++; 2035 } 2036 nla_nest_end(msg, nl_ftypes); 2037 } 2038 nla_nest_end(msg, nl_ifs); 2039 2040 return 0; 2041 } 2042 2043 #define CMD(op, n) \ 2044 do { \ 2045 if (rdev->ops->op) { \ 2046 i++; \ 2047 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \ 2048 goto nla_put_failure; \ 2049 } \ 2050 } while (0) 2051 2052 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev, 2053 struct sk_buff *msg) 2054 { 2055 int i = 0; 2056 2057 /* 2058 * do *NOT* add anything into this function, new things need to be 2059 * advertised only to new versions of userspace that can deal with 2060 * the split (and they can't possibly care about new features... 2061 */ 2062 CMD(add_virtual_intf, NEW_INTERFACE); 2063 CMD(change_virtual_intf, SET_INTERFACE); 2064 CMD(add_key, NEW_KEY); 2065 CMD(start_ap, START_AP); 2066 CMD(add_station, NEW_STATION); 2067 CMD(add_mpath, NEW_MPATH); 2068 CMD(update_mesh_config, SET_MESH_CONFIG); 2069 CMD(change_bss, SET_BSS); 2070 CMD(auth, AUTHENTICATE); 2071 CMD(assoc, ASSOCIATE); 2072 CMD(deauth, DEAUTHENTICATE); 2073 CMD(disassoc, DISASSOCIATE); 2074 CMD(join_ibss, JOIN_IBSS); 2075 CMD(join_mesh, JOIN_MESH); 2076 CMD(set_pmksa, SET_PMKSA); 2077 CMD(del_pmksa, DEL_PMKSA); 2078 CMD(flush_pmksa, FLUSH_PMKSA); 2079 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) 2080 CMD(remain_on_channel, REMAIN_ON_CHANNEL); 2081 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK); 2082 CMD(mgmt_tx, FRAME); 2083 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL); 2084 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) { 2085 i++; 2086 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS)) 2087 goto nla_put_failure; 2088 } 2089 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap || 2090 rdev->ops->join_mesh) { 2091 i++; 2092 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL)) 2093 goto nla_put_failure; 2094 } 2095 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) { 2096 CMD(tdls_mgmt, TDLS_MGMT); 2097 CMD(tdls_oper, TDLS_OPER); 2098 } 2099 if (rdev->wiphy.max_sched_scan_reqs) 2100 CMD(sched_scan_start, START_SCHED_SCAN); 2101 CMD(probe_client, PROBE_CLIENT); 2102 CMD(set_noack_map, SET_NOACK_MAP); 2103 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) { 2104 i++; 2105 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS)) 2106 goto nla_put_failure; 2107 } 2108 CMD(start_p2p_device, START_P2P_DEVICE); 2109 CMD(set_mcast_rate, SET_MCAST_RATE); 2110 #ifdef CONFIG_NL80211_TESTMODE 2111 CMD(testmode_cmd, TESTMODE); 2112 #endif 2113 2114 if (rdev->ops->connect || rdev->ops->auth) { 2115 i++; 2116 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT)) 2117 goto nla_put_failure; 2118 } 2119 2120 if (rdev->ops->disconnect || rdev->ops->deauth) { 2121 i++; 2122 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT)) 2123 goto nla_put_failure; 2124 } 2125 2126 return i; 2127 nla_put_failure: 2128 return -ENOBUFS; 2129 } 2130 2131 static int 2132 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap, 2133 struct sk_buff *msg) 2134 { 2135 struct nlattr *ftm; 2136 2137 if (!cap->ftm.supported) 2138 return 0; 2139 2140 ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM); 2141 if (!ftm) 2142 return -ENOBUFS; 2143 2144 if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP)) 2145 return -ENOBUFS; 2146 if (cap->ftm.non_asap && 2147 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP)) 2148 return -ENOBUFS; 2149 if (cap->ftm.request_lci && 2150 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI)) 2151 return -ENOBUFS; 2152 if (cap->ftm.request_civicloc && 2153 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC)) 2154 return -ENOBUFS; 2155 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES, 2156 cap->ftm.preambles)) 2157 return -ENOBUFS; 2158 if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS, 2159 cap->ftm.bandwidths)) 2160 return -ENOBUFS; 2161 if (cap->ftm.max_bursts_exponent >= 0 && 2162 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT, 2163 cap->ftm.max_bursts_exponent)) 2164 return -ENOBUFS; 2165 if (cap->ftm.max_ftms_per_burst && 2166 nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST, 2167 cap->ftm.max_ftms_per_burst)) 2168 return -ENOBUFS; 2169 if (cap->ftm.trigger_based && 2170 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED)) 2171 return -ENOBUFS; 2172 if (cap->ftm.non_trigger_based && 2173 nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED)) 2174 return -ENOBUFS; 2175 2176 nla_nest_end(msg, ftm); 2177 return 0; 2178 } 2179 2180 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev, 2181 struct sk_buff *msg) 2182 { 2183 const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa; 2184 struct nlattr *pmsr, *caps; 2185 2186 if (!cap) 2187 return 0; 2188 2189 /* 2190 * we don't need to clean up anything here since the caller 2191 * will genlmsg_cancel() if we fail 2192 */ 2193 2194 pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS); 2195 if (!pmsr) 2196 return -ENOBUFS; 2197 2198 if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers)) 2199 return -ENOBUFS; 2200 2201 if (cap->report_ap_tsf && 2202 nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF)) 2203 return -ENOBUFS; 2204 2205 if (cap->randomize_mac_addr && 2206 nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR)) 2207 return -ENOBUFS; 2208 2209 caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA); 2210 if (!caps) 2211 return -ENOBUFS; 2212 2213 if (nl80211_send_pmsr_ftm_capa(cap, msg)) 2214 return -ENOBUFS; 2215 2216 nla_nest_end(msg, caps); 2217 nla_nest_end(msg, pmsr); 2218 2219 return 0; 2220 } 2221 2222 static int 2223 nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev, 2224 struct sk_buff *msg) 2225 { 2226 int i; 2227 struct nlattr *nested, *nested_akms; 2228 const struct wiphy_iftype_akm_suites *iftype_akms; 2229 2230 if (!rdev->wiphy.num_iftype_akm_suites || 2231 !rdev->wiphy.iftype_akm_suites) 2232 return 0; 2233 2234 nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES); 2235 if (!nested) 2236 return -ENOBUFS; 2237 2238 for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) { 2239 nested_akms = nla_nest_start(msg, i + 1); 2240 if (!nested_akms) 2241 return -ENOBUFS; 2242 2243 iftype_akms = &rdev->wiphy.iftype_akm_suites[i]; 2244 2245 if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES, 2246 iftype_akms->iftypes_mask)) 2247 return -ENOBUFS; 2248 2249 if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES, 2250 sizeof(u32) * iftype_akms->n_akm_suites, 2251 iftype_akms->akm_suites)) { 2252 return -ENOBUFS; 2253 } 2254 nla_nest_end(msg, nested_akms); 2255 } 2256 2257 nla_nest_end(msg, nested); 2258 2259 return 0; 2260 } 2261 2262 static int 2263 nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev, 2264 struct sk_buff *msg) 2265 { 2266 struct nlattr *supp; 2267 2268 if (!rdev->wiphy.tid_config_support.vif && 2269 !rdev->wiphy.tid_config_support.peer) 2270 return 0; 2271 2272 supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG); 2273 if (!supp) 2274 return -ENOSPC; 2275 2276 if (rdev->wiphy.tid_config_support.vif && 2277 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP, 2278 rdev->wiphy.tid_config_support.vif, 2279 NL80211_TID_CONFIG_ATTR_PAD)) 2280 goto fail; 2281 2282 if (rdev->wiphy.tid_config_support.peer && 2283 nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP, 2284 rdev->wiphy.tid_config_support.peer, 2285 NL80211_TID_CONFIG_ATTR_PAD)) 2286 goto fail; 2287 2288 /* for now we just use the same value ... makes more sense */ 2289 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT, 2290 rdev->wiphy.tid_config_support.max_retry)) 2291 goto fail; 2292 if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG, 2293 rdev->wiphy.tid_config_support.max_retry)) 2294 goto fail; 2295 2296 nla_nest_end(msg, supp); 2297 2298 return 0; 2299 fail: 2300 nla_nest_cancel(msg, supp); 2301 return -ENOBUFS; 2302 } 2303 2304 static int 2305 nl80211_put_sar_specs(struct cfg80211_registered_device *rdev, 2306 struct sk_buff *msg) 2307 { 2308 struct nlattr *sar_capa, *specs, *sub_freq_range; 2309 u8 num_freq_ranges; 2310 int i; 2311 2312 if (!rdev->wiphy.sar_capa) 2313 return 0; 2314 2315 num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges; 2316 2317 sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC); 2318 if (!sar_capa) 2319 return -ENOSPC; 2320 2321 if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type)) 2322 goto fail; 2323 2324 specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS); 2325 if (!specs) 2326 goto fail; 2327 2328 /* report supported freq_ranges */ 2329 for (i = 0; i < num_freq_ranges; i++) { 2330 sub_freq_range = nla_nest_start(msg, i + 1); 2331 if (!sub_freq_range) 2332 goto fail; 2333 2334 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ, 2335 rdev->wiphy.sar_capa->freq_ranges[i].start_freq)) 2336 goto fail; 2337 2338 if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ, 2339 rdev->wiphy.sar_capa->freq_ranges[i].end_freq)) 2340 goto fail; 2341 2342 nla_nest_end(msg, sub_freq_range); 2343 } 2344 2345 nla_nest_end(msg, specs); 2346 nla_nest_end(msg, sar_capa); 2347 2348 return 0; 2349 fail: 2350 nla_nest_cancel(msg, sar_capa); 2351 return -ENOBUFS; 2352 } 2353 2354 static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg) 2355 { 2356 struct nlattr *config; 2357 2358 if (!wiphy->mbssid_max_interfaces) 2359 return 0; 2360 2361 config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG); 2362 if (!config) 2363 return -ENOBUFS; 2364 2365 if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES, 2366 wiphy->mbssid_max_interfaces)) 2367 goto fail; 2368 2369 if (wiphy->ema_max_profile_periodicity && 2370 nla_put_u8(msg, 2371 NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY, 2372 wiphy->ema_max_profile_periodicity)) 2373 goto fail; 2374 2375 nla_nest_end(msg, config); 2376 return 0; 2377 2378 fail: 2379 nla_nest_cancel(msg, config); 2380 return -ENOBUFS; 2381 } 2382 2383 struct nl80211_dump_wiphy_state { 2384 s64 filter_wiphy; 2385 long start; 2386 long split_start, band_start, chan_start, capa_start; 2387 bool split; 2388 }; 2389 2390 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev, 2391 enum nl80211_commands cmd, 2392 struct sk_buff *msg, u32 portid, u32 seq, 2393 int flags, struct nl80211_dump_wiphy_state *state) 2394 { 2395 void *hdr; 2396 struct nlattr *nl_bands, *nl_band; 2397 struct nlattr *nl_freqs, *nl_freq; 2398 struct nlattr *nl_cmds; 2399 enum nl80211_band band; 2400 struct ieee80211_channel *chan; 2401 int i; 2402 const struct ieee80211_txrx_stypes *mgmt_stypes = 2403 rdev->wiphy.mgmt_stypes; 2404 u32 features; 2405 2406 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 2407 if (!hdr) 2408 return -ENOBUFS; 2409 2410 if (WARN_ON(!state)) 2411 return -EINVAL; 2412 2413 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 2414 nla_put_string(msg, NL80211_ATTR_WIPHY_NAME, 2415 wiphy_name(&rdev->wiphy)) || 2416 nla_put_u32(msg, NL80211_ATTR_GENERATION, 2417 cfg80211_rdev_list_generation)) 2418 goto nla_put_failure; 2419 2420 if (cmd != NL80211_CMD_NEW_WIPHY) 2421 goto finish; 2422 2423 switch (state->split_start) { 2424 case 0: 2425 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT, 2426 rdev->wiphy.retry_short) || 2427 nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG, 2428 rdev->wiphy.retry_long) || 2429 nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD, 2430 rdev->wiphy.frag_threshold) || 2431 nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD, 2432 rdev->wiphy.rts_threshold) || 2433 nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS, 2434 rdev->wiphy.coverage_class) || 2435 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS, 2436 rdev->wiphy.max_scan_ssids) || 2437 nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS, 2438 rdev->wiphy.max_sched_scan_ssids) || 2439 nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN, 2440 rdev->wiphy.max_scan_ie_len) || 2441 nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN, 2442 rdev->wiphy.max_sched_scan_ie_len) || 2443 nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS, 2444 rdev->wiphy.max_match_sets)) 2445 goto nla_put_failure; 2446 2447 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) && 2448 nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN)) 2449 goto nla_put_failure; 2450 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) && 2451 nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH)) 2452 goto nla_put_failure; 2453 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) && 2454 nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD)) 2455 goto nla_put_failure; 2456 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) && 2457 nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT)) 2458 goto nla_put_failure; 2459 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) && 2460 nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT)) 2461 goto nla_put_failure; 2462 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) && 2463 nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP)) 2464 goto nla_put_failure; 2465 state->split_start++; 2466 if (state->split) 2467 break; 2468 fallthrough; 2469 case 1: 2470 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES, 2471 sizeof(u32) * rdev->wiphy.n_cipher_suites, 2472 rdev->wiphy.cipher_suites)) 2473 goto nla_put_failure; 2474 2475 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS, 2476 rdev->wiphy.max_num_pmkids)) 2477 goto nla_put_failure; 2478 2479 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 2480 nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE)) 2481 goto nla_put_failure; 2482 2483 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX, 2484 rdev->wiphy.available_antennas_tx) || 2485 nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX, 2486 rdev->wiphy.available_antennas_rx)) 2487 goto nla_put_failure; 2488 2489 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) && 2490 nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD, 2491 rdev->wiphy.probe_resp_offload)) 2492 goto nla_put_failure; 2493 2494 if ((rdev->wiphy.available_antennas_tx || 2495 rdev->wiphy.available_antennas_rx) && 2496 rdev->ops->get_antenna) { 2497 u32 tx_ant = 0, rx_ant = 0; 2498 int res; 2499 2500 res = rdev_get_antenna(rdev, &tx_ant, &rx_ant); 2501 if (!res) { 2502 if (nla_put_u32(msg, 2503 NL80211_ATTR_WIPHY_ANTENNA_TX, 2504 tx_ant) || 2505 nla_put_u32(msg, 2506 NL80211_ATTR_WIPHY_ANTENNA_RX, 2507 rx_ant)) 2508 goto nla_put_failure; 2509 } 2510 } 2511 2512 state->split_start++; 2513 if (state->split) 2514 break; 2515 fallthrough; 2516 case 2: 2517 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES, 2518 rdev->wiphy.interface_modes)) 2519 goto nla_put_failure; 2520 state->split_start++; 2521 if (state->split) 2522 break; 2523 fallthrough; 2524 case 3: 2525 nl_bands = nla_nest_start_noflag(msg, 2526 NL80211_ATTR_WIPHY_BANDS); 2527 if (!nl_bands) 2528 goto nla_put_failure; 2529 2530 for (band = state->band_start; 2531 band < (state->split ? 2532 NUM_NL80211_BANDS : 2533 NL80211_BAND_60GHZ + 1); 2534 band++) { 2535 struct ieee80211_supported_band *sband; 2536 2537 /* omit higher bands for ancient software */ 2538 if (band > NL80211_BAND_5GHZ && !state->split) 2539 break; 2540 2541 sband = rdev->wiphy.bands[band]; 2542 2543 if (!sband) 2544 continue; 2545 2546 nl_band = nla_nest_start_noflag(msg, band); 2547 if (!nl_band) 2548 goto nla_put_failure; 2549 2550 switch (state->chan_start) { 2551 case 0: 2552 if (nl80211_send_band_rateinfo(msg, sband, 2553 state->split)) 2554 goto nla_put_failure; 2555 state->chan_start++; 2556 if (state->split) 2557 break; 2558 fallthrough; 2559 default: 2560 /* add frequencies */ 2561 nl_freqs = nla_nest_start_noflag(msg, 2562 NL80211_BAND_ATTR_FREQS); 2563 if (!nl_freqs) 2564 goto nla_put_failure; 2565 2566 for (i = state->chan_start - 1; 2567 i < sband->n_channels; 2568 i++) { 2569 nl_freq = nla_nest_start_noflag(msg, 2570 i); 2571 if (!nl_freq) 2572 goto nla_put_failure; 2573 2574 chan = &sband->channels[i]; 2575 2576 if (nl80211_msg_put_channel( 2577 msg, &rdev->wiphy, chan, 2578 state->split)) 2579 goto nla_put_failure; 2580 2581 nla_nest_end(msg, nl_freq); 2582 if (state->split) 2583 break; 2584 } 2585 if (i < sband->n_channels) 2586 state->chan_start = i + 2; 2587 else 2588 state->chan_start = 0; 2589 nla_nest_end(msg, nl_freqs); 2590 } 2591 2592 nla_nest_end(msg, nl_band); 2593 2594 if (state->split) { 2595 /* start again here */ 2596 if (state->chan_start) 2597 band--; 2598 break; 2599 } 2600 } 2601 nla_nest_end(msg, nl_bands); 2602 2603 if (band < NUM_NL80211_BANDS) 2604 state->band_start = band + 1; 2605 else 2606 state->band_start = 0; 2607 2608 /* if bands & channels are done, continue outside */ 2609 if (state->band_start == 0 && state->chan_start == 0) 2610 state->split_start++; 2611 if (state->split) 2612 break; 2613 fallthrough; 2614 case 4: 2615 nl_cmds = nla_nest_start_noflag(msg, 2616 NL80211_ATTR_SUPPORTED_COMMANDS); 2617 if (!nl_cmds) 2618 goto nla_put_failure; 2619 2620 i = nl80211_add_commands_unsplit(rdev, msg); 2621 if (i < 0) 2622 goto nla_put_failure; 2623 if (state->split) { 2624 CMD(crit_proto_start, CRIT_PROTOCOL_START); 2625 CMD(crit_proto_stop, CRIT_PROTOCOL_STOP); 2626 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH) 2627 CMD(channel_switch, CHANNEL_SWITCH); 2628 CMD(set_qos_map, SET_QOS_MAP); 2629 if (rdev->wiphy.features & 2630 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION) 2631 CMD(add_tx_ts, ADD_TX_TS); 2632 CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST); 2633 CMD(update_connect_params, UPDATE_CONNECT_PARAMS); 2634 CMD(update_ft_ies, UPDATE_FT_IES); 2635 if (rdev->wiphy.sar_capa) 2636 CMD(set_sar_specs, SET_SAR_SPECS); 2637 } 2638 #undef CMD 2639 2640 nla_nest_end(msg, nl_cmds); 2641 state->split_start++; 2642 if (state->split) 2643 break; 2644 fallthrough; 2645 case 5: 2646 if (rdev->ops->remain_on_channel && 2647 (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) && 2648 nla_put_u32(msg, 2649 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION, 2650 rdev->wiphy.max_remain_on_channel_duration)) 2651 goto nla_put_failure; 2652 2653 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) && 2654 nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK)) 2655 goto nla_put_failure; 2656 2657 state->split_start++; 2658 if (state->split) 2659 break; 2660 fallthrough; 2661 case 6: 2662 #ifdef CONFIG_PM 2663 if (nl80211_send_wowlan(msg, rdev, state->split)) 2664 goto nla_put_failure; 2665 state->split_start++; 2666 if (state->split) 2667 break; 2668 #else 2669 state->split_start++; 2670 #endif 2671 fallthrough; 2672 case 7: 2673 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES, 2674 rdev->wiphy.software_iftypes)) 2675 goto nla_put_failure; 2676 2677 if (nl80211_put_iface_combinations(&rdev->wiphy, msg, 2678 state->split)) 2679 goto nla_put_failure; 2680 2681 state->split_start++; 2682 if (state->split) 2683 break; 2684 fallthrough; 2685 case 8: 2686 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) && 2687 nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME, 2688 rdev->wiphy.ap_sme_capa)) 2689 goto nla_put_failure; 2690 2691 features = rdev->wiphy.features; 2692 /* 2693 * We can only add the per-channel limit information if the 2694 * dump is split, otherwise it makes it too big. Therefore 2695 * only advertise it in that case. 2696 */ 2697 if (state->split) 2698 features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS; 2699 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features)) 2700 goto nla_put_failure; 2701 2702 if (rdev->wiphy.ht_capa_mod_mask && 2703 nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK, 2704 sizeof(*rdev->wiphy.ht_capa_mod_mask), 2705 rdev->wiphy.ht_capa_mod_mask)) 2706 goto nla_put_failure; 2707 2708 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME && 2709 rdev->wiphy.max_acl_mac_addrs && 2710 nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX, 2711 rdev->wiphy.max_acl_mac_addrs)) 2712 goto nla_put_failure; 2713 2714 /* 2715 * Any information below this point is only available to 2716 * applications that can deal with it being split. This 2717 * helps ensure that newly added capabilities don't break 2718 * older tools by overrunning their buffers. 2719 * 2720 * We still increment split_start so that in the split 2721 * case we'll continue with more data in the next round, 2722 * but break unconditionally so unsplit data stops here. 2723 */ 2724 if (state->split) 2725 state->split_start++; 2726 else 2727 state->split_start = 0; 2728 break; 2729 case 9: 2730 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes)) 2731 goto nla_put_failure; 2732 2733 if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS, 2734 rdev->wiphy.max_sched_scan_plans) || 2735 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL, 2736 rdev->wiphy.max_sched_scan_plan_interval) || 2737 nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS, 2738 rdev->wiphy.max_sched_scan_plan_iterations)) 2739 goto nla_put_failure; 2740 2741 if (rdev->wiphy.extended_capabilities && 2742 (nla_put(msg, NL80211_ATTR_EXT_CAPA, 2743 rdev->wiphy.extended_capabilities_len, 2744 rdev->wiphy.extended_capabilities) || 2745 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2746 rdev->wiphy.extended_capabilities_len, 2747 rdev->wiphy.extended_capabilities_mask))) 2748 goto nla_put_failure; 2749 2750 if (rdev->wiphy.vht_capa_mod_mask && 2751 nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK, 2752 sizeof(*rdev->wiphy.vht_capa_mod_mask), 2753 rdev->wiphy.vht_capa_mod_mask)) 2754 goto nla_put_failure; 2755 2756 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 2757 rdev->wiphy.perm_addr)) 2758 goto nla_put_failure; 2759 2760 if (!is_zero_ether_addr(rdev->wiphy.addr_mask) && 2761 nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN, 2762 rdev->wiphy.addr_mask)) 2763 goto nla_put_failure; 2764 2765 if (rdev->wiphy.n_addresses > 1) { 2766 void *attr; 2767 2768 attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS); 2769 if (!attr) 2770 goto nla_put_failure; 2771 2772 for (i = 0; i < rdev->wiphy.n_addresses; i++) 2773 if (nla_put(msg, i + 1, ETH_ALEN, 2774 rdev->wiphy.addresses[i].addr)) 2775 goto nla_put_failure; 2776 2777 nla_nest_end(msg, attr); 2778 } 2779 2780 state->split_start++; 2781 break; 2782 case 10: 2783 if (nl80211_send_coalesce(msg, rdev)) 2784 goto nla_put_failure; 2785 2786 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) && 2787 (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) || 2788 nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ))) 2789 goto nla_put_failure; 2790 2791 if (rdev->wiphy.max_ap_assoc_sta && 2792 nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA, 2793 rdev->wiphy.max_ap_assoc_sta)) 2794 goto nla_put_failure; 2795 2796 state->split_start++; 2797 break; 2798 case 11: 2799 if (rdev->wiphy.n_vendor_commands) { 2800 const struct nl80211_vendor_cmd_info *info; 2801 struct nlattr *nested; 2802 2803 nested = nla_nest_start_noflag(msg, 2804 NL80211_ATTR_VENDOR_DATA); 2805 if (!nested) 2806 goto nla_put_failure; 2807 2808 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 2809 info = &rdev->wiphy.vendor_commands[i].info; 2810 if (nla_put(msg, i + 1, sizeof(*info), info)) 2811 goto nla_put_failure; 2812 } 2813 nla_nest_end(msg, nested); 2814 } 2815 2816 if (rdev->wiphy.n_vendor_events) { 2817 const struct nl80211_vendor_cmd_info *info; 2818 struct nlattr *nested; 2819 2820 nested = nla_nest_start_noflag(msg, 2821 NL80211_ATTR_VENDOR_EVENTS); 2822 if (!nested) 2823 goto nla_put_failure; 2824 2825 for (i = 0; i < rdev->wiphy.n_vendor_events; i++) { 2826 info = &rdev->wiphy.vendor_events[i]; 2827 if (nla_put(msg, i + 1, sizeof(*info), info)) 2828 goto nla_put_failure; 2829 } 2830 nla_nest_end(msg, nested); 2831 } 2832 state->split_start++; 2833 break; 2834 case 12: 2835 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH && 2836 nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS, 2837 rdev->wiphy.max_num_csa_counters)) 2838 goto nla_put_failure; 2839 2840 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 2841 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 2842 goto nla_put_failure; 2843 2844 if (rdev->wiphy.max_sched_scan_reqs && 2845 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS, 2846 rdev->wiphy.max_sched_scan_reqs)) 2847 goto nla_put_failure; 2848 2849 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES, 2850 sizeof(rdev->wiphy.ext_features), 2851 rdev->wiphy.ext_features)) 2852 goto nla_put_failure; 2853 2854 if (rdev->wiphy.bss_select_support) { 2855 struct nlattr *nested; 2856 u32 bss_select_support = rdev->wiphy.bss_select_support; 2857 2858 nested = nla_nest_start_noflag(msg, 2859 NL80211_ATTR_BSS_SELECT); 2860 if (!nested) 2861 goto nla_put_failure; 2862 2863 i = 0; 2864 while (bss_select_support) { 2865 if ((bss_select_support & 1) && 2866 nla_put_flag(msg, i)) 2867 goto nla_put_failure; 2868 i++; 2869 bss_select_support >>= 1; 2870 } 2871 nla_nest_end(msg, nested); 2872 } 2873 2874 state->split_start++; 2875 break; 2876 case 13: 2877 if (rdev->wiphy.num_iftype_ext_capab && 2878 rdev->wiphy.iftype_ext_capab) { 2879 struct nlattr *nested_ext_capab, *nested; 2880 2881 nested = nla_nest_start_noflag(msg, 2882 NL80211_ATTR_IFTYPE_EXT_CAPA); 2883 if (!nested) 2884 goto nla_put_failure; 2885 2886 for (i = state->capa_start; 2887 i < rdev->wiphy.num_iftype_ext_capab; i++) { 2888 const struct wiphy_iftype_ext_capab *capab; 2889 2890 capab = &rdev->wiphy.iftype_ext_capab[i]; 2891 2892 nested_ext_capab = nla_nest_start_noflag(msg, 2893 i); 2894 if (!nested_ext_capab || 2895 nla_put_u32(msg, NL80211_ATTR_IFTYPE, 2896 capab->iftype) || 2897 nla_put(msg, NL80211_ATTR_EXT_CAPA, 2898 capab->extended_capabilities_len, 2899 capab->extended_capabilities) || 2900 nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK, 2901 capab->extended_capabilities_len, 2902 capab->extended_capabilities_mask)) 2903 goto nla_put_failure; 2904 2905 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO && 2906 (nla_put_u16(msg, 2907 NL80211_ATTR_EML_CAPABILITY, 2908 capab->eml_capabilities) || 2909 nla_put_u16(msg, 2910 NL80211_ATTR_MLD_CAPA_AND_OPS, 2911 capab->mld_capa_and_ops))) 2912 goto nla_put_failure; 2913 2914 nla_nest_end(msg, nested_ext_capab); 2915 if (state->split) 2916 break; 2917 } 2918 nla_nest_end(msg, nested); 2919 if (i < rdev->wiphy.num_iftype_ext_capab) { 2920 state->capa_start = i + 1; 2921 break; 2922 } 2923 } 2924 2925 if (nla_put_u32(msg, NL80211_ATTR_BANDS, 2926 rdev->wiphy.nan_supported_bands)) 2927 goto nla_put_failure; 2928 2929 if (wiphy_ext_feature_isset(&rdev->wiphy, 2930 NL80211_EXT_FEATURE_TXQS)) { 2931 struct cfg80211_txq_stats txqstats = {}; 2932 int res; 2933 2934 res = rdev_get_txq_stats(rdev, NULL, &txqstats); 2935 if (!res && 2936 !nl80211_put_txq_stats(msg, &txqstats, 2937 NL80211_ATTR_TXQ_STATS)) 2938 goto nla_put_failure; 2939 2940 if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT, 2941 rdev->wiphy.txq_limit)) 2942 goto nla_put_failure; 2943 if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT, 2944 rdev->wiphy.txq_memory_limit)) 2945 goto nla_put_failure; 2946 if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM, 2947 rdev->wiphy.txq_quantum)) 2948 goto nla_put_failure; 2949 } 2950 2951 state->split_start++; 2952 break; 2953 case 14: 2954 if (nl80211_send_pmsr_capa(rdev, msg)) 2955 goto nla_put_failure; 2956 2957 state->split_start++; 2958 break; 2959 case 15: 2960 if (rdev->wiphy.akm_suites && 2961 nla_put(msg, NL80211_ATTR_AKM_SUITES, 2962 sizeof(u32) * rdev->wiphy.n_akm_suites, 2963 rdev->wiphy.akm_suites)) 2964 goto nla_put_failure; 2965 2966 if (nl80211_put_iftype_akm_suites(rdev, msg)) 2967 goto nla_put_failure; 2968 2969 if (nl80211_put_tid_config_support(rdev, msg)) 2970 goto nla_put_failure; 2971 state->split_start++; 2972 break; 2973 case 16: 2974 if (nl80211_put_sar_specs(rdev, msg)) 2975 goto nla_put_failure; 2976 2977 if (nl80211_put_mbssid_support(&rdev->wiphy, msg)) 2978 goto nla_put_failure; 2979 2980 if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES, 2981 rdev->wiphy.max_num_akm_suites)) 2982 goto nla_put_failure; 2983 2984 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO) 2985 nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT); 2986 2987 if (rdev->wiphy.hw_timestamp_max_peers && 2988 nla_put_u16(msg, NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS, 2989 rdev->wiphy.hw_timestamp_max_peers)) 2990 goto nla_put_failure; 2991 2992 /* done */ 2993 state->split_start = 0; 2994 break; 2995 } 2996 finish: 2997 genlmsg_end(msg, hdr); 2998 return 0; 2999 3000 nla_put_failure: 3001 genlmsg_cancel(msg, hdr); 3002 return -EMSGSIZE; 3003 } 3004 3005 static int nl80211_dump_wiphy_parse(struct sk_buff *skb, 3006 struct netlink_callback *cb, 3007 struct nl80211_dump_wiphy_state *state) 3008 { 3009 struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 3010 int ret; 3011 3012 if (!tb) 3013 return -ENOMEM; 3014 3015 ret = nlmsg_parse_deprecated(cb->nlh, 3016 GENL_HDRLEN + nl80211_fam.hdrsize, 3017 tb, nl80211_fam.maxattr, 3018 nl80211_policy, NULL); 3019 /* ignore parse errors for backward compatibility */ 3020 if (ret) { 3021 ret = 0; 3022 goto out; 3023 } 3024 3025 state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP]; 3026 if (tb[NL80211_ATTR_WIPHY]) 3027 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]); 3028 if (tb[NL80211_ATTR_WDEV]) 3029 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32; 3030 if (tb[NL80211_ATTR_IFINDEX]) { 3031 struct net_device *netdev; 3032 struct cfg80211_registered_device *rdev; 3033 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]); 3034 3035 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx); 3036 if (!netdev) { 3037 ret = -ENODEV; 3038 goto out; 3039 } 3040 if (netdev->ieee80211_ptr) { 3041 rdev = wiphy_to_rdev( 3042 netdev->ieee80211_ptr->wiphy); 3043 state->filter_wiphy = rdev->wiphy_idx; 3044 } 3045 } 3046 3047 ret = 0; 3048 out: 3049 kfree(tb); 3050 return ret; 3051 } 3052 3053 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb) 3054 { 3055 int idx = 0, ret; 3056 struct nl80211_dump_wiphy_state *state = (void *)cb->args[0]; 3057 struct cfg80211_registered_device *rdev; 3058 3059 rtnl_lock(); 3060 if (!state) { 3061 state = kzalloc(sizeof(*state), GFP_KERNEL); 3062 if (!state) { 3063 rtnl_unlock(); 3064 return -ENOMEM; 3065 } 3066 state->filter_wiphy = -1; 3067 ret = nl80211_dump_wiphy_parse(skb, cb, state); 3068 if (ret) { 3069 kfree(state); 3070 rtnl_unlock(); 3071 return ret; 3072 } 3073 cb->args[0] = (long)state; 3074 } 3075 3076 list_for_each_entry(rdev, &cfg80211_rdev_list, list) { 3077 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 3078 continue; 3079 if (++idx <= state->start) 3080 continue; 3081 if (state->filter_wiphy != -1 && 3082 state->filter_wiphy != rdev->wiphy_idx) 3083 continue; 3084 wiphy_lock(&rdev->wiphy); 3085 /* attempt to fit multiple wiphy data chunks into the skb */ 3086 do { 3087 ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, 3088 skb, 3089 NETLINK_CB(cb->skb).portid, 3090 cb->nlh->nlmsg_seq, 3091 NLM_F_MULTI, state); 3092 if (ret < 0) { 3093 /* 3094 * If sending the wiphy data didn't fit (ENOBUFS 3095 * or EMSGSIZE returned), this SKB is still 3096 * empty (so it's not too big because another 3097 * wiphy dataset is already in the skb) and 3098 * we've not tried to adjust the dump allocation 3099 * yet ... then adjust the alloc size to be 3100 * bigger, and return 1 but with the empty skb. 3101 * This results in an empty message being RX'ed 3102 * in userspace, but that is ignored. 3103 * 3104 * We can then retry with the larger buffer. 3105 */ 3106 if ((ret == -ENOBUFS || ret == -EMSGSIZE) && 3107 !skb->len && !state->split && 3108 cb->min_dump_alloc < 4096) { 3109 cb->min_dump_alloc = 4096; 3110 state->split_start = 0; 3111 wiphy_unlock(&rdev->wiphy); 3112 rtnl_unlock(); 3113 return 1; 3114 } 3115 idx--; 3116 break; 3117 } 3118 } while (state->split_start > 0); 3119 wiphy_unlock(&rdev->wiphy); 3120 break; 3121 } 3122 rtnl_unlock(); 3123 3124 state->start = idx; 3125 3126 return skb->len; 3127 } 3128 3129 static int nl80211_dump_wiphy_done(struct netlink_callback *cb) 3130 { 3131 kfree((void *)cb->args[0]); 3132 return 0; 3133 } 3134 3135 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info) 3136 { 3137 struct sk_buff *msg; 3138 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3139 struct nl80211_dump_wiphy_state state = {}; 3140 3141 msg = nlmsg_new(4096, GFP_KERNEL); 3142 if (!msg) 3143 return -ENOMEM; 3144 3145 if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg, 3146 info->snd_portid, info->snd_seq, 0, 3147 &state) < 0) { 3148 nlmsg_free(msg); 3149 return -ENOBUFS; 3150 } 3151 3152 return genlmsg_reply(msg, info); 3153 } 3154 3155 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = { 3156 [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 }, 3157 [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 }, 3158 [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 }, 3159 [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 }, 3160 [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 }, 3161 }; 3162 3163 static int parse_txq_params(struct nlattr *tb[], 3164 struct ieee80211_txq_params *txq_params) 3165 { 3166 u8 ac; 3167 3168 if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] || 3169 !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] || 3170 !tb[NL80211_TXQ_ATTR_AIFS]) 3171 return -EINVAL; 3172 3173 ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]); 3174 txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]); 3175 txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]); 3176 txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]); 3177 txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]); 3178 3179 if (ac >= NL80211_NUM_ACS) 3180 return -EINVAL; 3181 txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS); 3182 return 0; 3183 } 3184 3185 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev) 3186 { 3187 /* 3188 * You can only set the channel explicitly for some interfaces, 3189 * most have their channel managed via their respective 3190 * "establish a connection" command (connect, join, ...) 3191 * 3192 * For AP/GO and mesh mode, the channel can be set with the 3193 * channel userspace API, but is only stored and passed to the 3194 * low-level driver when the AP starts or the mesh is joined. 3195 * This is for backward compatibility, userspace can also give 3196 * the channel in the start-ap or join-mesh commands instead. 3197 * 3198 * Monitors are special as they are normally slaved to 3199 * whatever else is going on, so they have their own special 3200 * operation to set the monitor channel if possible. 3201 */ 3202 return !wdev || 3203 wdev->iftype == NL80211_IFTYPE_AP || 3204 wdev->iftype == NL80211_IFTYPE_MESH_POINT || 3205 wdev->iftype == NL80211_IFTYPE_MONITOR || 3206 wdev->iftype == NL80211_IFTYPE_P2P_GO; 3207 } 3208 3209 static int nl80211_parse_punct_bitmap(struct cfg80211_registered_device *rdev, 3210 struct genl_info *info, 3211 const struct cfg80211_chan_def *chandef, 3212 u16 *punct_bitmap) 3213 { 3214 if (!wiphy_ext_feature_isset(&rdev->wiphy, NL80211_EXT_FEATURE_PUNCT)) 3215 return -EINVAL; 3216 3217 *punct_bitmap = nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]); 3218 if (!cfg80211_valid_disable_subchannel_bitmap(punct_bitmap, chandef)) 3219 return -EINVAL; 3220 3221 return 0; 3222 } 3223 3224 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev, 3225 struct genl_info *info, 3226 struct cfg80211_chan_def *chandef) 3227 { 3228 struct netlink_ext_ack *extack = info->extack; 3229 struct nlattr **attrs = info->attrs; 3230 u32 control_freq; 3231 3232 if (!attrs[NL80211_ATTR_WIPHY_FREQ]) { 3233 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3234 "Frequency is missing"); 3235 return -EINVAL; 3236 } 3237 3238 control_freq = MHZ_TO_KHZ( 3239 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 3240 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 3241 control_freq += 3242 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 3243 3244 memset(chandef, 0, sizeof(*chandef)); 3245 chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq); 3246 chandef->width = NL80211_CHAN_WIDTH_20_NOHT; 3247 chandef->center_freq1 = KHZ_TO_MHZ(control_freq); 3248 chandef->freq1_offset = control_freq % 1000; 3249 chandef->center_freq2 = 0; 3250 3251 /* Primary channel not allowed */ 3252 if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED) { 3253 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ], 3254 "Channel is disabled"); 3255 return -EINVAL; 3256 } 3257 3258 if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) { 3259 enum nl80211_channel_type chantype; 3260 3261 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]); 3262 3263 switch (chantype) { 3264 case NL80211_CHAN_NO_HT: 3265 case NL80211_CHAN_HT20: 3266 case NL80211_CHAN_HT40PLUS: 3267 case NL80211_CHAN_HT40MINUS: 3268 cfg80211_chandef_create(chandef, chandef->chan, 3269 chantype); 3270 /* user input for center_freq is incorrect */ 3271 if (attrs[NL80211_ATTR_CENTER_FREQ1] && 3272 chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) { 3273 NL_SET_ERR_MSG_ATTR(extack, 3274 attrs[NL80211_ATTR_CENTER_FREQ1], 3275 "bad center frequency 1"); 3276 return -EINVAL; 3277 } 3278 /* center_freq2 must be zero */ 3279 if (attrs[NL80211_ATTR_CENTER_FREQ2] && 3280 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) { 3281 NL_SET_ERR_MSG_ATTR(extack, 3282 attrs[NL80211_ATTR_CENTER_FREQ2], 3283 "center frequency 2 can't be used"); 3284 return -EINVAL; 3285 } 3286 break; 3287 default: 3288 NL_SET_ERR_MSG_ATTR(extack, 3289 attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE], 3290 "invalid channel type"); 3291 return -EINVAL; 3292 } 3293 } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) { 3294 chandef->width = 3295 nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]); 3296 if (chandef->chan->band == NL80211_BAND_S1GHZ) { 3297 /* User input error for channel width doesn't match channel */ 3298 if (chandef->width != ieee80211_s1g_channel_width(chandef->chan)) { 3299 NL_SET_ERR_MSG_ATTR(extack, 3300 attrs[NL80211_ATTR_CHANNEL_WIDTH], 3301 "bad channel width"); 3302 return -EINVAL; 3303 } 3304 } 3305 if (attrs[NL80211_ATTR_CENTER_FREQ1]) { 3306 chandef->center_freq1 = 3307 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]); 3308 if (attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET]) 3309 chandef->freq1_offset = nla_get_u32( 3310 attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET]); 3311 else 3312 chandef->freq1_offset = 0; 3313 } 3314 if (attrs[NL80211_ATTR_CENTER_FREQ2]) 3315 chandef->center_freq2 = 3316 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]); 3317 } 3318 3319 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 3320 chandef->edmg.channels = 3321 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 3322 3323 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 3324 chandef->edmg.bw_config = 3325 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 3326 } else { 3327 chandef->edmg.bw_config = 0; 3328 chandef->edmg.channels = 0; 3329 } 3330 3331 if (!cfg80211_chandef_valid(chandef)) { 3332 NL_SET_ERR_MSG(extack, "invalid channel definition"); 3333 return -EINVAL; 3334 } 3335 3336 if (!cfg80211_chandef_usable(&rdev->wiphy, chandef, 3337 IEEE80211_CHAN_DISABLED)) { 3338 NL_SET_ERR_MSG(extack, "(extension) channel is disabled"); 3339 return -EINVAL; 3340 } 3341 3342 if ((chandef->width == NL80211_CHAN_WIDTH_5 || 3343 chandef->width == NL80211_CHAN_WIDTH_10) && 3344 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) { 3345 NL_SET_ERR_MSG(extack, "5/10 MHz not supported"); 3346 return -EINVAL; 3347 } 3348 3349 return 0; 3350 } 3351 3352 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev, 3353 struct net_device *dev, 3354 struct genl_info *info, 3355 int _link_id) 3356 { 3357 struct cfg80211_chan_def chandef; 3358 int result; 3359 enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR; 3360 struct wireless_dev *wdev = NULL; 3361 int link_id = _link_id; 3362 3363 if (dev) 3364 wdev = dev->ieee80211_ptr; 3365 if (!nl80211_can_set_dev_channel(wdev)) 3366 return -EOPNOTSUPP; 3367 if (wdev) 3368 iftype = wdev->iftype; 3369 3370 if (link_id < 0) { 3371 if (wdev && wdev->valid_links) 3372 return -EINVAL; 3373 link_id = 0; 3374 } 3375 3376 result = nl80211_parse_chandef(rdev, info, &chandef); 3377 if (result) 3378 return result; 3379 3380 switch (iftype) { 3381 case NL80211_IFTYPE_AP: 3382 case NL80211_IFTYPE_P2P_GO: 3383 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 3384 iftype)) 3385 return -EINVAL; 3386 if (wdev->links[link_id].ap.beacon_interval) { 3387 struct ieee80211_channel *cur_chan; 3388 3389 if (!dev || !rdev->ops->set_ap_chanwidth || 3390 !(rdev->wiphy.features & 3391 NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) 3392 return -EBUSY; 3393 3394 /* Only allow dynamic channel width changes */ 3395 cur_chan = wdev->links[link_id].ap.chandef.chan; 3396 if (chandef.chan != cur_chan) 3397 return -EBUSY; 3398 3399 result = rdev_set_ap_chanwidth(rdev, dev, link_id, 3400 &chandef); 3401 if (result) 3402 return result; 3403 wdev->links[link_id].ap.chandef = chandef; 3404 } else { 3405 wdev->u.ap.preset_chandef = chandef; 3406 } 3407 return 0; 3408 case NL80211_IFTYPE_MESH_POINT: 3409 return cfg80211_set_mesh_channel(rdev, wdev, &chandef); 3410 case NL80211_IFTYPE_MONITOR: 3411 return cfg80211_set_monitor_channel(rdev, &chandef); 3412 default: 3413 break; 3414 } 3415 3416 return -EINVAL; 3417 } 3418 3419 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info) 3420 { 3421 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 3422 int link_id = nl80211_link_id_or_invalid(info->attrs); 3423 struct net_device *netdev = info->user_ptr[1]; 3424 int ret; 3425 3426 wdev_lock(netdev->ieee80211_ptr); 3427 ret = __nl80211_set_channel(rdev, netdev, info, link_id); 3428 wdev_unlock(netdev->ieee80211_ptr); 3429 3430 return ret; 3431 } 3432 3433 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info) 3434 { 3435 struct cfg80211_registered_device *rdev = NULL; 3436 struct net_device *netdev = NULL; 3437 struct wireless_dev *wdev; 3438 int result = 0, rem_txq_params = 0; 3439 struct nlattr *nl_txq_params; 3440 u32 changed; 3441 u8 retry_short = 0, retry_long = 0; 3442 u32 frag_threshold = 0, rts_threshold = 0; 3443 u8 coverage_class = 0; 3444 u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0; 3445 3446 rtnl_lock(); 3447 /* 3448 * Try to find the wiphy and netdev. Normally this 3449 * function shouldn't need the netdev, but this is 3450 * done for backward compatibility -- previously 3451 * setting the channel was done per wiphy, but now 3452 * it is per netdev. Previous userland like hostapd 3453 * also passed a netdev to set_wiphy, so that it is 3454 * possible to let that go to the right netdev! 3455 */ 3456 3457 if (info->attrs[NL80211_ATTR_IFINDEX]) { 3458 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]); 3459 3460 netdev = __dev_get_by_index(genl_info_net(info), ifindex); 3461 if (netdev && netdev->ieee80211_ptr) 3462 rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy); 3463 else 3464 netdev = NULL; 3465 } 3466 3467 if (!netdev) { 3468 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info), 3469 info->attrs); 3470 if (IS_ERR(rdev)) { 3471 rtnl_unlock(); 3472 return PTR_ERR(rdev); 3473 } 3474 wdev = NULL; 3475 netdev = NULL; 3476 result = 0; 3477 } else 3478 wdev = netdev->ieee80211_ptr; 3479 3480 wiphy_lock(&rdev->wiphy); 3481 3482 /* 3483 * end workaround code, by now the rdev is available 3484 * and locked, and wdev may or may not be NULL. 3485 */ 3486 3487 if (info->attrs[NL80211_ATTR_WIPHY_NAME]) 3488 result = cfg80211_dev_rename( 3489 rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME])); 3490 rtnl_unlock(); 3491 3492 if (result) 3493 goto out; 3494 3495 if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) { 3496 struct ieee80211_txq_params txq_params; 3497 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1]; 3498 3499 if (!rdev->ops->set_txq_params) { 3500 result = -EOPNOTSUPP; 3501 goto out; 3502 } 3503 3504 if (!netdev) { 3505 result = -EINVAL; 3506 goto out; 3507 } 3508 3509 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 3510 netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 3511 result = -EINVAL; 3512 goto out; 3513 } 3514 3515 if (!netif_running(netdev)) { 3516 result = -ENETDOWN; 3517 goto out; 3518 } 3519 3520 nla_for_each_nested(nl_txq_params, 3521 info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS], 3522 rem_txq_params) { 3523 result = nla_parse_nested_deprecated(tb, 3524 NL80211_TXQ_ATTR_MAX, 3525 nl_txq_params, 3526 txq_params_policy, 3527 info->extack); 3528 if (result) 3529 goto out; 3530 result = parse_txq_params(tb, &txq_params); 3531 if (result) 3532 goto out; 3533 3534 txq_params.link_id = 3535 nl80211_link_id_or_invalid(info->attrs); 3536 3537 wdev_lock(netdev->ieee80211_ptr); 3538 if (txq_params.link_id >= 0 && 3539 !(netdev->ieee80211_ptr->valid_links & 3540 BIT(txq_params.link_id))) 3541 result = -ENOLINK; 3542 else if (txq_params.link_id >= 0 && 3543 !netdev->ieee80211_ptr->valid_links) 3544 result = -EINVAL; 3545 else 3546 result = rdev_set_txq_params(rdev, netdev, 3547 &txq_params); 3548 wdev_unlock(netdev->ieee80211_ptr); 3549 if (result) 3550 goto out; 3551 } 3552 } 3553 3554 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 3555 int link_id = nl80211_link_id_or_invalid(info->attrs); 3556 3557 if (wdev) { 3558 wdev_lock(wdev); 3559 result = __nl80211_set_channel( 3560 rdev, 3561 nl80211_can_set_dev_channel(wdev) ? netdev : NULL, 3562 info, link_id); 3563 wdev_unlock(wdev); 3564 } else { 3565 result = __nl80211_set_channel(rdev, netdev, info, link_id); 3566 } 3567 3568 if (result) 3569 goto out; 3570 } 3571 3572 if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) { 3573 struct wireless_dev *txp_wdev = wdev; 3574 enum nl80211_tx_power_setting type; 3575 int idx, mbm = 0; 3576 3577 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER)) 3578 txp_wdev = NULL; 3579 3580 if (!rdev->ops->set_tx_power) { 3581 result = -EOPNOTSUPP; 3582 goto out; 3583 } 3584 3585 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING; 3586 type = nla_get_u32(info->attrs[idx]); 3587 3588 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] && 3589 (type != NL80211_TX_POWER_AUTOMATIC)) { 3590 result = -EINVAL; 3591 goto out; 3592 } 3593 3594 if (type != NL80211_TX_POWER_AUTOMATIC) { 3595 idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL; 3596 mbm = nla_get_u32(info->attrs[idx]); 3597 } 3598 3599 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm); 3600 if (result) 3601 goto out; 3602 } 3603 3604 if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] && 3605 info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) { 3606 u32 tx_ant, rx_ant; 3607 3608 if ((!rdev->wiphy.available_antennas_tx && 3609 !rdev->wiphy.available_antennas_rx) || 3610 !rdev->ops->set_antenna) { 3611 result = -EOPNOTSUPP; 3612 goto out; 3613 } 3614 3615 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]); 3616 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]); 3617 3618 /* reject antenna configurations which don't match the 3619 * available antenna masks, except for the "all" mask */ 3620 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) || 3621 (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) { 3622 result = -EINVAL; 3623 goto out; 3624 } 3625 3626 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx; 3627 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx; 3628 3629 result = rdev_set_antenna(rdev, tx_ant, rx_ant); 3630 if (result) 3631 goto out; 3632 } 3633 3634 changed = 0; 3635 3636 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) { 3637 retry_short = nla_get_u8( 3638 info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]); 3639 3640 changed |= WIPHY_PARAM_RETRY_SHORT; 3641 } 3642 3643 if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) { 3644 retry_long = nla_get_u8( 3645 info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]); 3646 3647 changed |= WIPHY_PARAM_RETRY_LONG; 3648 } 3649 3650 if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) { 3651 frag_threshold = nla_get_u32( 3652 info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]); 3653 if (frag_threshold < 256) { 3654 result = -EINVAL; 3655 goto out; 3656 } 3657 3658 if (frag_threshold != (u32) -1) { 3659 /* 3660 * Fragments (apart from the last one) are required to 3661 * have even length. Make the fragmentation code 3662 * simpler by stripping LSB should someone try to use 3663 * odd threshold value. 3664 */ 3665 frag_threshold &= ~0x1; 3666 } 3667 changed |= WIPHY_PARAM_FRAG_THRESHOLD; 3668 } 3669 3670 if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) { 3671 rts_threshold = nla_get_u32( 3672 info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]); 3673 changed |= WIPHY_PARAM_RTS_THRESHOLD; 3674 } 3675 3676 if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) { 3677 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3678 result = -EINVAL; 3679 goto out; 3680 } 3681 3682 coverage_class = nla_get_u8( 3683 info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]); 3684 changed |= WIPHY_PARAM_COVERAGE_CLASS; 3685 } 3686 3687 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) { 3688 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) { 3689 result = -EOPNOTSUPP; 3690 goto out; 3691 } 3692 3693 changed |= WIPHY_PARAM_DYN_ACK; 3694 } 3695 3696 if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) { 3697 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3698 NL80211_EXT_FEATURE_TXQS)) { 3699 result = -EOPNOTSUPP; 3700 goto out; 3701 } 3702 txq_limit = nla_get_u32( 3703 info->attrs[NL80211_ATTR_TXQ_LIMIT]); 3704 changed |= WIPHY_PARAM_TXQ_LIMIT; 3705 } 3706 3707 if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) { 3708 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3709 NL80211_EXT_FEATURE_TXQS)) { 3710 result = -EOPNOTSUPP; 3711 goto out; 3712 } 3713 txq_memory_limit = nla_get_u32( 3714 info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]); 3715 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT; 3716 } 3717 3718 if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) { 3719 if (!wiphy_ext_feature_isset(&rdev->wiphy, 3720 NL80211_EXT_FEATURE_TXQS)) { 3721 result = -EOPNOTSUPP; 3722 goto out; 3723 } 3724 txq_quantum = nla_get_u32( 3725 info->attrs[NL80211_ATTR_TXQ_QUANTUM]); 3726 changed |= WIPHY_PARAM_TXQ_QUANTUM; 3727 } 3728 3729 if (changed) { 3730 u8 old_retry_short, old_retry_long; 3731 u32 old_frag_threshold, old_rts_threshold; 3732 u8 old_coverage_class; 3733 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum; 3734 3735 if (!rdev->ops->set_wiphy_params) { 3736 result = -EOPNOTSUPP; 3737 goto out; 3738 } 3739 3740 old_retry_short = rdev->wiphy.retry_short; 3741 old_retry_long = rdev->wiphy.retry_long; 3742 old_frag_threshold = rdev->wiphy.frag_threshold; 3743 old_rts_threshold = rdev->wiphy.rts_threshold; 3744 old_coverage_class = rdev->wiphy.coverage_class; 3745 old_txq_limit = rdev->wiphy.txq_limit; 3746 old_txq_memory_limit = rdev->wiphy.txq_memory_limit; 3747 old_txq_quantum = rdev->wiphy.txq_quantum; 3748 3749 if (changed & WIPHY_PARAM_RETRY_SHORT) 3750 rdev->wiphy.retry_short = retry_short; 3751 if (changed & WIPHY_PARAM_RETRY_LONG) 3752 rdev->wiphy.retry_long = retry_long; 3753 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) 3754 rdev->wiphy.frag_threshold = frag_threshold; 3755 if (changed & WIPHY_PARAM_RTS_THRESHOLD) 3756 rdev->wiphy.rts_threshold = rts_threshold; 3757 if (changed & WIPHY_PARAM_COVERAGE_CLASS) 3758 rdev->wiphy.coverage_class = coverage_class; 3759 if (changed & WIPHY_PARAM_TXQ_LIMIT) 3760 rdev->wiphy.txq_limit = txq_limit; 3761 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT) 3762 rdev->wiphy.txq_memory_limit = txq_memory_limit; 3763 if (changed & WIPHY_PARAM_TXQ_QUANTUM) 3764 rdev->wiphy.txq_quantum = txq_quantum; 3765 3766 result = rdev_set_wiphy_params(rdev, changed); 3767 if (result) { 3768 rdev->wiphy.retry_short = old_retry_short; 3769 rdev->wiphy.retry_long = old_retry_long; 3770 rdev->wiphy.frag_threshold = old_frag_threshold; 3771 rdev->wiphy.rts_threshold = old_rts_threshold; 3772 rdev->wiphy.coverage_class = old_coverage_class; 3773 rdev->wiphy.txq_limit = old_txq_limit; 3774 rdev->wiphy.txq_memory_limit = old_txq_memory_limit; 3775 rdev->wiphy.txq_quantum = old_txq_quantum; 3776 goto out; 3777 } 3778 } 3779 3780 result = 0; 3781 3782 out: 3783 wiphy_unlock(&rdev->wiphy); 3784 return result; 3785 } 3786 3787 int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef) 3788 { 3789 if (WARN_ON(!cfg80211_chandef_valid(chandef))) 3790 return -EINVAL; 3791 3792 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 3793 chandef->chan->center_freq)) 3794 return -ENOBUFS; 3795 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 3796 chandef->chan->freq_offset)) 3797 return -ENOBUFS; 3798 switch (chandef->width) { 3799 case NL80211_CHAN_WIDTH_20_NOHT: 3800 case NL80211_CHAN_WIDTH_20: 3801 case NL80211_CHAN_WIDTH_40: 3802 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 3803 cfg80211_get_chandef_type(chandef))) 3804 return -ENOBUFS; 3805 break; 3806 default: 3807 break; 3808 } 3809 if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width)) 3810 return -ENOBUFS; 3811 if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1)) 3812 return -ENOBUFS; 3813 if (chandef->center_freq2 && 3814 nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2)) 3815 return -ENOBUFS; 3816 return 0; 3817 } 3818 EXPORT_SYMBOL(nl80211_send_chandef); 3819 3820 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags, 3821 struct cfg80211_registered_device *rdev, 3822 struct wireless_dev *wdev, 3823 enum nl80211_commands cmd) 3824 { 3825 struct net_device *dev = wdev->netdev; 3826 void *hdr; 3827 3828 WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE && 3829 cmd != NL80211_CMD_DEL_INTERFACE && 3830 cmd != NL80211_CMD_SET_INTERFACE); 3831 3832 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 3833 if (!hdr) 3834 return -1; 3835 3836 if (dev && 3837 (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 3838 nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name))) 3839 goto nla_put_failure; 3840 3841 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 3842 nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) || 3843 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 3844 NL80211_ATTR_PAD) || 3845 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) || 3846 nla_put_u32(msg, NL80211_ATTR_GENERATION, 3847 rdev->devlist_generation ^ 3848 (cfg80211_rdev_list_generation << 2)) || 3849 nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr)) 3850 goto nla_put_failure; 3851 3852 if (rdev->ops->get_channel && !wdev->valid_links) { 3853 struct cfg80211_chan_def chandef = {}; 3854 int ret; 3855 3856 ret = rdev_get_channel(rdev, wdev, 0, &chandef); 3857 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 3858 goto nla_put_failure; 3859 } 3860 3861 if (rdev->ops->get_tx_power) { 3862 int dbm, ret; 3863 3864 ret = rdev_get_tx_power(rdev, wdev, &dbm); 3865 if (ret == 0 && 3866 nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL, 3867 DBM_TO_MBM(dbm))) 3868 goto nla_put_failure; 3869 } 3870 3871 wdev_lock(wdev); 3872 switch (wdev->iftype) { 3873 case NL80211_IFTYPE_AP: 3874 case NL80211_IFTYPE_P2P_GO: 3875 if (wdev->u.ap.ssid_len && 3876 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 3877 wdev->u.ap.ssid)) 3878 goto nla_put_failure_locked; 3879 break; 3880 case NL80211_IFTYPE_STATION: 3881 case NL80211_IFTYPE_P2P_CLIENT: 3882 if (wdev->u.client.ssid_len && 3883 nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len, 3884 wdev->u.client.ssid)) 3885 goto nla_put_failure_locked; 3886 break; 3887 case NL80211_IFTYPE_ADHOC: 3888 if (wdev->u.ibss.ssid_len && 3889 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len, 3890 wdev->u.ibss.ssid)) 3891 goto nla_put_failure_locked; 3892 break; 3893 default: 3894 /* nothing */ 3895 break; 3896 } 3897 wdev_unlock(wdev); 3898 3899 if (rdev->ops->get_txq_stats) { 3900 struct cfg80211_txq_stats txqstats = {}; 3901 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats); 3902 3903 if (ret == 0 && 3904 !nl80211_put_txq_stats(msg, &txqstats, 3905 NL80211_ATTR_TXQ_STATS)) 3906 goto nla_put_failure; 3907 } 3908 3909 if (wdev->valid_links) { 3910 unsigned int link_id; 3911 struct nlattr *links = nla_nest_start(msg, 3912 NL80211_ATTR_MLO_LINKS); 3913 3914 if (!links) 3915 goto nla_put_failure; 3916 3917 for_each_valid_link(wdev, link_id) { 3918 struct nlattr *link = nla_nest_start(msg, link_id + 1); 3919 struct cfg80211_chan_def chandef = {}; 3920 int ret; 3921 3922 if (!link) 3923 goto nla_put_failure; 3924 3925 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 3926 goto nla_put_failure; 3927 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 3928 wdev->links[link_id].addr)) 3929 goto nla_put_failure; 3930 3931 ret = rdev_get_channel(rdev, wdev, link_id, &chandef); 3932 if (ret == 0 && nl80211_send_chandef(msg, &chandef)) 3933 goto nla_put_failure; 3934 3935 nla_nest_end(msg, link); 3936 } 3937 3938 nla_nest_end(msg, links); 3939 } 3940 3941 genlmsg_end(msg, hdr); 3942 return 0; 3943 3944 nla_put_failure_locked: 3945 wdev_unlock(wdev); 3946 nla_put_failure: 3947 genlmsg_cancel(msg, hdr); 3948 return -EMSGSIZE; 3949 } 3950 3951 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb) 3952 { 3953 int wp_idx = 0; 3954 int if_idx = 0; 3955 int wp_start = cb->args[0]; 3956 int if_start = cb->args[1]; 3957 int filter_wiphy = -1; 3958 struct cfg80211_registered_device *rdev; 3959 struct wireless_dev *wdev; 3960 int ret; 3961 3962 rtnl_lock(); 3963 if (!cb->args[2]) { 3964 struct nl80211_dump_wiphy_state state = { 3965 .filter_wiphy = -1, 3966 }; 3967 3968 ret = nl80211_dump_wiphy_parse(skb, cb, &state); 3969 if (ret) 3970 goto out_unlock; 3971 3972 filter_wiphy = state.filter_wiphy; 3973 3974 /* 3975 * if filtering, set cb->args[2] to +1 since 0 is the default 3976 * value needed to determine that parsing is necessary. 3977 */ 3978 if (filter_wiphy >= 0) 3979 cb->args[2] = filter_wiphy + 1; 3980 else 3981 cb->args[2] = -1; 3982 } else if (cb->args[2] > 0) { 3983 filter_wiphy = cb->args[2] - 1; 3984 } 3985 3986 list_for_each_entry(rdev, &cfg80211_rdev_list, list) { 3987 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk))) 3988 continue; 3989 if (wp_idx < wp_start) { 3990 wp_idx++; 3991 continue; 3992 } 3993 3994 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx) 3995 continue; 3996 3997 if_idx = 0; 3998 3999 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 4000 if (if_idx < if_start) { 4001 if_idx++; 4002 continue; 4003 } 4004 if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid, 4005 cb->nlh->nlmsg_seq, NLM_F_MULTI, 4006 rdev, wdev, 4007 NL80211_CMD_NEW_INTERFACE) < 0) { 4008 goto out; 4009 } 4010 if_idx++; 4011 } 4012 4013 wp_idx++; 4014 } 4015 out: 4016 cb->args[0] = wp_idx; 4017 cb->args[1] = if_idx; 4018 4019 ret = skb->len; 4020 out_unlock: 4021 rtnl_unlock(); 4022 4023 return ret; 4024 } 4025 4026 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info) 4027 { 4028 struct sk_buff *msg; 4029 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4030 struct wireless_dev *wdev = info->user_ptr[1]; 4031 4032 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4033 if (!msg) 4034 return -ENOMEM; 4035 4036 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4037 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4038 nlmsg_free(msg); 4039 return -ENOBUFS; 4040 } 4041 4042 return genlmsg_reply(msg, info); 4043 } 4044 4045 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = { 4046 [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG }, 4047 [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG }, 4048 [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG }, 4049 [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG }, 4050 [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG }, 4051 [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG }, 4052 }; 4053 4054 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags) 4055 { 4056 struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1]; 4057 int flag; 4058 4059 *mntrflags = 0; 4060 4061 if (!nla) 4062 return -EINVAL; 4063 4064 if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL)) 4065 return -EINVAL; 4066 4067 for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++) 4068 if (flags[flag]) 4069 *mntrflags |= (1<<flag); 4070 4071 *mntrflags |= MONITOR_FLAG_CHANGED; 4072 4073 return 0; 4074 } 4075 4076 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev, 4077 enum nl80211_iftype type, 4078 struct genl_info *info, 4079 struct vif_params *params) 4080 { 4081 bool change = false; 4082 int err; 4083 4084 if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) { 4085 if (type != NL80211_IFTYPE_MONITOR) 4086 return -EINVAL; 4087 4088 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS], 4089 ¶ms->flags); 4090 if (err) 4091 return err; 4092 4093 change = true; 4094 } 4095 4096 if (params->flags & MONITOR_FLAG_ACTIVE && 4097 !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR)) 4098 return -EOPNOTSUPP; 4099 4100 if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) { 4101 const u8 *mumimo_groups; 4102 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4103 4104 if (type != NL80211_IFTYPE_MONITOR) 4105 return -EINVAL; 4106 4107 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4108 return -EOPNOTSUPP; 4109 4110 mumimo_groups = 4111 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]); 4112 4113 /* bits 0 and 63 are reserved and must be zero */ 4114 if ((mumimo_groups[0] & BIT(0)) || 4115 (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7))) 4116 return -EINVAL; 4117 4118 params->vht_mumimo_groups = mumimo_groups; 4119 change = true; 4120 } 4121 4122 if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) { 4123 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER; 4124 4125 if (type != NL80211_IFTYPE_MONITOR) 4126 return -EINVAL; 4127 4128 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag)) 4129 return -EOPNOTSUPP; 4130 4131 params->vht_mumimo_follow_addr = 4132 nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]); 4133 change = true; 4134 } 4135 4136 return change ? 1 : 0; 4137 } 4138 4139 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev, 4140 struct net_device *netdev, u8 use_4addr, 4141 enum nl80211_iftype iftype) 4142 { 4143 if (!use_4addr) { 4144 if (netdev && netif_is_bridge_port(netdev)) 4145 return -EBUSY; 4146 return 0; 4147 } 4148 4149 switch (iftype) { 4150 case NL80211_IFTYPE_AP_VLAN: 4151 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP) 4152 return 0; 4153 break; 4154 case NL80211_IFTYPE_STATION: 4155 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION) 4156 return 0; 4157 break; 4158 default: 4159 break; 4160 } 4161 4162 return -EOPNOTSUPP; 4163 } 4164 4165 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info) 4166 { 4167 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4168 struct vif_params params; 4169 int err; 4170 enum nl80211_iftype otype, ntype; 4171 struct net_device *dev = info->user_ptr[1]; 4172 bool change = false; 4173 4174 memset(¶ms, 0, sizeof(params)); 4175 4176 otype = ntype = dev->ieee80211_ptr->iftype; 4177 4178 if (info->attrs[NL80211_ATTR_IFTYPE]) { 4179 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4180 if (otype != ntype) 4181 change = true; 4182 } 4183 4184 if (info->attrs[NL80211_ATTR_MESH_ID]) { 4185 struct wireless_dev *wdev = dev->ieee80211_ptr; 4186 4187 if (ntype != NL80211_IFTYPE_MESH_POINT) 4188 return -EINVAL; 4189 if (netif_running(dev)) 4190 return -EBUSY; 4191 4192 wdev_lock(wdev); 4193 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN != 4194 IEEE80211_MAX_MESH_ID_LEN); 4195 wdev->u.mesh.id_up_len = 4196 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4197 memcpy(wdev->u.mesh.id, 4198 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4199 wdev->u.mesh.id_up_len); 4200 wdev_unlock(wdev); 4201 } 4202 4203 if (info->attrs[NL80211_ATTR_4ADDR]) { 4204 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4205 change = true; 4206 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype); 4207 if (err) 4208 return err; 4209 } else { 4210 params.use_4addr = -1; 4211 } 4212 4213 err = nl80211_parse_mon_options(rdev, ntype, info, ¶ms); 4214 if (err < 0) 4215 return err; 4216 if (err > 0) 4217 change = true; 4218 4219 if (change) 4220 err = cfg80211_change_iface(rdev, dev, ntype, ¶ms); 4221 else 4222 err = 0; 4223 4224 if (!err && params.use_4addr != -1) 4225 dev->ieee80211_ptr->use_4addr = params.use_4addr; 4226 4227 if (change && !err) { 4228 struct wireless_dev *wdev = dev->ieee80211_ptr; 4229 4230 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE); 4231 } 4232 4233 return err; 4234 } 4235 4236 static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4237 { 4238 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4239 struct vif_params params; 4240 struct wireless_dev *wdev; 4241 struct sk_buff *msg; 4242 int err; 4243 enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED; 4244 4245 memset(¶ms, 0, sizeof(params)); 4246 4247 if (!info->attrs[NL80211_ATTR_IFNAME]) 4248 return -EINVAL; 4249 4250 if (info->attrs[NL80211_ATTR_IFTYPE]) 4251 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]); 4252 4253 if (!rdev->ops->add_virtual_intf) 4254 return -EOPNOTSUPP; 4255 4256 if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN || 4257 rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) && 4258 info->attrs[NL80211_ATTR_MAC]) { 4259 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC], 4260 ETH_ALEN); 4261 if (!is_valid_ether_addr(params.macaddr)) 4262 return -EADDRNOTAVAIL; 4263 } 4264 4265 if (info->attrs[NL80211_ATTR_4ADDR]) { 4266 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]); 4267 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type); 4268 if (err) 4269 return err; 4270 } 4271 4272 if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0)) 4273 return -EOPNOTSUPP; 4274 4275 err = nl80211_parse_mon_options(rdev, type, info, ¶ms); 4276 if (err < 0) 4277 return err; 4278 4279 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4280 if (!msg) 4281 return -ENOMEM; 4282 4283 wdev = rdev_add_virtual_intf(rdev, 4284 nla_data(info->attrs[NL80211_ATTR_IFNAME]), 4285 NET_NAME_USER, type, ¶ms); 4286 if (WARN_ON(!wdev)) { 4287 nlmsg_free(msg); 4288 return -EPROTO; 4289 } else if (IS_ERR(wdev)) { 4290 nlmsg_free(msg); 4291 return PTR_ERR(wdev); 4292 } 4293 4294 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 4295 wdev->owner_nlportid = info->snd_portid; 4296 4297 switch (type) { 4298 case NL80211_IFTYPE_MESH_POINT: 4299 if (!info->attrs[NL80211_ATTR_MESH_ID]) 4300 break; 4301 wdev_lock(wdev); 4302 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN != 4303 IEEE80211_MAX_MESH_ID_LEN); 4304 wdev->u.mesh.id_up_len = 4305 nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 4306 memcpy(wdev->u.mesh.id, 4307 nla_data(info->attrs[NL80211_ATTR_MESH_ID]), 4308 wdev->u.mesh.id_up_len); 4309 wdev_unlock(wdev); 4310 break; 4311 case NL80211_IFTYPE_NAN: 4312 case NL80211_IFTYPE_P2P_DEVICE: 4313 /* 4314 * P2P Device and NAN do not have a netdev, so don't go 4315 * through the netdev notifier and must be added here 4316 */ 4317 cfg80211_init_wdev(wdev); 4318 cfg80211_register_wdev(rdev, wdev); 4319 break; 4320 default: 4321 break; 4322 } 4323 4324 if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0, 4325 rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) { 4326 nlmsg_free(msg); 4327 return -ENOBUFS; 4328 } 4329 4330 return genlmsg_reply(msg, info); 4331 } 4332 4333 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info) 4334 { 4335 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4336 int ret; 4337 4338 /* to avoid failing a new interface creation due to pending removal */ 4339 cfg80211_destroy_ifaces(rdev); 4340 4341 wiphy_lock(&rdev->wiphy); 4342 ret = _nl80211_new_interface(skb, info); 4343 wiphy_unlock(&rdev->wiphy); 4344 4345 return ret; 4346 } 4347 4348 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info) 4349 { 4350 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4351 struct wireless_dev *wdev = info->user_ptr[1]; 4352 4353 if (!rdev->ops->del_virtual_intf) 4354 return -EOPNOTSUPP; 4355 4356 /* 4357 * We hold RTNL, so this is safe, without RTNL opencount cannot 4358 * reach 0, and thus the rdev cannot be deleted. 4359 * 4360 * We need to do it for the dev_close(), since that will call 4361 * the netdev notifiers, and we need to acquire the mutex there 4362 * but don't know if we get there from here or from some other 4363 * place (e.g. "ip link set ... down"). 4364 */ 4365 mutex_unlock(&rdev->wiphy.mtx); 4366 4367 /* 4368 * If we remove a wireless device without a netdev then clear 4369 * user_ptr[1] so that nl80211_post_doit won't dereference it 4370 * to check if it needs to do dev_put(). Otherwise it crashes 4371 * since the wdev has been freed, unlike with a netdev where 4372 * we need the dev_put() for the netdev to really be freed. 4373 */ 4374 if (!wdev->netdev) 4375 info->user_ptr[1] = NULL; 4376 else 4377 dev_close(wdev->netdev); 4378 4379 mutex_lock(&rdev->wiphy.mtx); 4380 4381 return cfg80211_remove_virtual_intf(rdev, wdev); 4382 } 4383 4384 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info) 4385 { 4386 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4387 struct net_device *dev = info->user_ptr[1]; 4388 u16 noack_map; 4389 4390 if (!info->attrs[NL80211_ATTR_NOACK_MAP]) 4391 return -EINVAL; 4392 4393 if (!rdev->ops->set_noack_map) 4394 return -EOPNOTSUPP; 4395 4396 noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]); 4397 4398 return rdev_set_noack_map(rdev, dev, noack_map); 4399 } 4400 4401 static int nl80211_validate_key_link_id(struct genl_info *info, 4402 struct wireless_dev *wdev, 4403 int link_id, bool pairwise) 4404 { 4405 if (pairwise) { 4406 if (link_id != -1) { 4407 GENL_SET_ERR_MSG(info, 4408 "link ID not allowed for pairwise key"); 4409 return -EINVAL; 4410 } 4411 4412 return 0; 4413 } 4414 4415 if (wdev->valid_links) { 4416 if (link_id == -1) { 4417 GENL_SET_ERR_MSG(info, 4418 "link ID must for MLO group key"); 4419 return -EINVAL; 4420 } 4421 if (!(wdev->valid_links & BIT(link_id))) { 4422 GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key"); 4423 return -EINVAL; 4424 } 4425 } else if (link_id != -1) { 4426 GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key"); 4427 return -EINVAL; 4428 } 4429 4430 return 0; 4431 } 4432 4433 struct get_key_cookie { 4434 struct sk_buff *msg; 4435 int error; 4436 int idx; 4437 }; 4438 4439 static void get_key_callback(void *c, struct key_params *params) 4440 { 4441 struct nlattr *key; 4442 struct get_key_cookie *cookie = c; 4443 4444 if ((params->key && 4445 nla_put(cookie->msg, NL80211_ATTR_KEY_DATA, 4446 params->key_len, params->key)) || 4447 (params->seq && 4448 nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ, 4449 params->seq_len, params->seq)) || 4450 (params->cipher && 4451 nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER, 4452 params->cipher))) 4453 goto nla_put_failure; 4454 4455 key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY); 4456 if (!key) 4457 goto nla_put_failure; 4458 4459 if ((params->key && 4460 nla_put(cookie->msg, NL80211_KEY_DATA, 4461 params->key_len, params->key)) || 4462 (params->seq && 4463 nla_put(cookie->msg, NL80211_KEY_SEQ, 4464 params->seq_len, params->seq)) || 4465 (params->cipher && 4466 nla_put_u32(cookie->msg, NL80211_KEY_CIPHER, 4467 params->cipher))) 4468 goto nla_put_failure; 4469 4470 if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx)) 4471 goto nla_put_failure; 4472 4473 nla_nest_end(cookie->msg, key); 4474 4475 return; 4476 nla_put_failure: 4477 cookie->error = 1; 4478 } 4479 4480 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info) 4481 { 4482 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4483 int err; 4484 struct net_device *dev = info->user_ptr[1]; 4485 u8 key_idx = 0; 4486 const u8 *mac_addr = NULL; 4487 bool pairwise; 4488 struct get_key_cookie cookie = { 4489 .error = 0, 4490 }; 4491 void *hdr; 4492 struct sk_buff *msg; 4493 bool bigtk_support = false; 4494 int link_id = nl80211_link_id_or_invalid(info->attrs); 4495 struct wireless_dev *wdev = dev->ieee80211_ptr; 4496 4497 if (wiphy_ext_feature_isset(&rdev->wiphy, 4498 NL80211_EXT_FEATURE_BEACON_PROTECTION)) 4499 bigtk_support = true; 4500 4501 if ((wdev->iftype == NL80211_IFTYPE_STATION || 4502 wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) && 4503 wiphy_ext_feature_isset(&rdev->wiphy, 4504 NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT)) 4505 bigtk_support = true; 4506 4507 if (info->attrs[NL80211_ATTR_KEY_IDX]) { 4508 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]); 4509 4510 if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) { 4511 GENL_SET_ERR_MSG(info, "BIGTK not supported"); 4512 return -EINVAL; 4513 } 4514 } 4515 4516 if (info->attrs[NL80211_ATTR_MAC]) 4517 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4518 4519 pairwise = !!mac_addr; 4520 if (info->attrs[NL80211_ATTR_KEY_TYPE]) { 4521 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]); 4522 4523 if (kt != NL80211_KEYTYPE_GROUP && 4524 kt != NL80211_KEYTYPE_PAIRWISE) 4525 return -EINVAL; 4526 pairwise = kt == NL80211_KEYTYPE_PAIRWISE; 4527 } 4528 4529 if (!rdev->ops->get_key) 4530 return -EOPNOTSUPP; 4531 4532 if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4533 return -ENOENT; 4534 4535 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 4536 if (!msg) 4537 return -ENOMEM; 4538 4539 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 4540 NL80211_CMD_NEW_KEY); 4541 if (!hdr) 4542 goto nla_put_failure; 4543 4544 cookie.msg = msg; 4545 cookie.idx = key_idx; 4546 4547 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 4548 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx)) 4549 goto nla_put_failure; 4550 if (mac_addr && 4551 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr)) 4552 goto nla_put_failure; 4553 4554 err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise); 4555 if (err) 4556 goto free_msg; 4557 4558 err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr, 4559 &cookie, get_key_callback); 4560 4561 if (err) 4562 goto free_msg; 4563 4564 if (cookie.error) 4565 goto nla_put_failure; 4566 4567 genlmsg_end(msg, hdr); 4568 return genlmsg_reply(msg, info); 4569 4570 nla_put_failure: 4571 err = -ENOBUFS; 4572 free_msg: 4573 nlmsg_free(msg); 4574 return err; 4575 } 4576 4577 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info) 4578 { 4579 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4580 struct key_parse key; 4581 int err; 4582 struct net_device *dev = info->user_ptr[1]; 4583 int link_id = nl80211_link_id_or_invalid(info->attrs); 4584 struct wireless_dev *wdev = dev->ieee80211_ptr; 4585 4586 err = nl80211_parse_key(info, &key); 4587 if (err) 4588 return err; 4589 4590 if (key.idx < 0) 4591 return -EINVAL; 4592 4593 /* Only support setting default key and 4594 * Extended Key ID action NL80211_KEY_SET_TX. 4595 */ 4596 if (!key.def && !key.defmgmt && !key.defbeacon && 4597 !(key.p.mode == NL80211_KEY_SET_TX)) 4598 return -EINVAL; 4599 4600 wdev_lock(wdev); 4601 4602 if (key.def) { 4603 if (!rdev->ops->set_default_key) { 4604 err = -EOPNOTSUPP; 4605 goto out; 4606 } 4607 4608 err = nl80211_key_allowed(wdev); 4609 if (err) 4610 goto out; 4611 4612 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4613 if (err) 4614 goto out; 4615 4616 err = rdev_set_default_key(rdev, dev, link_id, key.idx, 4617 key.def_uni, key.def_multi); 4618 4619 if (err) 4620 goto out; 4621 4622 #ifdef CONFIG_CFG80211_WEXT 4623 wdev->wext.default_key = key.idx; 4624 #endif 4625 } else if (key.defmgmt) { 4626 if (key.def_uni || !key.def_multi) { 4627 err = -EINVAL; 4628 goto out; 4629 } 4630 4631 if (!rdev->ops->set_default_mgmt_key) { 4632 err = -EOPNOTSUPP; 4633 goto out; 4634 } 4635 4636 err = nl80211_key_allowed(wdev); 4637 if (err) 4638 goto out; 4639 4640 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4641 if (err) 4642 goto out; 4643 4644 err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx); 4645 if (err) 4646 goto out; 4647 4648 #ifdef CONFIG_CFG80211_WEXT 4649 wdev->wext.default_mgmt_key = key.idx; 4650 #endif 4651 } else if (key.defbeacon) { 4652 if (key.def_uni || !key.def_multi) { 4653 err = -EINVAL; 4654 goto out; 4655 } 4656 4657 if (!rdev->ops->set_default_beacon_key) { 4658 err = -EOPNOTSUPP; 4659 goto out; 4660 } 4661 4662 err = nl80211_key_allowed(wdev); 4663 if (err) 4664 goto out; 4665 4666 err = nl80211_validate_key_link_id(info, wdev, link_id, false); 4667 if (err) 4668 goto out; 4669 4670 err = rdev_set_default_beacon_key(rdev, dev, link_id, key.idx); 4671 if (err) 4672 goto out; 4673 } else if (key.p.mode == NL80211_KEY_SET_TX && 4674 wiphy_ext_feature_isset(&rdev->wiphy, 4675 NL80211_EXT_FEATURE_EXT_KEY_ID)) { 4676 u8 *mac_addr = NULL; 4677 4678 if (info->attrs[NL80211_ATTR_MAC]) 4679 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4680 4681 if (!mac_addr || key.idx < 0 || key.idx > 1) { 4682 err = -EINVAL; 4683 goto out; 4684 } 4685 4686 err = nl80211_validate_key_link_id(info, wdev, link_id, true); 4687 if (err) 4688 goto out; 4689 4690 err = rdev_add_key(rdev, dev, link_id, key.idx, 4691 NL80211_KEYTYPE_PAIRWISE, 4692 mac_addr, &key.p); 4693 } else { 4694 err = -EINVAL; 4695 } 4696 out: 4697 wdev_unlock(wdev); 4698 4699 return err; 4700 } 4701 4702 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info) 4703 { 4704 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4705 int err; 4706 struct net_device *dev = info->user_ptr[1]; 4707 struct key_parse key; 4708 const u8 *mac_addr = NULL; 4709 int link_id = nl80211_link_id_or_invalid(info->attrs); 4710 struct wireless_dev *wdev = dev->ieee80211_ptr; 4711 4712 err = nl80211_parse_key(info, &key); 4713 if (err) 4714 return err; 4715 4716 if (!key.p.key) { 4717 GENL_SET_ERR_MSG(info, "no key"); 4718 return -EINVAL; 4719 } 4720 4721 if (info->attrs[NL80211_ATTR_MAC]) 4722 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4723 4724 if (key.type == -1) { 4725 if (mac_addr) 4726 key.type = NL80211_KEYTYPE_PAIRWISE; 4727 else 4728 key.type = NL80211_KEYTYPE_GROUP; 4729 } 4730 4731 /* for now */ 4732 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4733 key.type != NL80211_KEYTYPE_GROUP) { 4734 GENL_SET_ERR_MSG(info, "key type not pairwise or group"); 4735 return -EINVAL; 4736 } 4737 4738 if (key.type == NL80211_KEYTYPE_GROUP && 4739 info->attrs[NL80211_ATTR_VLAN_ID]) 4740 key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 4741 4742 if (!rdev->ops->add_key) 4743 return -EOPNOTSUPP; 4744 4745 if (cfg80211_validate_key_settings(rdev, &key.p, key.idx, 4746 key.type == NL80211_KEYTYPE_PAIRWISE, 4747 mac_addr)) { 4748 GENL_SET_ERR_MSG(info, "key setting validation failed"); 4749 return -EINVAL; 4750 } 4751 4752 wdev_lock(wdev); 4753 err = nl80211_key_allowed(wdev); 4754 if (err) 4755 GENL_SET_ERR_MSG(info, "key not allowed"); 4756 4757 if (!err) 4758 err = nl80211_validate_key_link_id(info, wdev, link_id, 4759 key.type == NL80211_KEYTYPE_PAIRWISE); 4760 4761 if (!err) { 4762 err = rdev_add_key(rdev, dev, link_id, key.idx, 4763 key.type == NL80211_KEYTYPE_PAIRWISE, 4764 mac_addr, &key.p); 4765 if (err) 4766 GENL_SET_ERR_MSG(info, "key addition failed"); 4767 } 4768 wdev_unlock(wdev); 4769 4770 return err; 4771 } 4772 4773 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info) 4774 { 4775 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4776 int err; 4777 struct net_device *dev = info->user_ptr[1]; 4778 u8 *mac_addr = NULL; 4779 struct key_parse key; 4780 int link_id = nl80211_link_id_or_invalid(info->attrs); 4781 struct wireless_dev *wdev = dev->ieee80211_ptr; 4782 4783 err = nl80211_parse_key(info, &key); 4784 if (err) 4785 return err; 4786 4787 if (info->attrs[NL80211_ATTR_MAC]) 4788 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 4789 4790 if (key.type == -1) { 4791 if (mac_addr) 4792 key.type = NL80211_KEYTYPE_PAIRWISE; 4793 else 4794 key.type = NL80211_KEYTYPE_GROUP; 4795 } 4796 4797 /* for now */ 4798 if (key.type != NL80211_KEYTYPE_PAIRWISE && 4799 key.type != NL80211_KEYTYPE_GROUP) 4800 return -EINVAL; 4801 4802 if (!cfg80211_valid_key_idx(rdev, key.idx, 4803 key.type == NL80211_KEYTYPE_PAIRWISE)) 4804 return -EINVAL; 4805 4806 if (!rdev->ops->del_key) 4807 return -EOPNOTSUPP; 4808 4809 wdev_lock(wdev); 4810 err = nl80211_key_allowed(wdev); 4811 4812 if (key.type == NL80211_KEYTYPE_GROUP && mac_addr && 4813 !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)) 4814 err = -ENOENT; 4815 4816 if (!err) 4817 err = nl80211_validate_key_link_id(info, wdev, link_id, 4818 key.type == NL80211_KEYTYPE_PAIRWISE); 4819 4820 if (!err) 4821 err = rdev_del_key(rdev, dev, link_id, key.idx, 4822 key.type == NL80211_KEYTYPE_PAIRWISE, 4823 mac_addr); 4824 4825 #ifdef CONFIG_CFG80211_WEXT 4826 if (!err) { 4827 if (key.idx == wdev->wext.default_key) 4828 wdev->wext.default_key = -1; 4829 else if (key.idx == wdev->wext.default_mgmt_key) 4830 wdev->wext.default_mgmt_key = -1; 4831 } 4832 #endif 4833 wdev_unlock(wdev); 4834 4835 return err; 4836 } 4837 4838 /* This function returns an error or the number of nested attributes */ 4839 static int validate_acl_mac_addrs(struct nlattr *nl_attr) 4840 { 4841 struct nlattr *attr; 4842 int n_entries = 0, tmp; 4843 4844 nla_for_each_nested(attr, nl_attr, tmp) { 4845 if (nla_len(attr) != ETH_ALEN) 4846 return -EINVAL; 4847 4848 n_entries++; 4849 } 4850 4851 return n_entries; 4852 } 4853 4854 /* 4855 * This function parses ACL information and allocates memory for ACL data. 4856 * On successful return, the calling function is responsible to free the 4857 * ACL buffer returned by this function. 4858 */ 4859 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy, 4860 struct genl_info *info) 4861 { 4862 enum nl80211_acl_policy acl_policy; 4863 struct nlattr *attr; 4864 struct cfg80211_acl_data *acl; 4865 int i = 0, n_entries, tmp; 4866 4867 if (!wiphy->max_acl_mac_addrs) 4868 return ERR_PTR(-EOPNOTSUPP); 4869 4870 if (!info->attrs[NL80211_ATTR_ACL_POLICY]) 4871 return ERR_PTR(-EINVAL); 4872 4873 acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]); 4874 if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED && 4875 acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED) 4876 return ERR_PTR(-EINVAL); 4877 4878 if (!info->attrs[NL80211_ATTR_MAC_ADDRS]) 4879 return ERR_PTR(-EINVAL); 4880 4881 n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]); 4882 if (n_entries < 0) 4883 return ERR_PTR(n_entries); 4884 4885 if (n_entries > wiphy->max_acl_mac_addrs) 4886 return ERR_PTR(-ENOTSUPP); 4887 4888 acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL); 4889 if (!acl) 4890 return ERR_PTR(-ENOMEM); 4891 4892 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) { 4893 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN); 4894 i++; 4895 } 4896 4897 acl->n_acl_entries = n_entries; 4898 acl->acl_policy = acl_policy; 4899 4900 return acl; 4901 } 4902 4903 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info) 4904 { 4905 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 4906 struct net_device *dev = info->user_ptr[1]; 4907 struct cfg80211_acl_data *acl; 4908 int err; 4909 4910 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 4911 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 4912 return -EOPNOTSUPP; 4913 4914 if (!dev->ieee80211_ptr->links[0].ap.beacon_interval) 4915 return -EINVAL; 4916 4917 acl = parse_acl_data(&rdev->wiphy, info); 4918 if (IS_ERR(acl)) 4919 return PTR_ERR(acl); 4920 4921 err = rdev_set_mac_acl(rdev, dev, acl); 4922 4923 kfree(acl); 4924 4925 return err; 4926 } 4927 4928 static u32 rateset_to_mask(struct ieee80211_supported_band *sband, 4929 u8 *rates, u8 rates_len) 4930 { 4931 u8 i; 4932 u32 mask = 0; 4933 4934 for (i = 0; i < rates_len; i++) { 4935 int rate = (rates[i] & 0x7f) * 5; 4936 int ridx; 4937 4938 for (ridx = 0; ridx < sband->n_bitrates; ridx++) { 4939 struct ieee80211_rate *srate = 4940 &sband->bitrates[ridx]; 4941 if (rate == srate->bitrate) { 4942 mask |= 1 << ridx; 4943 break; 4944 } 4945 } 4946 if (ridx == sband->n_bitrates) 4947 return 0; /* rate not found */ 4948 } 4949 4950 return mask; 4951 } 4952 4953 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband, 4954 u8 *rates, u8 rates_len, 4955 u8 mcs[IEEE80211_HT_MCS_MASK_LEN]) 4956 { 4957 u8 i; 4958 4959 memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN); 4960 4961 for (i = 0; i < rates_len; i++) { 4962 int ridx, rbit; 4963 4964 ridx = rates[i] / 8; 4965 rbit = BIT(rates[i] % 8); 4966 4967 /* check validity */ 4968 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN)) 4969 return false; 4970 4971 /* check availability */ 4972 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN); 4973 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit) 4974 mcs[ridx] |= rbit; 4975 else 4976 return false; 4977 } 4978 4979 return true; 4980 } 4981 4982 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map) 4983 { 4984 u16 mcs_mask = 0; 4985 4986 switch (vht_mcs_map) { 4987 case IEEE80211_VHT_MCS_NOT_SUPPORTED: 4988 break; 4989 case IEEE80211_VHT_MCS_SUPPORT_0_7: 4990 mcs_mask = 0x00FF; 4991 break; 4992 case IEEE80211_VHT_MCS_SUPPORT_0_8: 4993 mcs_mask = 0x01FF; 4994 break; 4995 case IEEE80211_VHT_MCS_SUPPORT_0_9: 4996 mcs_mask = 0x03FF; 4997 break; 4998 default: 4999 break; 5000 } 5001 5002 return mcs_mask; 5003 } 5004 5005 static void vht_build_mcs_mask(u16 vht_mcs_map, 5006 u16 vht_mcs_mask[NL80211_VHT_NSS_MAX]) 5007 { 5008 u8 nss; 5009 5010 for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) { 5011 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03); 5012 vht_mcs_map >>= 2; 5013 } 5014 } 5015 5016 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband, 5017 struct nl80211_txrate_vht *txrate, 5018 u16 mcs[NL80211_VHT_NSS_MAX]) 5019 { 5020 u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5021 u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {}; 5022 u8 i; 5023 5024 if (!sband->vht_cap.vht_supported) 5025 return false; 5026 5027 memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX); 5028 5029 /* Build vht_mcs_mask from VHT capabilities */ 5030 vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5031 5032 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5033 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5034 mcs[i] = txrate->mcs[i]; 5035 else 5036 return false; 5037 } 5038 5039 return true; 5040 } 5041 5042 static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map) 5043 { 5044 switch (he_mcs_map) { 5045 case IEEE80211_HE_MCS_NOT_SUPPORTED: 5046 return 0; 5047 case IEEE80211_HE_MCS_SUPPORT_0_7: 5048 return 0x00FF; 5049 case IEEE80211_HE_MCS_SUPPORT_0_9: 5050 return 0x03FF; 5051 case IEEE80211_HE_MCS_SUPPORT_0_11: 5052 return 0xFFF; 5053 default: 5054 break; 5055 } 5056 return 0; 5057 } 5058 5059 static void he_build_mcs_mask(u16 he_mcs_map, 5060 u16 he_mcs_mask[NL80211_HE_NSS_MAX]) 5061 { 5062 u8 nss; 5063 5064 for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) { 5065 he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03); 5066 he_mcs_map >>= 2; 5067 } 5068 } 5069 5070 static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id, 5071 const struct ieee80211_sta_he_cap *he_cap) 5072 { 5073 struct net_device *dev = info->user_ptr[1]; 5074 struct wireless_dev *wdev = dev->ieee80211_ptr; 5075 struct cfg80211_chan_def *chandef; 5076 __le16 tx_mcs; 5077 5078 chandef = wdev_chandef(wdev, link_id); 5079 if (!chandef) { 5080 /* 5081 * This is probably broken, but we never maintained 5082 * a chandef in these cases, so it always was. 5083 */ 5084 return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80); 5085 } 5086 5087 switch (chandef->width) { 5088 case NL80211_CHAN_WIDTH_80P80: 5089 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80; 5090 break; 5091 case NL80211_CHAN_WIDTH_160: 5092 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160; 5093 break; 5094 default: 5095 tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80; 5096 break; 5097 } 5098 5099 return le16_to_cpu(tx_mcs); 5100 } 5101 5102 static bool he_set_mcs_mask(struct genl_info *info, 5103 struct wireless_dev *wdev, 5104 struct ieee80211_supported_band *sband, 5105 struct nl80211_txrate_he *txrate, 5106 u16 mcs[NL80211_HE_NSS_MAX], 5107 unsigned int link_id) 5108 { 5109 const struct ieee80211_sta_he_cap *he_cap; 5110 u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {}; 5111 u16 tx_mcs_map = 0; 5112 u8 i; 5113 5114 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5115 if (!he_cap) 5116 return false; 5117 5118 memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX); 5119 5120 tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5121 5122 /* Build he_mcs_mask from HE capabilities */ 5123 he_build_mcs_mask(tx_mcs_map, tx_mcs_mask); 5124 5125 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5126 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i]) 5127 mcs[i] = txrate->mcs[i]; 5128 else 5129 return false; 5130 } 5131 5132 return true; 5133 } 5134 5135 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info, 5136 struct nlattr *attrs[], 5137 enum nl80211_attrs attr, 5138 struct cfg80211_bitrate_mask *mask, 5139 struct net_device *dev, 5140 bool default_all_enabled, 5141 unsigned int link_id) 5142 { 5143 struct nlattr *tb[NL80211_TXRATE_MAX + 1]; 5144 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5145 struct wireless_dev *wdev = dev->ieee80211_ptr; 5146 int rem, i; 5147 struct nlattr *tx_rates; 5148 struct ieee80211_supported_band *sband; 5149 u16 vht_tx_mcs_map, he_tx_mcs_map; 5150 5151 memset(mask, 0, sizeof(*mask)); 5152 /* Default to all rates enabled */ 5153 for (i = 0; i < NUM_NL80211_BANDS; i++) { 5154 const struct ieee80211_sta_he_cap *he_cap; 5155 5156 if (!default_all_enabled) 5157 break; 5158 5159 sband = rdev->wiphy.bands[i]; 5160 5161 if (!sband) 5162 continue; 5163 5164 mask->control[i].legacy = (1 << sband->n_bitrates) - 1; 5165 memcpy(mask->control[i].ht_mcs, 5166 sband->ht_cap.mcs.rx_mask, 5167 sizeof(mask->control[i].ht_mcs)); 5168 5169 if (sband->vht_cap.vht_supported) { 5170 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map); 5171 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs); 5172 } 5173 5174 he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype); 5175 if (!he_cap) 5176 continue; 5177 5178 he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap); 5179 he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs); 5180 5181 mask->control[i].he_gi = 0xFF; 5182 mask->control[i].he_ltf = 0xFF; 5183 } 5184 5185 /* if no rates are given set it back to the defaults */ 5186 if (!attrs[attr]) 5187 goto out; 5188 5189 /* The nested attribute uses enum nl80211_band as the index. This maps 5190 * directly to the enum nl80211_band values used in cfg80211. 5191 */ 5192 BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8); 5193 nla_for_each_nested(tx_rates, attrs[attr], rem) { 5194 enum nl80211_band band = nla_type(tx_rates); 5195 int err; 5196 5197 if (band < 0 || band >= NUM_NL80211_BANDS) 5198 return -EINVAL; 5199 sband = rdev->wiphy.bands[band]; 5200 if (sband == NULL) 5201 return -EINVAL; 5202 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX, 5203 tx_rates, 5204 nl80211_txattr_policy, 5205 info->extack); 5206 if (err) 5207 return err; 5208 if (tb[NL80211_TXRATE_LEGACY]) { 5209 mask->control[band].legacy = rateset_to_mask( 5210 sband, 5211 nla_data(tb[NL80211_TXRATE_LEGACY]), 5212 nla_len(tb[NL80211_TXRATE_LEGACY])); 5213 if ((mask->control[band].legacy == 0) && 5214 nla_len(tb[NL80211_TXRATE_LEGACY])) 5215 return -EINVAL; 5216 } 5217 if (tb[NL80211_TXRATE_HT]) { 5218 if (!ht_rateset_to_mask( 5219 sband, 5220 nla_data(tb[NL80211_TXRATE_HT]), 5221 nla_len(tb[NL80211_TXRATE_HT]), 5222 mask->control[band].ht_mcs)) 5223 return -EINVAL; 5224 } 5225 5226 if (tb[NL80211_TXRATE_VHT]) { 5227 if (!vht_set_mcs_mask( 5228 sband, 5229 nla_data(tb[NL80211_TXRATE_VHT]), 5230 mask->control[band].vht_mcs)) 5231 return -EINVAL; 5232 } 5233 5234 if (tb[NL80211_TXRATE_GI]) { 5235 mask->control[band].gi = 5236 nla_get_u8(tb[NL80211_TXRATE_GI]); 5237 if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI) 5238 return -EINVAL; 5239 } 5240 if (tb[NL80211_TXRATE_HE] && 5241 !he_set_mcs_mask(info, wdev, sband, 5242 nla_data(tb[NL80211_TXRATE_HE]), 5243 mask->control[band].he_mcs, 5244 link_id)) 5245 return -EINVAL; 5246 5247 if (tb[NL80211_TXRATE_HE_GI]) 5248 mask->control[band].he_gi = 5249 nla_get_u8(tb[NL80211_TXRATE_HE_GI]); 5250 if (tb[NL80211_TXRATE_HE_LTF]) 5251 mask->control[band].he_ltf = 5252 nla_get_u8(tb[NL80211_TXRATE_HE_LTF]); 5253 5254 if (mask->control[band].legacy == 0) { 5255 /* don't allow empty legacy rates if HT, VHT or HE 5256 * are not even supported. 5257 */ 5258 if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported || 5259 rdev->wiphy.bands[band]->vht_cap.vht_supported || 5260 ieee80211_get_he_iftype_cap(sband, wdev->iftype))) 5261 return -EINVAL; 5262 5263 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) 5264 if (mask->control[band].ht_mcs[i]) 5265 goto out; 5266 5267 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) 5268 if (mask->control[band].vht_mcs[i]) 5269 goto out; 5270 5271 for (i = 0; i < NL80211_HE_NSS_MAX; i++) 5272 if (mask->control[band].he_mcs[i]) 5273 goto out; 5274 5275 /* legacy and mcs rates may not be both empty */ 5276 return -EINVAL; 5277 } 5278 } 5279 5280 out: 5281 return 0; 5282 } 5283 5284 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev, 5285 enum nl80211_band band, 5286 struct cfg80211_bitrate_mask *beacon_rate) 5287 { 5288 u32 count_ht, count_vht, count_he, i; 5289 u32 rate = beacon_rate->control[band].legacy; 5290 5291 /* Allow only one rate */ 5292 if (hweight32(rate) > 1) 5293 return -EINVAL; 5294 5295 count_ht = 0; 5296 for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) { 5297 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) { 5298 return -EINVAL; 5299 } else if (beacon_rate->control[band].ht_mcs[i]) { 5300 count_ht++; 5301 if (count_ht > 1) 5302 return -EINVAL; 5303 } 5304 if (count_ht && rate) 5305 return -EINVAL; 5306 } 5307 5308 count_vht = 0; 5309 for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { 5310 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) { 5311 return -EINVAL; 5312 } else if (beacon_rate->control[band].vht_mcs[i]) { 5313 count_vht++; 5314 if (count_vht > 1) 5315 return -EINVAL; 5316 } 5317 if (count_vht && rate) 5318 return -EINVAL; 5319 } 5320 5321 count_he = 0; 5322 for (i = 0; i < NL80211_HE_NSS_MAX; i++) { 5323 if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) { 5324 return -EINVAL; 5325 } else if (beacon_rate->control[band].he_mcs[i]) { 5326 count_he++; 5327 if (count_he > 1) 5328 return -EINVAL; 5329 } 5330 if (count_he && rate) 5331 return -EINVAL; 5332 } 5333 5334 if ((count_ht && count_vht && count_he) || 5335 (!rate && !count_ht && !count_vht && !count_he)) 5336 return -EINVAL; 5337 5338 if (rate && 5339 !wiphy_ext_feature_isset(&rdev->wiphy, 5340 NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) 5341 return -EINVAL; 5342 if (count_ht && 5343 !wiphy_ext_feature_isset(&rdev->wiphy, 5344 NL80211_EXT_FEATURE_BEACON_RATE_HT)) 5345 return -EINVAL; 5346 if (count_vht && 5347 !wiphy_ext_feature_isset(&rdev->wiphy, 5348 NL80211_EXT_FEATURE_BEACON_RATE_VHT)) 5349 return -EINVAL; 5350 if (count_he && 5351 !wiphy_ext_feature_isset(&rdev->wiphy, 5352 NL80211_EXT_FEATURE_BEACON_RATE_HE)) 5353 return -EINVAL; 5354 5355 return 0; 5356 } 5357 5358 static int nl80211_parse_mbssid_config(struct wiphy *wiphy, 5359 struct net_device *dev, 5360 struct nlattr *attrs, 5361 struct cfg80211_mbssid_config *config, 5362 u8 num_elems) 5363 { 5364 struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1]; 5365 5366 if (!wiphy->mbssid_max_interfaces) 5367 return -EOPNOTSUPP; 5368 5369 if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL, 5370 NULL) || 5371 !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]) 5372 return -EINVAL; 5373 5374 config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]); 5375 if (config->ema) { 5376 if (!wiphy->ema_max_profile_periodicity) 5377 return -EOPNOTSUPP; 5378 5379 if (num_elems > wiphy->ema_max_profile_periodicity) 5380 return -EINVAL; 5381 } 5382 5383 config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]); 5384 if (config->index >= wiphy->mbssid_max_interfaces || 5385 (!config->index && !num_elems)) 5386 return -EINVAL; 5387 5388 if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) { 5389 u32 tx_ifindex = 5390 nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]); 5391 5392 if ((!config->index && tx_ifindex != dev->ifindex) || 5393 (config->index && tx_ifindex == dev->ifindex)) 5394 return -EINVAL; 5395 5396 if (tx_ifindex != dev->ifindex) { 5397 struct net_device *tx_netdev = 5398 dev_get_by_index(wiphy_net(wiphy), tx_ifindex); 5399 5400 if (!tx_netdev || !tx_netdev->ieee80211_ptr || 5401 tx_netdev->ieee80211_ptr->wiphy != wiphy || 5402 tx_netdev->ieee80211_ptr->iftype != 5403 NL80211_IFTYPE_AP) { 5404 dev_put(tx_netdev); 5405 return -EINVAL; 5406 } 5407 5408 config->tx_wdev = tx_netdev->ieee80211_ptr; 5409 } else { 5410 config->tx_wdev = dev->ieee80211_ptr; 5411 } 5412 } else if (!config->index) { 5413 config->tx_wdev = dev->ieee80211_ptr; 5414 } else { 5415 return -EINVAL; 5416 } 5417 5418 return 0; 5419 } 5420 5421 static struct cfg80211_mbssid_elems * 5422 nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs) 5423 { 5424 struct nlattr *nl_elems; 5425 struct cfg80211_mbssid_elems *elems; 5426 int rem_elems; 5427 u8 i = 0, num_elems = 0; 5428 5429 if (!wiphy->mbssid_max_interfaces) 5430 return ERR_PTR(-EINVAL); 5431 5432 nla_for_each_nested(nl_elems, attrs, rem_elems) 5433 num_elems++; 5434 5435 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5436 if (!elems) 5437 return ERR_PTR(-ENOMEM); 5438 5439 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5440 elems->elem[i].data = nla_data(nl_elems); 5441 elems->elem[i].len = nla_len(nl_elems); 5442 i++; 5443 } 5444 elems->cnt = num_elems; 5445 return elems; 5446 } 5447 5448 static struct cfg80211_rnr_elems * 5449 nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs, 5450 struct netlink_ext_ack *extack) 5451 { 5452 struct nlattr *nl_elems; 5453 struct cfg80211_rnr_elems *elems; 5454 int rem_elems; 5455 u8 i = 0, num_elems = 0; 5456 5457 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5458 int ret; 5459 5460 ret = validate_ie_attr(nl_elems, extack); 5461 if (ret) 5462 return ERR_PTR(ret); 5463 5464 num_elems++; 5465 } 5466 5467 elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL); 5468 if (!elems) 5469 return ERR_PTR(-ENOMEM); 5470 5471 nla_for_each_nested(nl_elems, attrs, rem_elems) { 5472 elems->elem[i].data = nla_data(nl_elems); 5473 elems->elem[i].len = nla_len(nl_elems); 5474 i++; 5475 } 5476 elems->cnt = num_elems; 5477 return elems; 5478 } 5479 5480 static int nl80211_parse_he_bss_color(struct nlattr *attrs, 5481 struct cfg80211_he_bss_color *he_bss_color) 5482 { 5483 struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1]; 5484 int err; 5485 5486 err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs, 5487 he_bss_color_policy, NULL); 5488 if (err) 5489 return err; 5490 5491 if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]) 5492 return -EINVAL; 5493 5494 he_bss_color->color = 5495 nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]); 5496 he_bss_color->enabled = 5497 !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]); 5498 he_bss_color->partial = 5499 nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]); 5500 5501 return 0; 5502 } 5503 5504 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev, 5505 struct nlattr *attrs[], 5506 struct cfg80211_beacon_data *bcn, 5507 struct netlink_ext_ack *extack) 5508 { 5509 bool haveinfo = false; 5510 int err; 5511 5512 memset(bcn, 0, sizeof(*bcn)); 5513 5514 bcn->link_id = nl80211_link_id(attrs); 5515 5516 if (attrs[NL80211_ATTR_BEACON_HEAD]) { 5517 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]); 5518 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]); 5519 if (!bcn->head_len) 5520 return -EINVAL; 5521 haveinfo = true; 5522 } 5523 5524 if (attrs[NL80211_ATTR_BEACON_TAIL]) { 5525 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]); 5526 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]); 5527 haveinfo = true; 5528 } 5529 5530 if (!haveinfo) 5531 return -EINVAL; 5532 5533 if (attrs[NL80211_ATTR_IE]) { 5534 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]); 5535 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]); 5536 } 5537 5538 if (attrs[NL80211_ATTR_IE_PROBE_RESP]) { 5539 bcn->proberesp_ies = 5540 nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5541 bcn->proberesp_ies_len = 5542 nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]); 5543 } 5544 5545 if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) { 5546 bcn->assocresp_ies = 5547 nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5548 bcn->assocresp_ies_len = 5549 nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]); 5550 } 5551 5552 if (attrs[NL80211_ATTR_PROBE_RESP]) { 5553 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]); 5554 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]); 5555 } 5556 5557 if (attrs[NL80211_ATTR_FTM_RESPONDER]) { 5558 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1]; 5559 5560 err = nla_parse_nested_deprecated(tb, 5561 NL80211_FTM_RESP_ATTR_MAX, 5562 attrs[NL80211_ATTR_FTM_RESPONDER], 5563 NULL, NULL); 5564 if (err) 5565 return err; 5566 5567 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] && 5568 wiphy_ext_feature_isset(&rdev->wiphy, 5569 NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER)) 5570 bcn->ftm_responder = 1; 5571 else 5572 return -EOPNOTSUPP; 5573 5574 if (tb[NL80211_FTM_RESP_ATTR_LCI]) { 5575 bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]); 5576 bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]); 5577 } 5578 5579 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) { 5580 bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5581 bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]); 5582 } 5583 } else { 5584 bcn->ftm_responder = -1; 5585 } 5586 5587 if (attrs[NL80211_ATTR_HE_BSS_COLOR]) { 5588 err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR], 5589 &bcn->he_bss_color); 5590 if (err) 5591 return err; 5592 bcn->he_bss_color_valid = true; 5593 } 5594 5595 if (attrs[NL80211_ATTR_MBSSID_ELEMS]) { 5596 struct cfg80211_mbssid_elems *mbssid = 5597 nl80211_parse_mbssid_elems(&rdev->wiphy, 5598 attrs[NL80211_ATTR_MBSSID_ELEMS]); 5599 5600 if (IS_ERR(mbssid)) 5601 return PTR_ERR(mbssid); 5602 5603 bcn->mbssid_ies = mbssid; 5604 5605 if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) { 5606 struct cfg80211_rnr_elems *rnr = 5607 nl80211_parse_rnr_elems(&rdev->wiphy, 5608 attrs[NL80211_ATTR_EMA_RNR_ELEMS], 5609 extack); 5610 5611 if (IS_ERR(rnr)) 5612 return PTR_ERR(rnr); 5613 5614 if (rnr && rnr->cnt < bcn->mbssid_ies->cnt) 5615 return -EINVAL; 5616 5617 bcn->rnr_ies = rnr; 5618 } 5619 } 5620 5621 return 0; 5622 } 5623 5624 static int nl80211_parse_he_obss_pd(struct nlattr *attrs, 5625 struct ieee80211_he_obss_pd *he_obss_pd) 5626 { 5627 struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1]; 5628 int err; 5629 5630 err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs, 5631 he_obss_pd_policy, NULL); 5632 if (err) 5633 return err; 5634 5635 if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]) 5636 return -EINVAL; 5637 5638 he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]); 5639 5640 if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]) 5641 he_obss_pd->min_offset = 5642 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]); 5643 if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]) 5644 he_obss_pd->max_offset = 5645 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]); 5646 if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]) 5647 he_obss_pd->non_srg_max_offset = 5648 nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]); 5649 5650 if (he_obss_pd->min_offset > he_obss_pd->max_offset) 5651 return -EINVAL; 5652 5653 if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]) 5654 memcpy(he_obss_pd->bss_color_bitmap, 5655 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]), 5656 sizeof(he_obss_pd->bss_color_bitmap)); 5657 5658 if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]) 5659 memcpy(he_obss_pd->partial_bssid_bitmap, 5660 nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]), 5661 sizeof(he_obss_pd->partial_bssid_bitmap)); 5662 5663 he_obss_pd->enable = true; 5664 5665 return 0; 5666 } 5667 5668 static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev, 5669 struct nlattr *attrs, 5670 struct cfg80211_ap_settings *params) 5671 { 5672 struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1]; 5673 int ret; 5674 struct cfg80211_fils_discovery *fd = ¶ms->fils_discovery; 5675 5676 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5677 NL80211_EXT_FEATURE_FILS_DISCOVERY)) 5678 return -EINVAL; 5679 5680 ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs, 5681 NULL, NULL); 5682 if (ret) 5683 return ret; 5684 5685 if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] || 5686 !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] || 5687 !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) 5688 return -EINVAL; 5689 5690 fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5691 fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]); 5692 fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]); 5693 fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]); 5694 5695 return 0; 5696 } 5697 5698 static int 5699 nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev, 5700 struct nlattr *attrs, 5701 struct cfg80211_ap_settings *params) 5702 { 5703 struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1]; 5704 int ret; 5705 struct cfg80211_unsol_bcast_probe_resp *presp = 5706 ¶ms->unsol_bcast_probe_resp; 5707 5708 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5709 NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP)) 5710 return -EINVAL; 5711 5712 ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX, 5713 attrs, NULL, NULL); 5714 if (ret) 5715 return ret; 5716 5717 if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] || 5718 !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) 5719 return -EINVAL; 5720 5721 presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5722 presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]); 5723 presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]); 5724 return 0; 5725 } 5726 5727 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params, 5728 const struct element *rates) 5729 { 5730 int i; 5731 5732 if (!rates) 5733 return; 5734 5735 for (i = 0; i < rates->datalen; i++) { 5736 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY) 5737 params->ht_required = true; 5738 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY) 5739 params->vht_required = true; 5740 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY) 5741 params->he_required = true; 5742 if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E) 5743 params->sae_h2e_required = true; 5744 } 5745 } 5746 5747 /* 5748 * Since the nl80211 API didn't include, from the beginning, attributes about 5749 * HT/VHT requirements/capabilities, we parse them out of the IEs for the 5750 * benefit of drivers that rebuild IEs in the firmware. 5751 */ 5752 static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params) 5753 { 5754 const struct cfg80211_beacon_data *bcn = ¶ms->beacon; 5755 size_t ies_len = bcn->tail_len; 5756 const u8 *ies = bcn->tail; 5757 const struct element *rates; 5758 const struct element *cap; 5759 5760 rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len); 5761 nl80211_check_ap_rate_selectors(params, rates); 5762 5763 rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len); 5764 nl80211_check_ap_rate_selectors(params, rates); 5765 5766 cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len); 5767 if (cap && cap->datalen >= sizeof(*params->ht_cap)) 5768 params->ht_cap = (void *)cap->data; 5769 cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len); 5770 if (cap && cap->datalen >= sizeof(*params->vht_cap)) 5771 params->vht_cap = (void *)cap->data; 5772 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len); 5773 if (cap && cap->datalen >= sizeof(*params->he_cap) + 1) 5774 params->he_cap = (void *)(cap->data + 1); 5775 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len); 5776 if (cap && cap->datalen >= sizeof(*params->he_oper) + 1) 5777 params->he_oper = (void *)(cap->data + 1); 5778 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len); 5779 if (cap) { 5780 if (!cap->datalen) 5781 return -EINVAL; 5782 params->eht_cap = (void *)(cap->data + 1); 5783 if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap, 5784 (const u8 *)params->eht_cap, 5785 cap->datalen - 1, true)) 5786 return -EINVAL; 5787 } 5788 cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len); 5789 if (cap) { 5790 if (!cap->datalen) 5791 return -EINVAL; 5792 params->eht_oper = (void *)(cap->data + 1); 5793 if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper, 5794 cap->datalen - 1)) 5795 return -EINVAL; 5796 } 5797 return 0; 5798 } 5799 5800 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev, 5801 struct cfg80211_ap_settings *params) 5802 { 5803 struct wireless_dev *wdev; 5804 5805 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) { 5806 if (wdev->iftype != NL80211_IFTYPE_AP && 5807 wdev->iftype != NL80211_IFTYPE_P2P_GO) 5808 continue; 5809 5810 if (!wdev->u.ap.preset_chandef.chan) 5811 continue; 5812 5813 params->chandef = wdev->u.ap.preset_chandef; 5814 return true; 5815 } 5816 5817 return false; 5818 } 5819 5820 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev, 5821 enum nl80211_auth_type auth_type, 5822 enum nl80211_commands cmd) 5823 { 5824 if (auth_type > NL80211_AUTHTYPE_MAX) 5825 return false; 5826 5827 switch (cmd) { 5828 case NL80211_CMD_AUTHENTICATE: 5829 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 5830 auth_type == NL80211_AUTHTYPE_SAE) 5831 return false; 5832 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5833 NL80211_EXT_FEATURE_FILS_STA) && 5834 (auth_type == NL80211_AUTHTYPE_FILS_SK || 5835 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5836 auth_type == NL80211_AUTHTYPE_FILS_PK)) 5837 return false; 5838 return true; 5839 case NL80211_CMD_CONNECT: 5840 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) && 5841 !wiphy_ext_feature_isset(&rdev->wiphy, 5842 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 5843 auth_type == NL80211_AUTHTYPE_SAE) 5844 return false; 5845 5846 /* FILS with SK PFS or PK not supported yet */ 5847 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5848 auth_type == NL80211_AUTHTYPE_FILS_PK) 5849 return false; 5850 if (!wiphy_ext_feature_isset( 5851 &rdev->wiphy, 5852 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 5853 auth_type == NL80211_AUTHTYPE_FILS_SK) 5854 return false; 5855 return true; 5856 case NL80211_CMD_START_AP: 5857 if (!wiphy_ext_feature_isset(&rdev->wiphy, 5858 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) && 5859 auth_type == NL80211_AUTHTYPE_SAE) 5860 return false; 5861 /* FILS not supported yet */ 5862 if (auth_type == NL80211_AUTHTYPE_FILS_SK || 5863 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 5864 auth_type == NL80211_AUTHTYPE_FILS_PK) 5865 return false; 5866 return true; 5867 default: 5868 return false; 5869 } 5870 } 5871 5872 static void nl80211_send_ap_started(struct wireless_dev *wdev, 5873 unsigned int link_id) 5874 { 5875 struct wiphy *wiphy = wdev->wiphy; 5876 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 5877 struct sk_buff *msg; 5878 void *hdr; 5879 5880 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 5881 if (!msg) 5882 return; 5883 5884 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP); 5885 if (!hdr) 5886 goto out; 5887 5888 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 5889 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 5890 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 5891 NL80211_ATTR_PAD) || 5892 (wdev->u.ap.ssid_len && 5893 nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len, 5894 wdev->u.ap.ssid)) || 5895 (wdev->valid_links && 5896 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 5897 goto out; 5898 5899 genlmsg_end(msg, hdr); 5900 5901 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 5902 NL80211_MCGRP_MLME, GFP_KERNEL); 5903 return; 5904 out: 5905 nlmsg_free(msg); 5906 } 5907 5908 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info) 5909 { 5910 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 5911 unsigned int link_id = nl80211_link_id(info->attrs); 5912 struct net_device *dev = info->user_ptr[1]; 5913 struct wireless_dev *wdev = dev->ieee80211_ptr; 5914 struct cfg80211_ap_settings *params; 5915 int err; 5916 5917 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 5918 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 5919 return -EOPNOTSUPP; 5920 5921 if (!rdev->ops->start_ap) 5922 return -EOPNOTSUPP; 5923 5924 if (wdev->links[link_id].ap.beacon_interval) 5925 return -EALREADY; 5926 5927 /* these are required for START_AP */ 5928 if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] || 5929 !info->attrs[NL80211_ATTR_DTIM_PERIOD] || 5930 !info->attrs[NL80211_ATTR_BEACON_HEAD]) 5931 return -EINVAL; 5932 5933 params = kzalloc(sizeof(*params), GFP_KERNEL); 5934 if (!params) 5935 return -ENOMEM; 5936 5937 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms->beacon, 5938 info->extack); 5939 if (err) 5940 goto out; 5941 5942 params->beacon_interval = 5943 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 5944 params->dtim_period = 5945 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 5946 5947 err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype, 5948 params->beacon_interval); 5949 if (err) 5950 goto out; 5951 5952 /* 5953 * In theory, some of these attributes should be required here 5954 * but since they were not used when the command was originally 5955 * added, keep them optional for old user space programs to let 5956 * them continue to work with drivers that do not need the 5957 * additional information -- drivers must check! 5958 */ 5959 if (info->attrs[NL80211_ATTR_SSID]) { 5960 params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 5961 params->ssid_len = 5962 nla_len(info->attrs[NL80211_ATTR_SSID]); 5963 if (params->ssid_len == 0) { 5964 err = -EINVAL; 5965 goto out; 5966 } 5967 5968 if (wdev->u.ap.ssid_len && 5969 (wdev->u.ap.ssid_len != params->ssid_len || 5970 memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) { 5971 /* require identical SSID for MLO */ 5972 err = -EINVAL; 5973 goto out; 5974 } 5975 } else if (wdev->valid_links) { 5976 /* require SSID for MLO */ 5977 err = -EINVAL; 5978 goto out; 5979 } 5980 5981 if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) 5982 params->hidden_ssid = nla_get_u32( 5983 info->attrs[NL80211_ATTR_HIDDEN_SSID]); 5984 5985 params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 5986 5987 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 5988 params->auth_type = nla_get_u32( 5989 info->attrs[NL80211_ATTR_AUTH_TYPE]); 5990 if (!nl80211_valid_auth_type(rdev, params->auth_type, 5991 NL80211_CMD_START_AP)) { 5992 err = -EINVAL; 5993 goto out; 5994 } 5995 } else 5996 params->auth_type = NL80211_AUTHTYPE_AUTOMATIC; 5997 5998 err = nl80211_crypto_settings(rdev, info, ¶ms->crypto, 5999 NL80211_MAX_NR_CIPHER_SUITES); 6000 if (err) 6001 goto out; 6002 6003 if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) { 6004 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) { 6005 err = -EOPNOTSUPP; 6006 goto out; 6007 } 6008 params->inactivity_timeout = nla_get_u16( 6009 info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]); 6010 } 6011 6012 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 6013 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6014 err = -EINVAL; 6015 goto out; 6016 } 6017 params->p2p_ctwindow = 6018 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 6019 if (params->p2p_ctwindow != 0 && 6020 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) { 6021 err = -EINVAL; 6022 goto out; 6023 } 6024 } 6025 6026 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 6027 u8 tmp; 6028 6029 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6030 err = -EINVAL; 6031 goto out; 6032 } 6033 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 6034 params->p2p_opp_ps = tmp; 6035 if (params->p2p_opp_ps != 0 && 6036 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) { 6037 err = -EINVAL; 6038 goto out; 6039 } 6040 } 6041 6042 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 6043 err = nl80211_parse_chandef(rdev, info, ¶ms->chandef); 6044 if (err) 6045 goto out; 6046 } else if (wdev->valid_links) { 6047 /* with MLD need to specify the channel configuration */ 6048 err = -EINVAL; 6049 goto out; 6050 } else if (wdev->u.ap.preset_chandef.chan) { 6051 params->chandef = wdev->u.ap.preset_chandef; 6052 } else if (!nl80211_get_ap_channel(rdev, params)) { 6053 err = -EINVAL; 6054 goto out; 6055 } 6056 6057 if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) { 6058 err = nl80211_parse_punct_bitmap(rdev, info, 6059 ¶ms->chandef, 6060 ¶ms->punct_bitmap); 6061 if (err) 6062 goto out; 6063 } 6064 6065 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms->chandef, 6066 wdev->iftype)) { 6067 err = -EINVAL; 6068 goto out; 6069 } 6070 6071 wdev_lock(wdev); 6072 6073 if (info->attrs[NL80211_ATTR_TX_RATES]) { 6074 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 6075 NL80211_ATTR_TX_RATES, 6076 ¶ms->beacon_rate, 6077 dev, false, link_id); 6078 if (err) 6079 goto out_unlock; 6080 6081 err = validate_beacon_tx_rate(rdev, params->chandef.chan->band, 6082 ¶ms->beacon_rate); 6083 if (err) 6084 goto out_unlock; 6085 } 6086 6087 if (info->attrs[NL80211_ATTR_SMPS_MODE]) { 6088 params->smps_mode = 6089 nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]); 6090 switch (params->smps_mode) { 6091 case NL80211_SMPS_OFF: 6092 break; 6093 case NL80211_SMPS_STATIC: 6094 if (!(rdev->wiphy.features & 6095 NL80211_FEATURE_STATIC_SMPS)) { 6096 err = -EINVAL; 6097 goto out_unlock; 6098 } 6099 break; 6100 case NL80211_SMPS_DYNAMIC: 6101 if (!(rdev->wiphy.features & 6102 NL80211_FEATURE_DYNAMIC_SMPS)) { 6103 err = -EINVAL; 6104 goto out_unlock; 6105 } 6106 break; 6107 default: 6108 err = -EINVAL; 6109 goto out_unlock; 6110 } 6111 } else { 6112 params->smps_mode = NL80211_SMPS_OFF; 6113 } 6114 6115 params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 6116 if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 6117 err = -EOPNOTSUPP; 6118 goto out_unlock; 6119 } 6120 6121 if (info->attrs[NL80211_ATTR_ACL_POLICY]) { 6122 params->acl = parse_acl_data(&rdev->wiphy, info); 6123 if (IS_ERR(params->acl)) { 6124 err = PTR_ERR(params->acl); 6125 params->acl = NULL; 6126 goto out_unlock; 6127 } 6128 } 6129 6130 params->twt_responder = 6131 nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]); 6132 6133 if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) { 6134 err = nl80211_parse_he_obss_pd( 6135 info->attrs[NL80211_ATTR_HE_OBSS_PD], 6136 ¶ms->he_obss_pd); 6137 if (err) 6138 goto out_unlock; 6139 } 6140 6141 if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) { 6142 err = nl80211_parse_fils_discovery(rdev, 6143 info->attrs[NL80211_ATTR_FILS_DISCOVERY], 6144 params); 6145 if (err) 6146 goto out_unlock; 6147 } 6148 6149 if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) { 6150 err = nl80211_parse_unsol_bcast_probe_resp( 6151 rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP], 6152 params); 6153 if (err) 6154 goto out_unlock; 6155 } 6156 6157 if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) { 6158 err = nl80211_parse_mbssid_config(&rdev->wiphy, dev, 6159 info->attrs[NL80211_ATTR_MBSSID_CONFIG], 6160 ¶ms->mbssid_config, 6161 params->beacon.mbssid_ies ? 6162 params->beacon.mbssid_ies->cnt : 6163 0); 6164 if (err) 6165 goto out_unlock; 6166 } 6167 6168 if (!params->mbssid_config.ema && params->beacon.rnr_ies) { 6169 err = -EINVAL; 6170 goto out_unlock; 6171 } 6172 6173 err = nl80211_calculate_ap_params(params); 6174 if (err) 6175 goto out_unlock; 6176 6177 if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]) 6178 params->flags = nla_get_u32( 6179 info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]); 6180 else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT]) 6181 params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT; 6182 6183 if (wdev->conn_owner_nlportid && 6184 info->attrs[NL80211_ATTR_SOCKET_OWNER] && 6185 wdev->conn_owner_nlportid != info->snd_portid) { 6186 err = -EINVAL; 6187 goto out_unlock; 6188 } 6189 6190 /* FIXME: validate MLO/link-id against driver capabilities */ 6191 6192 err = rdev_start_ap(rdev, dev, params); 6193 if (!err) { 6194 wdev->links[link_id].ap.beacon_interval = params->beacon_interval; 6195 wdev->links[link_id].ap.chandef = params->chandef; 6196 wdev->u.ap.ssid_len = params->ssid_len; 6197 memcpy(wdev->u.ap.ssid, params->ssid, 6198 params->ssid_len); 6199 6200 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 6201 wdev->conn_owner_nlportid = info->snd_portid; 6202 6203 nl80211_send_ap_started(wdev, link_id); 6204 } 6205 out_unlock: 6206 wdev_unlock(wdev); 6207 out: 6208 kfree(params->acl); 6209 kfree(params->beacon.mbssid_ies); 6210 if (params->mbssid_config.tx_wdev && 6211 params->mbssid_config.tx_wdev->netdev && 6212 params->mbssid_config.tx_wdev->netdev != dev) 6213 dev_put(params->mbssid_config.tx_wdev->netdev); 6214 kfree(params->beacon.rnr_ies); 6215 kfree(params); 6216 6217 return err; 6218 } 6219 6220 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info) 6221 { 6222 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6223 unsigned int link_id = nl80211_link_id(info->attrs); 6224 struct net_device *dev = info->user_ptr[1]; 6225 struct wireless_dev *wdev = dev->ieee80211_ptr; 6226 struct cfg80211_beacon_data params; 6227 int err; 6228 6229 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6230 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 6231 return -EOPNOTSUPP; 6232 6233 if (!rdev->ops->change_beacon) 6234 return -EOPNOTSUPP; 6235 6236 if (!wdev->links[link_id].ap.beacon_interval) 6237 return -EINVAL; 6238 6239 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms, info->extack); 6240 if (err) 6241 goto out; 6242 6243 wdev_lock(wdev); 6244 err = rdev_change_beacon(rdev, dev, ¶ms); 6245 wdev_unlock(wdev); 6246 6247 out: 6248 kfree(params.mbssid_ies); 6249 kfree(params.rnr_ies); 6250 return err; 6251 } 6252 6253 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info) 6254 { 6255 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6256 unsigned int link_id = nl80211_link_id(info->attrs); 6257 struct net_device *dev = info->user_ptr[1]; 6258 6259 return cfg80211_stop_ap(rdev, dev, link_id, false); 6260 } 6261 6262 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = { 6263 [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG }, 6264 [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG }, 6265 [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG }, 6266 [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG }, 6267 [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG }, 6268 [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG }, 6269 }; 6270 6271 static int parse_station_flags(struct genl_info *info, 6272 enum nl80211_iftype iftype, 6273 struct station_parameters *params) 6274 { 6275 struct nlattr *flags[NL80211_STA_FLAG_MAX + 1]; 6276 struct nlattr *nla; 6277 int flag; 6278 6279 /* 6280 * Try parsing the new attribute first so userspace 6281 * can specify both for older kernels. 6282 */ 6283 nla = info->attrs[NL80211_ATTR_STA_FLAGS2]; 6284 if (nla) { 6285 struct nl80211_sta_flag_update *sta_flags; 6286 6287 sta_flags = nla_data(nla); 6288 params->sta_flags_mask = sta_flags->mask; 6289 params->sta_flags_set = sta_flags->set; 6290 params->sta_flags_set &= params->sta_flags_mask; 6291 if ((params->sta_flags_mask | 6292 params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID)) 6293 return -EINVAL; 6294 return 0; 6295 } 6296 6297 /* if present, parse the old attribute */ 6298 6299 nla = info->attrs[NL80211_ATTR_STA_FLAGS]; 6300 if (!nla) 6301 return 0; 6302 6303 if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack)) 6304 return -EINVAL; 6305 6306 /* 6307 * Only allow certain flags for interface types so that 6308 * other attributes are silently ignored. Remember that 6309 * this is backward compatibility code with old userspace 6310 * and shouldn't be hit in other cases anyway. 6311 */ 6312 switch (iftype) { 6313 case NL80211_IFTYPE_AP: 6314 case NL80211_IFTYPE_AP_VLAN: 6315 case NL80211_IFTYPE_P2P_GO: 6316 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6317 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6318 BIT(NL80211_STA_FLAG_WME) | 6319 BIT(NL80211_STA_FLAG_MFP); 6320 break; 6321 case NL80211_IFTYPE_P2P_CLIENT: 6322 case NL80211_IFTYPE_STATION: 6323 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) | 6324 BIT(NL80211_STA_FLAG_TDLS_PEER); 6325 break; 6326 case NL80211_IFTYPE_MESH_POINT: 6327 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6328 BIT(NL80211_STA_FLAG_MFP) | 6329 BIT(NL80211_STA_FLAG_AUTHORIZED); 6330 break; 6331 default: 6332 return -EINVAL; 6333 } 6334 6335 for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) { 6336 if (flags[flag]) { 6337 params->sta_flags_set |= (1<<flag); 6338 6339 /* no longer support new API additions in old API */ 6340 if (flag > NL80211_STA_FLAG_MAX_OLD_API) 6341 return -EINVAL; 6342 } 6343 } 6344 6345 return 0; 6346 } 6347 6348 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr) 6349 { 6350 struct nlattr *rate; 6351 u32 bitrate; 6352 u16 bitrate_compat; 6353 enum nl80211_rate_info rate_flg; 6354 6355 rate = nla_nest_start_noflag(msg, attr); 6356 if (!rate) 6357 return false; 6358 6359 /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */ 6360 bitrate = cfg80211_calculate_bitrate(info); 6361 /* report 16-bit bitrate only if we can */ 6362 bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0; 6363 if (bitrate > 0 && 6364 nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate)) 6365 return false; 6366 if (bitrate_compat > 0 && 6367 nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat)) 6368 return false; 6369 6370 switch (info->bw) { 6371 case RATE_INFO_BW_5: 6372 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH; 6373 break; 6374 case RATE_INFO_BW_10: 6375 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH; 6376 break; 6377 default: 6378 WARN_ON(1); 6379 fallthrough; 6380 case RATE_INFO_BW_20: 6381 rate_flg = 0; 6382 break; 6383 case RATE_INFO_BW_40: 6384 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH; 6385 break; 6386 case RATE_INFO_BW_80: 6387 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH; 6388 break; 6389 case RATE_INFO_BW_160: 6390 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH; 6391 break; 6392 case RATE_INFO_BW_HE_RU: 6393 rate_flg = 0; 6394 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS)); 6395 break; 6396 case RATE_INFO_BW_320: 6397 rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH; 6398 break; 6399 case RATE_INFO_BW_EHT_RU: 6400 rate_flg = 0; 6401 WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS)); 6402 break; 6403 } 6404 6405 if (rate_flg && nla_put_flag(msg, rate_flg)) 6406 return false; 6407 6408 if (info->flags & RATE_INFO_FLAGS_MCS) { 6409 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs)) 6410 return false; 6411 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6412 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6413 return false; 6414 } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) { 6415 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs)) 6416 return false; 6417 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss)) 6418 return false; 6419 if (info->flags & RATE_INFO_FLAGS_SHORT_GI && 6420 nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI)) 6421 return false; 6422 } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) { 6423 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs)) 6424 return false; 6425 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss)) 6426 return false; 6427 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi)) 6428 return false; 6429 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm)) 6430 return false; 6431 if (info->bw == RATE_INFO_BW_HE_RU && 6432 nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC, 6433 info->he_ru_alloc)) 6434 return false; 6435 } else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) { 6436 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs)) 6437 return false; 6438 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss)) 6439 return false; 6440 if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi)) 6441 return false; 6442 if (info->bw == RATE_INFO_BW_EHT_RU && 6443 nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC, 6444 info->eht_ru_alloc)) 6445 return false; 6446 } 6447 6448 nla_nest_end(msg, rate); 6449 return true; 6450 } 6451 6452 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal, 6453 int id) 6454 { 6455 void *attr; 6456 int i = 0; 6457 6458 if (!mask) 6459 return true; 6460 6461 attr = nla_nest_start_noflag(msg, id); 6462 if (!attr) 6463 return false; 6464 6465 for (i = 0; i < IEEE80211_MAX_CHAINS; i++) { 6466 if (!(mask & BIT(i))) 6467 continue; 6468 6469 if (nla_put_u8(msg, i, signal[i])) 6470 return false; 6471 } 6472 6473 nla_nest_end(msg, attr); 6474 6475 return true; 6476 } 6477 6478 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid, 6479 u32 seq, int flags, 6480 struct cfg80211_registered_device *rdev, 6481 struct net_device *dev, 6482 const u8 *mac_addr, struct station_info *sinfo) 6483 { 6484 void *hdr; 6485 struct nlattr *sinfoattr, *bss_param; 6486 6487 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 6488 if (!hdr) { 6489 cfg80211_sinfo_release_content(sinfo); 6490 return -1; 6491 } 6492 6493 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 6494 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 6495 nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation)) 6496 goto nla_put_failure; 6497 6498 sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO); 6499 if (!sinfoattr) 6500 goto nla_put_failure; 6501 6502 #define PUT_SINFO(attr, memb, type) do { \ 6503 BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \ 6504 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6505 nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \ 6506 sinfo->memb)) \ 6507 goto nla_put_failure; \ 6508 } while (0) 6509 #define PUT_SINFO_U64(attr, memb) do { \ 6510 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \ 6511 nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \ 6512 sinfo->memb, NL80211_STA_INFO_PAD)) \ 6513 goto nla_put_failure; \ 6514 } while (0) 6515 6516 PUT_SINFO(CONNECTED_TIME, connected_time, u32); 6517 PUT_SINFO(INACTIVE_TIME, inactive_time, u32); 6518 PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at); 6519 6520 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 6521 BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) && 6522 nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES, 6523 (u32)sinfo->rx_bytes)) 6524 goto nla_put_failure; 6525 6526 if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 6527 BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) && 6528 nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES, 6529 (u32)sinfo->tx_bytes)) 6530 goto nla_put_failure; 6531 6532 PUT_SINFO_U64(RX_BYTES64, rx_bytes); 6533 PUT_SINFO_U64(TX_BYTES64, tx_bytes); 6534 PUT_SINFO(LLID, llid, u16); 6535 PUT_SINFO(PLID, plid, u16); 6536 PUT_SINFO(PLINK_STATE, plink_state, u8); 6537 PUT_SINFO_U64(RX_DURATION, rx_duration); 6538 PUT_SINFO_U64(TX_DURATION, tx_duration); 6539 6540 if (wiphy_ext_feature_isset(&rdev->wiphy, 6541 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 6542 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16); 6543 6544 switch (rdev->wiphy.signal_type) { 6545 case CFG80211_SIGNAL_TYPE_MBM: 6546 PUT_SINFO(SIGNAL, signal, u8); 6547 PUT_SINFO(SIGNAL_AVG, signal_avg, u8); 6548 break; 6549 default: 6550 break; 6551 } 6552 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) { 6553 if (!nl80211_put_signal(msg, sinfo->chains, 6554 sinfo->chain_signal, 6555 NL80211_STA_INFO_CHAIN_SIGNAL)) 6556 goto nla_put_failure; 6557 } 6558 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) { 6559 if (!nl80211_put_signal(msg, sinfo->chains, 6560 sinfo->chain_signal_avg, 6561 NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) 6562 goto nla_put_failure; 6563 } 6564 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) { 6565 if (!nl80211_put_sta_rate(msg, &sinfo->txrate, 6566 NL80211_STA_INFO_TX_BITRATE)) 6567 goto nla_put_failure; 6568 } 6569 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) { 6570 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate, 6571 NL80211_STA_INFO_RX_BITRATE)) 6572 goto nla_put_failure; 6573 } 6574 6575 PUT_SINFO(RX_PACKETS, rx_packets, u32); 6576 PUT_SINFO(TX_PACKETS, tx_packets, u32); 6577 PUT_SINFO(TX_RETRIES, tx_retries, u32); 6578 PUT_SINFO(TX_FAILED, tx_failed, u32); 6579 PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32); 6580 PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32); 6581 PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32); 6582 PUT_SINFO(LOCAL_PM, local_pm, u32); 6583 PUT_SINFO(PEER_PM, peer_pm, u32); 6584 PUT_SINFO(NONPEER_PM, nonpeer_pm, u32); 6585 PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8); 6586 PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8); 6587 6588 if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) { 6589 bss_param = nla_nest_start_noflag(msg, 6590 NL80211_STA_INFO_BSS_PARAM); 6591 if (!bss_param) 6592 goto nla_put_failure; 6593 6594 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) && 6595 nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) || 6596 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) && 6597 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) || 6598 ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) && 6599 nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) || 6600 nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD, 6601 sinfo->bss_param.dtim_period) || 6602 nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL, 6603 sinfo->bss_param.beacon_interval)) 6604 goto nla_put_failure; 6605 6606 nla_nest_end(msg, bss_param); 6607 } 6608 if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) && 6609 nla_put(msg, NL80211_STA_INFO_STA_FLAGS, 6610 sizeof(struct nl80211_sta_flag_update), 6611 &sinfo->sta_flags)) 6612 goto nla_put_failure; 6613 6614 PUT_SINFO_U64(T_OFFSET, t_offset); 6615 PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc); 6616 PUT_SINFO_U64(BEACON_RX, rx_beacon); 6617 PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8); 6618 PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32); 6619 PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32); 6620 if (wiphy_ext_feature_isset(&rdev->wiphy, 6621 NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) { 6622 PUT_SINFO(ACK_SIGNAL, ack_signal, u8); 6623 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8); 6624 } 6625 6626 #undef PUT_SINFO 6627 #undef PUT_SINFO_U64 6628 6629 if (sinfo->pertid) { 6630 struct nlattr *tidsattr; 6631 int tid; 6632 6633 tidsattr = nla_nest_start_noflag(msg, 6634 NL80211_STA_INFO_TID_STATS); 6635 if (!tidsattr) 6636 goto nla_put_failure; 6637 6638 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) { 6639 struct cfg80211_tid_stats *tidstats; 6640 struct nlattr *tidattr; 6641 6642 tidstats = &sinfo->pertid[tid]; 6643 6644 if (!tidstats->filled) 6645 continue; 6646 6647 tidattr = nla_nest_start_noflag(msg, tid + 1); 6648 if (!tidattr) 6649 goto nla_put_failure; 6650 6651 #define PUT_TIDVAL_U64(attr, memb) do { \ 6652 if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \ 6653 nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \ 6654 tidstats->memb, NL80211_TID_STATS_PAD)) \ 6655 goto nla_put_failure; \ 6656 } while (0) 6657 6658 PUT_TIDVAL_U64(RX_MSDU, rx_msdu); 6659 PUT_TIDVAL_U64(TX_MSDU, tx_msdu); 6660 PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries); 6661 PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed); 6662 6663 #undef PUT_TIDVAL_U64 6664 if ((tidstats->filled & 6665 BIT(NL80211_TID_STATS_TXQ_STATS)) && 6666 !nl80211_put_txq_stats(msg, &tidstats->txq_stats, 6667 NL80211_TID_STATS_TXQ_STATS)) 6668 goto nla_put_failure; 6669 6670 nla_nest_end(msg, tidattr); 6671 } 6672 6673 nla_nest_end(msg, tidsattr); 6674 } 6675 6676 nla_nest_end(msg, sinfoattr); 6677 6678 if (sinfo->assoc_req_ies_len && 6679 nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len, 6680 sinfo->assoc_req_ies)) 6681 goto nla_put_failure; 6682 6683 if (sinfo->assoc_resp_ies_len && 6684 nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len, 6685 sinfo->assoc_resp_ies)) 6686 goto nla_put_failure; 6687 6688 if (sinfo->mlo_params_valid) { 6689 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 6690 sinfo->assoc_link_id)) 6691 goto nla_put_failure; 6692 6693 if (!is_zero_ether_addr(sinfo->mld_addr) && 6694 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 6695 sinfo->mld_addr)) 6696 goto nla_put_failure; 6697 } 6698 6699 cfg80211_sinfo_release_content(sinfo); 6700 genlmsg_end(msg, hdr); 6701 return 0; 6702 6703 nla_put_failure: 6704 cfg80211_sinfo_release_content(sinfo); 6705 genlmsg_cancel(msg, hdr); 6706 return -EMSGSIZE; 6707 } 6708 6709 static int nl80211_dump_station(struct sk_buff *skb, 6710 struct netlink_callback *cb) 6711 { 6712 struct station_info sinfo; 6713 struct cfg80211_registered_device *rdev; 6714 struct wireless_dev *wdev; 6715 u8 mac_addr[ETH_ALEN]; 6716 int sta_idx = cb->args[2]; 6717 int err; 6718 6719 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 6720 if (err) 6721 return err; 6722 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 6723 __acquire(&rdev->wiphy.mtx); 6724 6725 if (!wdev->netdev) { 6726 err = -EINVAL; 6727 goto out_err; 6728 } 6729 6730 if (!rdev->ops->dump_station) { 6731 err = -EOPNOTSUPP; 6732 goto out_err; 6733 } 6734 6735 while (1) { 6736 memset(&sinfo, 0, sizeof(sinfo)); 6737 err = rdev_dump_station(rdev, wdev->netdev, sta_idx, 6738 mac_addr, &sinfo); 6739 if (err == -ENOENT) 6740 break; 6741 if (err) 6742 goto out_err; 6743 6744 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION, 6745 NETLINK_CB(cb->skb).portid, 6746 cb->nlh->nlmsg_seq, NLM_F_MULTI, 6747 rdev, wdev->netdev, mac_addr, 6748 &sinfo) < 0) 6749 goto out; 6750 6751 sta_idx++; 6752 } 6753 6754 out: 6755 cb->args[2] = sta_idx; 6756 err = skb->len; 6757 out_err: 6758 wiphy_unlock(&rdev->wiphy); 6759 6760 return err; 6761 } 6762 6763 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info) 6764 { 6765 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 6766 struct net_device *dev = info->user_ptr[1]; 6767 struct station_info sinfo; 6768 struct sk_buff *msg; 6769 u8 *mac_addr = NULL; 6770 int err; 6771 6772 memset(&sinfo, 0, sizeof(sinfo)); 6773 6774 if (!info->attrs[NL80211_ATTR_MAC]) 6775 return -EINVAL; 6776 6777 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 6778 6779 if (!rdev->ops->get_station) 6780 return -EOPNOTSUPP; 6781 6782 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 6783 if (err) 6784 return err; 6785 6786 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 6787 if (!msg) { 6788 cfg80211_sinfo_release_content(&sinfo); 6789 return -ENOMEM; 6790 } 6791 6792 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 6793 info->snd_portid, info->snd_seq, 0, 6794 rdev, dev, mac_addr, &sinfo) < 0) { 6795 nlmsg_free(msg); 6796 return -ENOBUFS; 6797 } 6798 6799 return genlmsg_reply(msg, info); 6800 } 6801 6802 int cfg80211_check_station_change(struct wiphy *wiphy, 6803 struct station_parameters *params, 6804 enum cfg80211_station_type statype) 6805 { 6806 if (params->listen_interval != -1 && 6807 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6808 return -EINVAL; 6809 6810 if (params->support_p2p_ps != -1 && 6811 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6812 return -EINVAL; 6813 6814 if (params->aid && 6815 !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && 6816 statype != CFG80211_STA_AP_CLIENT_UNASSOC) 6817 return -EINVAL; 6818 6819 /* When you run into this, adjust the code below for the new flag */ 6820 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7); 6821 6822 switch (statype) { 6823 case CFG80211_STA_MESH_PEER_KERNEL: 6824 case CFG80211_STA_MESH_PEER_USER: 6825 /* 6826 * No ignoring the TDLS flag here -- the userspace mesh 6827 * code doesn't have the bug of including TDLS in the 6828 * mask everywhere. 6829 */ 6830 if (params->sta_flags_mask & 6831 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6832 BIT(NL80211_STA_FLAG_MFP) | 6833 BIT(NL80211_STA_FLAG_AUTHORIZED))) 6834 return -EINVAL; 6835 break; 6836 case CFG80211_STA_TDLS_PEER_SETUP: 6837 case CFG80211_STA_TDLS_PEER_ACTIVE: 6838 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 6839 return -EINVAL; 6840 /* ignore since it can't change */ 6841 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 6842 break; 6843 default: 6844 /* disallow mesh-specific things */ 6845 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) 6846 return -EINVAL; 6847 if (params->local_pm) 6848 return -EINVAL; 6849 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 6850 return -EINVAL; 6851 } 6852 6853 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 6854 statype != CFG80211_STA_TDLS_PEER_ACTIVE) { 6855 /* TDLS can't be set, ... */ 6856 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) 6857 return -EINVAL; 6858 /* 6859 * ... but don't bother the driver with it. This works around 6860 * a hostapd/wpa_supplicant issue -- it always includes the 6861 * TLDS_PEER flag in the mask even for AP mode. 6862 */ 6863 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 6864 } 6865 6866 if (statype != CFG80211_STA_TDLS_PEER_SETUP && 6867 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 6868 /* reject other things that can't change */ 6869 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) 6870 return -EINVAL; 6871 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) 6872 return -EINVAL; 6873 if (params->link_sta_params.supported_rates) 6874 return -EINVAL; 6875 if (params->ext_capab || params->link_sta_params.ht_capa || 6876 params->link_sta_params.vht_capa || 6877 params->link_sta_params.he_capa || 6878 params->link_sta_params.eht_capa) 6879 return -EINVAL; 6880 } 6881 6882 if (statype != CFG80211_STA_AP_CLIENT && 6883 statype != CFG80211_STA_AP_CLIENT_UNASSOC) { 6884 if (params->vlan) 6885 return -EINVAL; 6886 } 6887 6888 switch (statype) { 6889 case CFG80211_STA_AP_MLME_CLIENT: 6890 /* Use this only for authorizing/unauthorizing a station */ 6891 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 6892 return -EOPNOTSUPP; 6893 break; 6894 case CFG80211_STA_AP_CLIENT: 6895 case CFG80211_STA_AP_CLIENT_UNASSOC: 6896 /* accept only the listed bits */ 6897 if (params->sta_flags_mask & 6898 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 6899 BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6900 BIT(NL80211_STA_FLAG_ASSOCIATED) | 6901 BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) | 6902 BIT(NL80211_STA_FLAG_WME) | 6903 BIT(NL80211_STA_FLAG_MFP))) 6904 return -EINVAL; 6905 6906 /* but authenticated/associated only if driver handles it */ 6907 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 6908 params->sta_flags_mask & 6909 (BIT(NL80211_STA_FLAG_AUTHENTICATED) | 6910 BIT(NL80211_STA_FLAG_ASSOCIATED))) 6911 return -EINVAL; 6912 break; 6913 case CFG80211_STA_IBSS: 6914 case CFG80211_STA_AP_STA: 6915 /* reject any changes other than AUTHORIZED */ 6916 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED)) 6917 return -EINVAL; 6918 break; 6919 case CFG80211_STA_TDLS_PEER_SETUP: 6920 /* reject any changes other than AUTHORIZED or WME */ 6921 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) | 6922 BIT(NL80211_STA_FLAG_WME))) 6923 return -EINVAL; 6924 /* force (at least) rates when authorizing */ 6925 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) && 6926 !params->link_sta_params.supported_rates) 6927 return -EINVAL; 6928 break; 6929 case CFG80211_STA_TDLS_PEER_ACTIVE: 6930 /* reject any changes */ 6931 return -EINVAL; 6932 case CFG80211_STA_MESH_PEER_KERNEL: 6933 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) 6934 return -EINVAL; 6935 break; 6936 case CFG80211_STA_MESH_PEER_USER: 6937 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION && 6938 params->plink_action != NL80211_PLINK_ACTION_BLOCK) 6939 return -EINVAL; 6940 break; 6941 } 6942 6943 /* 6944 * Older kernel versions ignored this attribute entirely, so don't 6945 * reject attempts to update it but mark it as unused instead so the 6946 * driver won't look at the data. 6947 */ 6948 if (statype != CFG80211_STA_AP_CLIENT_UNASSOC && 6949 statype != CFG80211_STA_TDLS_PEER_SETUP) 6950 params->link_sta_params.opmode_notif_used = false; 6951 6952 return 0; 6953 } 6954 EXPORT_SYMBOL(cfg80211_check_station_change); 6955 6956 /* 6957 * Get vlan interface making sure it is running and on the right wiphy. 6958 */ 6959 static struct net_device *get_vlan(struct genl_info *info, 6960 struct cfg80211_registered_device *rdev) 6961 { 6962 struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN]; 6963 struct net_device *v; 6964 int ret; 6965 6966 if (!vlanattr) 6967 return NULL; 6968 6969 v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr)); 6970 if (!v) 6971 return ERR_PTR(-ENODEV); 6972 6973 if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) { 6974 ret = -EINVAL; 6975 goto error; 6976 } 6977 6978 if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN && 6979 v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 6980 v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) { 6981 ret = -EINVAL; 6982 goto error; 6983 } 6984 6985 if (!netif_running(v)) { 6986 ret = -ENETDOWN; 6987 goto error; 6988 } 6989 6990 return v; 6991 error: 6992 dev_put(v); 6993 return ERR_PTR(ret); 6994 } 6995 6996 static int nl80211_parse_sta_wme(struct genl_info *info, 6997 struct station_parameters *params) 6998 { 6999 struct nlattr *tb[NL80211_STA_WME_MAX + 1]; 7000 struct nlattr *nla; 7001 int err; 7002 7003 /* parse WME attributes if present */ 7004 if (!info->attrs[NL80211_ATTR_STA_WME]) 7005 return 0; 7006 7007 nla = info->attrs[NL80211_ATTR_STA_WME]; 7008 err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla, 7009 nl80211_sta_wme_policy, 7010 info->extack); 7011 if (err) 7012 return err; 7013 7014 if (tb[NL80211_STA_WME_UAPSD_QUEUES]) 7015 params->uapsd_queues = nla_get_u8( 7016 tb[NL80211_STA_WME_UAPSD_QUEUES]); 7017 if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK) 7018 return -EINVAL; 7019 7020 if (tb[NL80211_STA_WME_MAX_SP]) 7021 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]); 7022 7023 if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK) 7024 return -EINVAL; 7025 7026 params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD; 7027 7028 return 0; 7029 } 7030 7031 static int nl80211_parse_sta_channel_info(struct genl_info *info, 7032 struct station_parameters *params) 7033 { 7034 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) { 7035 params->supported_channels = 7036 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7037 params->supported_channels_len = 7038 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]); 7039 /* 7040 * Need to include at least one (first channel, number of 7041 * channels) tuple for each subband (checked in policy), 7042 * and must have proper tuples for the rest of the data as well. 7043 */ 7044 if (params->supported_channels_len % 2) 7045 return -EINVAL; 7046 } 7047 7048 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) { 7049 params->supported_oper_classes = 7050 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7051 params->supported_oper_classes_len = 7052 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]); 7053 } 7054 return 0; 7055 } 7056 7057 static int nl80211_set_station_tdls(struct genl_info *info, 7058 struct station_parameters *params) 7059 { 7060 int err; 7061 /* Dummy STA entry gets updated once the peer capabilities are known */ 7062 if (info->attrs[NL80211_ATTR_PEER_AID]) 7063 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7064 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7065 params->link_sta_params.ht_capa = 7066 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7067 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7068 params->link_sta_params.vht_capa = 7069 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7070 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7071 params->link_sta_params.he_capa = 7072 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7073 params->link_sta_params.he_capa_len = 7074 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7075 7076 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7077 params->link_sta_params.eht_capa = 7078 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7079 params->link_sta_params.eht_capa_len = 7080 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7081 7082 if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa, 7083 (const u8 *)params->link_sta_params.eht_capa, 7084 params->link_sta_params.eht_capa_len, 7085 false)) 7086 return -EINVAL; 7087 } 7088 } 7089 7090 err = nl80211_parse_sta_channel_info(info, params); 7091 if (err) 7092 return err; 7093 7094 return nl80211_parse_sta_wme(info, params); 7095 } 7096 7097 static int nl80211_parse_sta_txpower_setting(struct genl_info *info, 7098 struct sta_txpwr *txpwr, 7099 bool *txpwr_set) 7100 { 7101 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7102 int idx; 7103 7104 if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) { 7105 if (!rdev->ops->set_tx_power || 7106 !wiphy_ext_feature_isset(&rdev->wiphy, 7107 NL80211_EXT_FEATURE_STA_TX_PWR)) 7108 return -EOPNOTSUPP; 7109 7110 idx = NL80211_ATTR_STA_TX_POWER_SETTING; 7111 txpwr->type = nla_get_u8(info->attrs[idx]); 7112 7113 if (txpwr->type == NL80211_TX_POWER_LIMITED) { 7114 idx = NL80211_ATTR_STA_TX_POWER; 7115 7116 if (info->attrs[idx]) 7117 txpwr->power = nla_get_s16(info->attrs[idx]); 7118 else 7119 return -EINVAL; 7120 } 7121 7122 *txpwr_set = true; 7123 } else { 7124 *txpwr_set = false; 7125 } 7126 7127 return 0; 7128 } 7129 7130 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info) 7131 { 7132 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7133 struct net_device *dev = info->user_ptr[1]; 7134 struct station_parameters params; 7135 u8 *mac_addr; 7136 int err; 7137 7138 memset(¶ms, 0, sizeof(params)); 7139 7140 if (!rdev->ops->change_station) 7141 return -EOPNOTSUPP; 7142 7143 /* 7144 * AID and listen_interval properties can be set only for unassociated 7145 * station. Include these parameters here and will check them in 7146 * cfg80211_check_station_change(). 7147 */ 7148 if (info->attrs[NL80211_ATTR_STA_AID]) 7149 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7150 7151 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7152 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7153 7154 if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7155 params.listen_interval = 7156 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7157 else 7158 params.listen_interval = -1; 7159 7160 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) 7161 params.support_p2p_ps = 7162 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7163 else 7164 params.support_p2p_ps = -1; 7165 7166 if (!info->attrs[NL80211_ATTR_MAC]) 7167 return -EINVAL; 7168 7169 params.link_sta_params.link_id = 7170 nl80211_link_id_or_invalid(info->attrs); 7171 7172 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7173 /* If MLD_ADDR attribute is set then this is an MLD station 7174 * and the MLD_ADDR attribute holds the MLD address and the 7175 * MAC attribute holds for the LINK address. 7176 * In that case, the link_id is also expected to be valid. 7177 */ 7178 if (params.link_sta_params.link_id < 0) 7179 return -EINVAL; 7180 7181 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7182 params.link_sta_params.mld_mac = mac_addr; 7183 params.link_sta_params.link_mac = 7184 nla_data(info->attrs[NL80211_ATTR_MAC]); 7185 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7186 return -EINVAL; 7187 } else { 7188 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7189 } 7190 7191 7192 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 7193 params.link_sta_params.supported_rates = 7194 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7195 params.link_sta_params.supported_rates_len = 7196 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7197 } 7198 7199 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7200 params.capability = 7201 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7202 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7203 } 7204 7205 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7206 params.ext_capab = 7207 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7208 params.ext_capab_len = 7209 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7210 } 7211 7212 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7213 return -EINVAL; 7214 7215 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7216 params.plink_action = 7217 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7218 7219 if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) { 7220 params.plink_state = 7221 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]); 7222 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) 7223 params.peer_aid = nla_get_u16( 7224 info->attrs[NL80211_ATTR_MESH_PEER_AID]); 7225 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE; 7226 } 7227 7228 if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) 7229 params.local_pm = nla_get_u32( 7230 info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]); 7231 7232 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7233 params.link_sta_params.opmode_notif_used = true; 7234 params.link_sta_params.opmode_notif = 7235 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7236 } 7237 7238 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7239 params.link_sta_params.he_6ghz_capa = 7240 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7241 7242 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7243 params.airtime_weight = 7244 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7245 7246 if (params.airtime_weight && 7247 !wiphy_ext_feature_isset(&rdev->wiphy, 7248 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7249 return -EOPNOTSUPP; 7250 7251 err = nl80211_parse_sta_txpower_setting(info, 7252 ¶ms.link_sta_params.txpwr, 7253 ¶ms.link_sta_params.txpwr_set); 7254 if (err) 7255 return err; 7256 7257 /* Include parameters for TDLS peer (will check later) */ 7258 err = nl80211_set_station_tdls(info, ¶ms); 7259 if (err) 7260 return err; 7261 7262 params.vlan = get_vlan(info, rdev); 7263 if (IS_ERR(params.vlan)) 7264 return PTR_ERR(params.vlan); 7265 7266 switch (dev->ieee80211_ptr->iftype) { 7267 case NL80211_IFTYPE_AP: 7268 case NL80211_IFTYPE_AP_VLAN: 7269 case NL80211_IFTYPE_P2P_GO: 7270 case NL80211_IFTYPE_P2P_CLIENT: 7271 case NL80211_IFTYPE_STATION: 7272 case NL80211_IFTYPE_ADHOC: 7273 case NL80211_IFTYPE_MESH_POINT: 7274 break; 7275 default: 7276 err = -EOPNOTSUPP; 7277 goto out_put_vlan; 7278 } 7279 7280 /* driver will call cfg80211_check_station_change() */ 7281 wdev_lock(dev->ieee80211_ptr); 7282 err = rdev_change_station(rdev, dev, mac_addr, ¶ms); 7283 wdev_unlock(dev->ieee80211_ptr); 7284 7285 out_put_vlan: 7286 dev_put(params.vlan); 7287 7288 return err; 7289 } 7290 7291 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info) 7292 { 7293 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7294 int err; 7295 struct net_device *dev = info->user_ptr[1]; 7296 struct wireless_dev *wdev = dev->ieee80211_ptr; 7297 struct station_parameters params; 7298 u8 *mac_addr = NULL; 7299 u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) | 7300 BIT(NL80211_STA_FLAG_ASSOCIATED); 7301 7302 memset(¶ms, 0, sizeof(params)); 7303 7304 if (!rdev->ops->add_station) 7305 return -EOPNOTSUPP; 7306 7307 if (!info->attrs[NL80211_ATTR_MAC]) 7308 return -EINVAL; 7309 7310 if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]) 7311 return -EINVAL; 7312 7313 if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 7314 return -EINVAL; 7315 7316 if (!info->attrs[NL80211_ATTR_STA_AID] && 7317 !info->attrs[NL80211_ATTR_PEER_AID]) 7318 return -EINVAL; 7319 7320 params.link_sta_params.link_id = 7321 nl80211_link_id_or_invalid(info->attrs); 7322 7323 if (info->attrs[NL80211_ATTR_MLD_ADDR]) { 7324 mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 7325 params.link_sta_params.mld_mac = mac_addr; 7326 params.link_sta_params.link_mac = 7327 nla_data(info->attrs[NL80211_ATTR_MAC]); 7328 if (!is_valid_ether_addr(params.link_sta_params.link_mac)) 7329 return -EINVAL; 7330 } else { 7331 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 7332 } 7333 7334 params.link_sta_params.supported_rates = 7335 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7336 params.link_sta_params.supported_rates_len = 7337 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 7338 params.listen_interval = 7339 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]); 7340 7341 if (info->attrs[NL80211_ATTR_VLAN_ID]) 7342 params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]); 7343 7344 if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) { 7345 params.support_p2p_ps = 7346 nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]); 7347 } else { 7348 /* 7349 * if not specified, assume it's supported for P2P GO interface, 7350 * and is NOT supported for AP interface 7351 */ 7352 params.support_p2p_ps = 7353 dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO; 7354 } 7355 7356 if (info->attrs[NL80211_ATTR_PEER_AID]) 7357 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]); 7358 else 7359 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]); 7360 7361 if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) { 7362 params.capability = 7363 nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]); 7364 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY; 7365 } 7366 7367 if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) { 7368 params.ext_capab = 7369 nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7370 params.ext_capab_len = 7371 nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]); 7372 } 7373 7374 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 7375 params.link_sta_params.ht_capa = 7376 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 7377 7378 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 7379 params.link_sta_params.vht_capa = 7380 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 7381 7382 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 7383 params.link_sta_params.he_capa = 7384 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7385 params.link_sta_params.he_capa_len = 7386 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 7387 7388 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 7389 params.link_sta_params.eht_capa = 7390 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7391 params.link_sta_params.eht_capa_len = 7392 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 7393 7394 if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa, 7395 (const u8 *)params.link_sta_params.eht_capa, 7396 params.link_sta_params.eht_capa_len, 7397 false)) 7398 return -EINVAL; 7399 } 7400 } 7401 7402 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 7403 params.link_sta_params.he_6ghz_capa = 7404 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 7405 7406 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 7407 params.link_sta_params.opmode_notif_used = true; 7408 params.link_sta_params.opmode_notif = 7409 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 7410 } 7411 7412 if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) 7413 params.plink_action = 7414 nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]); 7415 7416 if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]) 7417 params.airtime_weight = 7418 nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]); 7419 7420 if (params.airtime_weight && 7421 !wiphy_ext_feature_isset(&rdev->wiphy, 7422 NL80211_EXT_FEATURE_AIRTIME_FAIRNESS)) 7423 return -EOPNOTSUPP; 7424 7425 err = nl80211_parse_sta_txpower_setting(info, 7426 ¶ms.link_sta_params.txpwr, 7427 ¶ms.link_sta_params.txpwr_set); 7428 if (err) 7429 return err; 7430 7431 err = nl80211_parse_sta_channel_info(info, ¶ms); 7432 if (err) 7433 return err; 7434 7435 err = nl80211_parse_sta_wme(info, ¶ms); 7436 if (err) 7437 return err; 7438 7439 if (parse_station_flags(info, dev->ieee80211_ptr->iftype, ¶ms)) 7440 return -EINVAL; 7441 7442 /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT 7443 * as userspace might just pass through the capabilities from the IEs 7444 * directly, rather than enforcing this restriction and returning an 7445 * error in this case. 7446 */ 7447 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) { 7448 params.link_sta_params.ht_capa = NULL; 7449 params.link_sta_params.vht_capa = NULL; 7450 7451 /* HE and EHT require WME */ 7452 if (params.link_sta_params.he_capa_len || 7453 params.link_sta_params.he_6ghz_capa || 7454 params.link_sta_params.eht_capa_len) 7455 return -EINVAL; 7456 } 7457 7458 /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */ 7459 if (params.link_sta_params.he_6ghz_capa && 7460 (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa)) 7461 return -EINVAL; 7462 7463 /* When you run into this, adjust the code below for the new flag */ 7464 BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7); 7465 7466 switch (dev->ieee80211_ptr->iftype) { 7467 case NL80211_IFTYPE_AP: 7468 case NL80211_IFTYPE_AP_VLAN: 7469 case NL80211_IFTYPE_P2P_GO: 7470 /* ignore WME attributes if iface/sta is not capable */ 7471 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) || 7472 !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) 7473 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7474 7475 /* TDLS peers cannot be added */ 7476 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7477 info->attrs[NL80211_ATTR_PEER_AID]) 7478 return -EINVAL; 7479 /* but don't bother the driver with it */ 7480 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER); 7481 7482 /* allow authenticated/associated only if driver handles it */ 7483 if (!(rdev->wiphy.features & 7484 NL80211_FEATURE_FULL_AP_CLIENT_STATE) && 7485 params.sta_flags_mask & auth_assoc) 7486 return -EINVAL; 7487 7488 /* Older userspace, or userspace wanting to be compatible with 7489 * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth 7490 * and assoc flags in the mask, but assumes the station will be 7491 * added as associated anyway since this was the required driver 7492 * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was 7493 * introduced. 7494 * In order to not bother drivers with this quirk in the API 7495 * set the flags in both the mask and set for new stations in 7496 * this case. 7497 */ 7498 if (!(params.sta_flags_mask & auth_assoc)) { 7499 params.sta_flags_mask |= auth_assoc; 7500 params.sta_flags_set |= auth_assoc; 7501 } 7502 7503 /* must be last in here for error handling */ 7504 params.vlan = get_vlan(info, rdev); 7505 if (IS_ERR(params.vlan)) 7506 return PTR_ERR(params.vlan); 7507 break; 7508 case NL80211_IFTYPE_MESH_POINT: 7509 /* ignore uAPSD data */ 7510 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7511 7512 /* associated is disallowed */ 7513 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) 7514 return -EINVAL; 7515 /* TDLS peers cannot be added */ 7516 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) || 7517 info->attrs[NL80211_ATTR_PEER_AID]) 7518 return -EINVAL; 7519 break; 7520 case NL80211_IFTYPE_STATION: 7521 case NL80211_IFTYPE_P2P_CLIENT: 7522 /* ignore uAPSD data */ 7523 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD; 7524 7525 /* these are disallowed */ 7526 if (params.sta_flags_mask & 7527 (BIT(NL80211_STA_FLAG_ASSOCIATED) | 7528 BIT(NL80211_STA_FLAG_AUTHENTICATED))) 7529 return -EINVAL; 7530 /* Only TDLS peers can be added */ 7531 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))) 7532 return -EINVAL; 7533 /* Can only add if TDLS ... */ 7534 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS)) 7535 return -EOPNOTSUPP; 7536 /* ... with external setup is supported */ 7537 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP)) 7538 return -EOPNOTSUPP; 7539 /* 7540 * Older wpa_supplicant versions always mark the TDLS peer 7541 * as authorized, but it shouldn't yet be. 7542 */ 7543 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED); 7544 break; 7545 default: 7546 return -EOPNOTSUPP; 7547 } 7548 7549 /* be aware of params.vlan when changing code here */ 7550 7551 wdev_lock(dev->ieee80211_ptr); 7552 if (wdev->valid_links) { 7553 if (params.link_sta_params.link_id < 0) { 7554 err = -EINVAL; 7555 goto out; 7556 } 7557 if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) { 7558 err = -ENOLINK; 7559 goto out; 7560 } 7561 } else { 7562 if (params.link_sta_params.link_id >= 0) { 7563 err = -EINVAL; 7564 goto out; 7565 } 7566 } 7567 err = rdev_add_station(rdev, dev, mac_addr, ¶ms); 7568 out: 7569 wdev_unlock(dev->ieee80211_ptr); 7570 dev_put(params.vlan); 7571 return err; 7572 } 7573 7574 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info) 7575 { 7576 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7577 struct net_device *dev = info->user_ptr[1]; 7578 struct station_del_parameters params; 7579 int ret; 7580 7581 memset(¶ms, 0, sizeof(params)); 7582 7583 if (info->attrs[NL80211_ATTR_MAC]) 7584 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 7585 7586 switch (dev->ieee80211_ptr->iftype) { 7587 case NL80211_IFTYPE_AP: 7588 case NL80211_IFTYPE_AP_VLAN: 7589 case NL80211_IFTYPE_MESH_POINT: 7590 case NL80211_IFTYPE_P2P_GO: 7591 /* always accept these */ 7592 break; 7593 case NL80211_IFTYPE_ADHOC: 7594 /* conditionally accept */ 7595 if (wiphy_ext_feature_isset(&rdev->wiphy, 7596 NL80211_EXT_FEATURE_DEL_IBSS_STA)) 7597 break; 7598 return -EINVAL; 7599 default: 7600 return -EINVAL; 7601 } 7602 7603 if (!rdev->ops->del_station) 7604 return -EOPNOTSUPP; 7605 7606 if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) { 7607 params.subtype = 7608 nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]); 7609 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 && 7610 params.subtype != IEEE80211_STYPE_DEAUTH >> 4) 7611 return -EINVAL; 7612 } else { 7613 /* Default to Deauthentication frame */ 7614 params.subtype = IEEE80211_STYPE_DEAUTH >> 4; 7615 } 7616 7617 if (info->attrs[NL80211_ATTR_REASON_CODE]) { 7618 params.reason_code = 7619 nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 7620 if (params.reason_code == 0) 7621 return -EINVAL; /* 0 is reserved */ 7622 } else { 7623 /* Default to reason code 2 */ 7624 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID; 7625 } 7626 7627 wdev_lock(dev->ieee80211_ptr); 7628 ret = rdev_del_station(rdev, dev, ¶ms); 7629 wdev_unlock(dev->ieee80211_ptr); 7630 7631 return ret; 7632 } 7633 7634 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq, 7635 int flags, struct net_device *dev, 7636 u8 *dst, u8 *next_hop, 7637 struct mpath_info *pinfo) 7638 { 7639 void *hdr; 7640 struct nlattr *pinfoattr; 7641 7642 hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH); 7643 if (!hdr) 7644 return -1; 7645 7646 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 7647 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) || 7648 nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) || 7649 nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation)) 7650 goto nla_put_failure; 7651 7652 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO); 7653 if (!pinfoattr) 7654 goto nla_put_failure; 7655 if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) && 7656 nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN, 7657 pinfo->frame_qlen)) 7658 goto nla_put_failure; 7659 if (((pinfo->filled & MPATH_INFO_SN) && 7660 nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) || 7661 ((pinfo->filled & MPATH_INFO_METRIC) && 7662 nla_put_u32(msg, NL80211_MPATH_INFO_METRIC, 7663 pinfo->metric)) || 7664 ((pinfo->filled & MPATH_INFO_EXPTIME) && 7665 nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME, 7666 pinfo->exptime)) || 7667 ((pinfo->filled & MPATH_INFO_FLAGS) && 7668 nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS, 7669 pinfo->flags)) || 7670 ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) && 7671 nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT, 7672 pinfo->discovery_timeout)) || 7673 ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) && 7674 nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES, 7675 pinfo->discovery_retries)) || 7676 ((pinfo->filled & MPATH_INFO_HOP_COUNT) && 7677 nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT, 7678 pinfo->hop_count)) || 7679 ((pinfo->filled & MPATH_INFO_PATH_CHANGE) && 7680 nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE, 7681 pinfo->path_change_count))) 7682 goto nla_put_failure; 7683 7684 nla_nest_end(msg, pinfoattr); 7685 7686 genlmsg_end(msg, hdr); 7687 return 0; 7688 7689 nla_put_failure: 7690 genlmsg_cancel(msg, hdr); 7691 return -EMSGSIZE; 7692 } 7693 7694 static int nl80211_dump_mpath(struct sk_buff *skb, 7695 struct netlink_callback *cb) 7696 { 7697 struct mpath_info pinfo; 7698 struct cfg80211_registered_device *rdev; 7699 struct wireless_dev *wdev; 7700 u8 dst[ETH_ALEN]; 7701 u8 next_hop[ETH_ALEN]; 7702 int path_idx = cb->args[2]; 7703 int err; 7704 7705 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7706 if (err) 7707 return err; 7708 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7709 __acquire(&rdev->wiphy.mtx); 7710 7711 if (!rdev->ops->dump_mpath) { 7712 err = -EOPNOTSUPP; 7713 goto out_err; 7714 } 7715 7716 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 7717 err = -EOPNOTSUPP; 7718 goto out_err; 7719 } 7720 7721 while (1) { 7722 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst, 7723 next_hop, &pinfo); 7724 if (err == -ENOENT) 7725 break; 7726 if (err) 7727 goto out_err; 7728 7729 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 7730 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7731 wdev->netdev, dst, next_hop, 7732 &pinfo) < 0) 7733 goto out; 7734 7735 path_idx++; 7736 } 7737 7738 out: 7739 cb->args[2] = path_idx; 7740 err = skb->len; 7741 out_err: 7742 wiphy_unlock(&rdev->wiphy); 7743 return err; 7744 } 7745 7746 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info) 7747 { 7748 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7749 int err; 7750 struct net_device *dev = info->user_ptr[1]; 7751 struct mpath_info pinfo; 7752 struct sk_buff *msg; 7753 u8 *dst = NULL; 7754 u8 next_hop[ETH_ALEN]; 7755 7756 memset(&pinfo, 0, sizeof(pinfo)); 7757 7758 if (!info->attrs[NL80211_ATTR_MAC]) 7759 return -EINVAL; 7760 7761 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7762 7763 if (!rdev->ops->get_mpath) 7764 return -EOPNOTSUPP; 7765 7766 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7767 return -EOPNOTSUPP; 7768 7769 err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo); 7770 if (err) 7771 return err; 7772 7773 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7774 if (!msg) 7775 return -ENOMEM; 7776 7777 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 7778 dev, dst, next_hop, &pinfo) < 0) { 7779 nlmsg_free(msg); 7780 return -ENOBUFS; 7781 } 7782 7783 return genlmsg_reply(msg, info); 7784 } 7785 7786 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info) 7787 { 7788 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7789 struct net_device *dev = info->user_ptr[1]; 7790 u8 *dst = NULL; 7791 u8 *next_hop = NULL; 7792 7793 if (!info->attrs[NL80211_ATTR_MAC]) 7794 return -EINVAL; 7795 7796 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 7797 return -EINVAL; 7798 7799 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7800 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 7801 7802 if (!rdev->ops->change_mpath) 7803 return -EOPNOTSUPP; 7804 7805 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7806 return -EOPNOTSUPP; 7807 7808 return rdev_change_mpath(rdev, dev, dst, next_hop); 7809 } 7810 7811 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info) 7812 { 7813 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7814 struct net_device *dev = info->user_ptr[1]; 7815 u8 *dst = NULL; 7816 u8 *next_hop = NULL; 7817 7818 if (!info->attrs[NL80211_ATTR_MAC]) 7819 return -EINVAL; 7820 7821 if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]) 7822 return -EINVAL; 7823 7824 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7825 next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]); 7826 7827 if (!rdev->ops->add_mpath) 7828 return -EOPNOTSUPP; 7829 7830 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7831 return -EOPNOTSUPP; 7832 7833 return rdev_add_mpath(rdev, dev, dst, next_hop); 7834 } 7835 7836 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info) 7837 { 7838 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7839 struct net_device *dev = info->user_ptr[1]; 7840 u8 *dst = NULL; 7841 7842 if (info->attrs[NL80211_ATTR_MAC]) 7843 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7844 7845 if (!rdev->ops->del_mpath) 7846 return -EOPNOTSUPP; 7847 7848 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7849 return -EOPNOTSUPP; 7850 7851 return rdev_del_mpath(rdev, dev, dst); 7852 } 7853 7854 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info) 7855 { 7856 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7857 int err; 7858 struct net_device *dev = info->user_ptr[1]; 7859 struct mpath_info pinfo; 7860 struct sk_buff *msg; 7861 u8 *dst = NULL; 7862 u8 mpp[ETH_ALEN]; 7863 7864 memset(&pinfo, 0, sizeof(pinfo)); 7865 7866 if (!info->attrs[NL80211_ATTR_MAC]) 7867 return -EINVAL; 7868 7869 dst = nla_data(info->attrs[NL80211_ATTR_MAC]); 7870 7871 if (!rdev->ops->get_mpp) 7872 return -EOPNOTSUPP; 7873 7874 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) 7875 return -EOPNOTSUPP; 7876 7877 err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo); 7878 if (err) 7879 return err; 7880 7881 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 7882 if (!msg) 7883 return -ENOMEM; 7884 7885 if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0, 7886 dev, dst, mpp, &pinfo) < 0) { 7887 nlmsg_free(msg); 7888 return -ENOBUFS; 7889 } 7890 7891 return genlmsg_reply(msg, info); 7892 } 7893 7894 static int nl80211_dump_mpp(struct sk_buff *skb, 7895 struct netlink_callback *cb) 7896 { 7897 struct mpath_info pinfo; 7898 struct cfg80211_registered_device *rdev; 7899 struct wireless_dev *wdev; 7900 u8 dst[ETH_ALEN]; 7901 u8 mpp[ETH_ALEN]; 7902 int path_idx = cb->args[2]; 7903 int err; 7904 7905 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 7906 if (err) 7907 return err; 7908 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 7909 __acquire(&rdev->wiphy.mtx); 7910 7911 if (!rdev->ops->dump_mpp) { 7912 err = -EOPNOTSUPP; 7913 goto out_err; 7914 } 7915 7916 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) { 7917 err = -EOPNOTSUPP; 7918 goto out_err; 7919 } 7920 7921 while (1) { 7922 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst, 7923 mpp, &pinfo); 7924 if (err == -ENOENT) 7925 break; 7926 if (err) 7927 goto out_err; 7928 7929 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid, 7930 cb->nlh->nlmsg_seq, NLM_F_MULTI, 7931 wdev->netdev, dst, mpp, 7932 &pinfo) < 0) 7933 goto out; 7934 7935 path_idx++; 7936 } 7937 7938 out: 7939 cb->args[2] = path_idx; 7940 err = skb->len; 7941 out_err: 7942 wiphy_unlock(&rdev->wiphy); 7943 return err; 7944 } 7945 7946 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info) 7947 { 7948 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 7949 struct net_device *dev = info->user_ptr[1]; 7950 struct wireless_dev *wdev = dev->ieee80211_ptr; 7951 struct bss_parameters params; 7952 int err; 7953 7954 memset(¶ms, 0, sizeof(params)); 7955 params.link_id = nl80211_link_id_or_invalid(info->attrs); 7956 /* default to not changing parameters */ 7957 params.use_cts_prot = -1; 7958 params.use_short_preamble = -1; 7959 params.use_short_slot_time = -1; 7960 params.ap_isolate = -1; 7961 params.ht_opmode = -1; 7962 params.p2p_ctwindow = -1; 7963 params.p2p_opp_ps = -1; 7964 7965 if (info->attrs[NL80211_ATTR_BSS_CTS_PROT]) 7966 params.use_cts_prot = 7967 nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]); 7968 if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]) 7969 params.use_short_preamble = 7970 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]); 7971 if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]) 7972 params.use_short_slot_time = 7973 nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]); 7974 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 7975 params.basic_rates = 7976 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 7977 params.basic_rates_len = 7978 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 7979 } 7980 if (info->attrs[NL80211_ATTR_AP_ISOLATE]) 7981 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]); 7982 if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE]) 7983 params.ht_opmode = 7984 nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]); 7985 7986 if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) { 7987 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 7988 return -EINVAL; 7989 params.p2p_ctwindow = 7990 nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]); 7991 if (params.p2p_ctwindow != 0 && 7992 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) 7993 return -EINVAL; 7994 } 7995 7996 if (info->attrs[NL80211_ATTR_P2P_OPPPS]) { 7997 u8 tmp; 7998 7999 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8000 return -EINVAL; 8001 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]); 8002 params.p2p_opp_ps = tmp; 8003 if (params.p2p_opp_ps && 8004 !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) 8005 return -EINVAL; 8006 } 8007 8008 if (!rdev->ops->change_bss) 8009 return -EOPNOTSUPP; 8010 8011 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 8012 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 8013 return -EOPNOTSUPP; 8014 8015 wdev_lock(wdev); 8016 err = rdev_change_bss(rdev, dev, ¶ms); 8017 wdev_unlock(wdev); 8018 8019 return err; 8020 } 8021 8022 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info) 8023 { 8024 char *data = NULL; 8025 bool is_indoor; 8026 enum nl80211_user_reg_hint_type user_reg_hint_type; 8027 u32 owner_nlportid; 8028 8029 /* 8030 * You should only get this when cfg80211 hasn't yet initialized 8031 * completely when built-in to the kernel right between the time 8032 * window between nl80211_init() and regulatory_init(), if that is 8033 * even possible. 8034 */ 8035 if (unlikely(!rcu_access_pointer(cfg80211_regdomain))) 8036 return -EINPROGRESS; 8037 8038 if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]) 8039 user_reg_hint_type = 8040 nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]); 8041 else 8042 user_reg_hint_type = NL80211_USER_REG_HINT_USER; 8043 8044 switch (user_reg_hint_type) { 8045 case NL80211_USER_REG_HINT_USER: 8046 case NL80211_USER_REG_HINT_CELL_BASE: 8047 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8048 return -EINVAL; 8049 8050 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8051 return regulatory_hint_user(data, user_reg_hint_type); 8052 case NL80211_USER_REG_HINT_INDOOR: 8053 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 8054 owner_nlportid = info->snd_portid; 8055 is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR]; 8056 } else { 8057 owner_nlportid = 0; 8058 is_indoor = true; 8059 } 8060 8061 return regulatory_hint_indoor(is_indoor, owner_nlportid); 8062 default: 8063 return -EINVAL; 8064 } 8065 } 8066 8067 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info) 8068 { 8069 return reg_reload_regdb(); 8070 } 8071 8072 static int nl80211_get_mesh_config(struct sk_buff *skb, 8073 struct genl_info *info) 8074 { 8075 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8076 struct net_device *dev = info->user_ptr[1]; 8077 struct wireless_dev *wdev = dev->ieee80211_ptr; 8078 struct mesh_config cur_params; 8079 int err = 0; 8080 void *hdr; 8081 struct nlattr *pinfoattr; 8082 struct sk_buff *msg; 8083 8084 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8085 return -EOPNOTSUPP; 8086 8087 if (!rdev->ops->get_mesh_config) 8088 return -EOPNOTSUPP; 8089 8090 wdev_lock(wdev); 8091 /* If not connected, get default parameters */ 8092 if (!wdev->u.mesh.id_len) 8093 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params)); 8094 else 8095 err = rdev_get_mesh_config(rdev, dev, &cur_params); 8096 wdev_unlock(wdev); 8097 8098 if (err) 8099 return err; 8100 8101 /* Draw up a netlink message to send back */ 8102 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8103 if (!msg) 8104 return -ENOMEM; 8105 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8106 NL80211_CMD_GET_MESH_CONFIG); 8107 if (!hdr) 8108 goto out; 8109 pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG); 8110 if (!pinfoattr) 8111 goto nla_put_failure; 8112 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 8113 nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT, 8114 cur_params.dot11MeshRetryTimeout) || 8115 nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT, 8116 cur_params.dot11MeshConfirmTimeout) || 8117 nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT, 8118 cur_params.dot11MeshHoldingTimeout) || 8119 nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS, 8120 cur_params.dot11MeshMaxPeerLinks) || 8121 nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES, 8122 cur_params.dot11MeshMaxRetries) || 8123 nla_put_u8(msg, NL80211_MESHCONF_TTL, 8124 cur_params.dot11MeshTTL) || 8125 nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL, 8126 cur_params.element_ttl) || 8127 nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8128 cur_params.auto_open_plinks) || 8129 nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8130 cur_params.dot11MeshNbrOffsetMaxNeighbor) || 8131 nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8132 cur_params.dot11MeshHWMPmaxPREQretries) || 8133 nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME, 8134 cur_params.path_refresh_time) || 8135 nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8136 cur_params.min_discovery_timeout) || 8137 nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8138 cur_params.dot11MeshHWMPactivePathTimeout) || 8139 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8140 cur_params.dot11MeshHWMPpreqMinInterval) || 8141 nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8142 cur_params.dot11MeshHWMPperrMinInterval) || 8143 nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8144 cur_params.dot11MeshHWMPnetDiameterTraversalTime) || 8145 nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE, 8146 cur_params.dot11MeshHWMPRootMode) || 8147 nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8148 cur_params.dot11MeshHWMPRannInterval) || 8149 nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8150 cur_params.dot11MeshGateAnnouncementProtocol) || 8151 nla_put_u8(msg, NL80211_MESHCONF_FORWARDING, 8152 cur_params.dot11MeshForwarding) || 8153 nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD, 8154 cur_params.rssi_threshold) || 8155 nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE, 8156 cur_params.ht_opmode) || 8157 nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8158 cur_params.dot11MeshHWMPactivePathToRootTimeout) || 8159 nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8160 cur_params.dot11MeshHWMProotInterval) || 8161 nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8162 cur_params.dot11MeshHWMPconfirmationInterval) || 8163 nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE, 8164 cur_params.power_mode) || 8165 nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW, 8166 cur_params.dot11MeshAwakeWindowDuration) || 8167 nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT, 8168 cur_params.plink_timeout) || 8169 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE, 8170 cur_params.dot11MeshConnectedToMeshGate) || 8171 nla_put_u8(msg, NL80211_MESHCONF_NOLEARN, 8172 cur_params.dot11MeshNolearn) || 8173 nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS, 8174 cur_params.dot11MeshConnectedToAuthServer)) 8175 goto nla_put_failure; 8176 nla_nest_end(msg, pinfoattr); 8177 genlmsg_end(msg, hdr); 8178 return genlmsg_reply(msg, info); 8179 8180 nla_put_failure: 8181 out: 8182 nlmsg_free(msg); 8183 return -ENOBUFS; 8184 } 8185 8186 static const struct nla_policy 8187 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = { 8188 [NL80211_MESHCONF_RETRY_TIMEOUT] = 8189 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8190 [NL80211_MESHCONF_CONFIRM_TIMEOUT] = 8191 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8192 [NL80211_MESHCONF_HOLDING_TIMEOUT] = 8193 NLA_POLICY_RANGE(NLA_U16, 1, 255), 8194 [NL80211_MESHCONF_MAX_PEER_LINKS] = 8195 NLA_POLICY_RANGE(NLA_U16, 0, 255), 8196 [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16), 8197 [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8198 [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1), 8199 [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1), 8200 [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = 8201 NLA_POLICY_RANGE(NLA_U32, 1, 255), 8202 [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 }, 8203 [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 }, 8204 [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1), 8205 [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 }, 8206 [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = 8207 NLA_POLICY_MIN(NLA_U16, 1), 8208 [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = 8209 NLA_POLICY_MIN(NLA_U16, 1), 8210 [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = 8211 NLA_POLICY_MIN(NLA_U16, 1), 8212 [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4), 8213 [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = 8214 NLA_POLICY_MIN(NLA_U16, 1), 8215 [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1), 8216 [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1), 8217 [NL80211_MESHCONF_RSSI_THRESHOLD] = 8218 NLA_POLICY_RANGE(NLA_S32, -255, 0), 8219 [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 }, 8220 [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 }, 8221 [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = 8222 NLA_POLICY_MIN(NLA_U16, 1), 8223 [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = 8224 NLA_POLICY_MIN(NLA_U16, 1), 8225 [NL80211_MESHCONF_POWER_MODE] = 8226 NLA_POLICY_RANGE(NLA_U32, 8227 NL80211_MESH_POWER_ACTIVE, 8228 NL80211_MESH_POWER_MAX), 8229 [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 }, 8230 [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 }, 8231 [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8232 [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8233 [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1), 8234 }; 8235 8236 static const struct nla_policy 8237 nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = { 8238 [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 }, 8239 [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 }, 8240 [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 }, 8241 [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG }, 8242 [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 }, 8243 [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG }, 8244 [NL80211_MESH_SETUP_IE] = 8245 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr, 8246 IEEE80211_MAX_DATA_LEN), 8247 [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG }, 8248 }; 8249 8250 static int nl80211_parse_mesh_config(struct genl_info *info, 8251 struct mesh_config *cfg, 8252 u32 *mask_out) 8253 { 8254 struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1]; 8255 u32 mask = 0; 8256 u16 ht_opmode; 8257 8258 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \ 8259 do { \ 8260 if (tb[attr]) { \ 8261 cfg->param = fn(tb[attr]); \ 8262 mask |= BIT((attr) - 1); \ 8263 } \ 8264 } while (0) 8265 8266 if (!info->attrs[NL80211_ATTR_MESH_CONFIG]) 8267 return -EINVAL; 8268 if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack)) 8269 return -EINVAL; 8270 8271 /* This makes sure that there aren't more than 32 mesh config 8272 * parameters (otherwise our bitfield scheme would not work.) */ 8273 BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32); 8274 8275 /* Fill in the params struct */ 8276 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask, 8277 NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16); 8278 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask, 8279 NL80211_MESHCONF_CONFIRM_TIMEOUT, 8280 nla_get_u16); 8281 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask, 8282 NL80211_MESHCONF_HOLDING_TIMEOUT, 8283 nla_get_u16); 8284 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask, 8285 NL80211_MESHCONF_MAX_PEER_LINKS, 8286 nla_get_u16); 8287 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask, 8288 NL80211_MESHCONF_MAX_RETRIES, nla_get_u8); 8289 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask, 8290 NL80211_MESHCONF_TTL, nla_get_u8); 8291 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask, 8292 NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8); 8293 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask, 8294 NL80211_MESHCONF_AUTO_OPEN_PLINKS, 8295 nla_get_u8); 8296 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor, 8297 mask, 8298 NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, 8299 nla_get_u32); 8300 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask, 8301 NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, 8302 nla_get_u8); 8303 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask, 8304 NL80211_MESHCONF_PATH_REFRESH_TIME, 8305 nla_get_u32); 8306 if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) && 8307 (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535)) 8308 return -EINVAL; 8309 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask, 8310 NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, 8311 nla_get_u16); 8312 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout, 8313 mask, 8314 NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, 8315 nla_get_u32); 8316 if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) && 8317 (cfg->dot11MeshHWMPactivePathTimeout < 1 || 8318 cfg->dot11MeshHWMPactivePathTimeout > 65535)) 8319 return -EINVAL; 8320 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask, 8321 NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, 8322 nla_get_u16); 8323 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask, 8324 NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, 8325 nla_get_u16); 8326 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8327 dot11MeshHWMPnetDiameterTraversalTime, mask, 8328 NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, 8329 nla_get_u16); 8330 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask, 8331 NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8); 8332 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask, 8333 NL80211_MESHCONF_HWMP_RANN_INTERVAL, 8334 nla_get_u16); 8335 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol, 8336 mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS, 8337 nla_get_u8); 8338 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask, 8339 NL80211_MESHCONF_FORWARDING, nla_get_u8); 8340 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask, 8341 NL80211_MESHCONF_RSSI_THRESHOLD, 8342 nla_get_s32); 8343 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask, 8344 NL80211_MESHCONF_CONNECTED_TO_GATE, 8345 nla_get_u8); 8346 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask, 8347 NL80211_MESHCONF_CONNECTED_TO_AS, 8348 nla_get_u8); 8349 /* 8350 * Check HT operation mode based on 8351 * IEEE 802.11-2016 9.4.2.57 HT Operation element. 8352 */ 8353 if (tb[NL80211_MESHCONF_HT_OPMODE]) { 8354 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]); 8355 8356 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION | 8357 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT | 8358 IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)) 8359 return -EINVAL; 8360 8361 /* NON_HT_STA bit is reserved, but some programs set it */ 8362 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT; 8363 8364 cfg->ht_opmode = ht_opmode; 8365 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1)); 8366 } 8367 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, 8368 dot11MeshHWMPactivePathToRootTimeout, mask, 8369 NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, 8370 nla_get_u32); 8371 if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) && 8372 (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 || 8373 cfg->dot11MeshHWMPactivePathToRootTimeout > 65535)) 8374 return -EINVAL; 8375 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask, 8376 NL80211_MESHCONF_HWMP_ROOT_INTERVAL, 8377 nla_get_u16); 8378 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval, 8379 mask, 8380 NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, 8381 nla_get_u16); 8382 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask, 8383 NL80211_MESHCONF_POWER_MODE, nla_get_u32); 8384 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask, 8385 NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16); 8386 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask, 8387 NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32); 8388 FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask, 8389 NL80211_MESHCONF_NOLEARN, nla_get_u8); 8390 if (mask_out) 8391 *mask_out = mask; 8392 8393 return 0; 8394 8395 #undef FILL_IN_MESH_PARAM_IF_SET 8396 } 8397 8398 static int nl80211_parse_mesh_setup(struct genl_info *info, 8399 struct mesh_setup *setup) 8400 { 8401 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8402 struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1]; 8403 8404 if (!info->attrs[NL80211_ATTR_MESH_SETUP]) 8405 return -EINVAL; 8406 if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack)) 8407 return -EINVAL; 8408 8409 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC]) 8410 setup->sync_method = 8411 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ? 8412 IEEE80211_SYNC_METHOD_VENDOR : 8413 IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET; 8414 8415 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL]) 8416 setup->path_sel_proto = 8417 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ? 8418 IEEE80211_PATH_PROTOCOL_VENDOR : 8419 IEEE80211_PATH_PROTOCOL_HWMP; 8420 8421 if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC]) 8422 setup->path_metric = 8423 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ? 8424 IEEE80211_PATH_METRIC_VENDOR : 8425 IEEE80211_PATH_METRIC_AIRTIME; 8426 8427 if (tb[NL80211_MESH_SETUP_IE]) { 8428 struct nlattr *ieattr = 8429 tb[NL80211_MESH_SETUP_IE]; 8430 setup->ie = nla_data(ieattr); 8431 setup->ie_len = nla_len(ieattr); 8432 } 8433 if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] && 8434 !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM)) 8435 return -EINVAL; 8436 setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]); 8437 setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]); 8438 setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]); 8439 if (setup->is_secure) 8440 setup->user_mpm = true; 8441 8442 if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) { 8443 if (!setup->user_mpm) 8444 return -EINVAL; 8445 setup->auth_id = 8446 nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]); 8447 } 8448 8449 return 0; 8450 } 8451 8452 static int nl80211_update_mesh_config(struct sk_buff *skb, 8453 struct genl_info *info) 8454 { 8455 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 8456 struct net_device *dev = info->user_ptr[1]; 8457 struct wireless_dev *wdev = dev->ieee80211_ptr; 8458 struct mesh_config cfg; 8459 u32 mask; 8460 int err; 8461 8462 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 8463 return -EOPNOTSUPP; 8464 8465 if (!rdev->ops->update_mesh_config) 8466 return -EOPNOTSUPP; 8467 8468 err = nl80211_parse_mesh_config(info, &cfg, &mask); 8469 if (err) 8470 return err; 8471 8472 wdev_lock(wdev); 8473 if (!wdev->u.mesh.id_len) 8474 err = -ENOLINK; 8475 8476 if (!err) 8477 err = rdev_update_mesh_config(rdev, dev, mask, &cfg); 8478 8479 wdev_unlock(wdev); 8480 8481 return err; 8482 } 8483 8484 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom, 8485 struct sk_buff *msg) 8486 { 8487 struct nlattr *nl_reg_rules; 8488 unsigned int i; 8489 8490 if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) || 8491 (regdom->dfs_region && 8492 nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region))) 8493 goto nla_put_failure; 8494 8495 nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES); 8496 if (!nl_reg_rules) 8497 goto nla_put_failure; 8498 8499 for (i = 0; i < regdom->n_reg_rules; i++) { 8500 struct nlattr *nl_reg_rule; 8501 const struct ieee80211_reg_rule *reg_rule; 8502 const struct ieee80211_freq_range *freq_range; 8503 const struct ieee80211_power_rule *power_rule; 8504 unsigned int max_bandwidth_khz; 8505 8506 reg_rule = ®dom->reg_rules[i]; 8507 freq_range = ®_rule->freq_range; 8508 power_rule = ®_rule->power_rule; 8509 8510 nl_reg_rule = nla_nest_start_noflag(msg, i); 8511 if (!nl_reg_rule) 8512 goto nla_put_failure; 8513 8514 max_bandwidth_khz = freq_range->max_bandwidth_khz; 8515 if (!max_bandwidth_khz) 8516 max_bandwidth_khz = reg_get_max_bandwidth(regdom, 8517 reg_rule); 8518 8519 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS, 8520 reg_rule->flags) || 8521 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START, 8522 freq_range->start_freq_khz) || 8523 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END, 8524 freq_range->end_freq_khz) || 8525 nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW, 8526 max_bandwidth_khz) || 8527 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN, 8528 power_rule->max_antenna_gain) || 8529 nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP, 8530 power_rule->max_eirp) || 8531 nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME, 8532 reg_rule->dfs_cac_ms)) 8533 goto nla_put_failure; 8534 8535 nla_nest_end(msg, nl_reg_rule); 8536 } 8537 8538 nla_nest_end(msg, nl_reg_rules); 8539 return 0; 8540 8541 nla_put_failure: 8542 return -EMSGSIZE; 8543 } 8544 8545 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info) 8546 { 8547 const struct ieee80211_regdomain *regdom = NULL; 8548 struct cfg80211_registered_device *rdev; 8549 struct wiphy *wiphy = NULL; 8550 struct sk_buff *msg; 8551 int err = -EMSGSIZE; 8552 void *hdr; 8553 8554 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 8555 if (!msg) 8556 return -ENOBUFS; 8557 8558 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 8559 NL80211_CMD_GET_REG); 8560 if (!hdr) 8561 goto put_failure; 8562 8563 rtnl_lock(); 8564 8565 if (info->attrs[NL80211_ATTR_WIPHY]) { 8566 bool self_managed; 8567 8568 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 8569 if (IS_ERR(rdev)) { 8570 err = PTR_ERR(rdev); 8571 goto nla_put_failure; 8572 } 8573 8574 wiphy = &rdev->wiphy; 8575 self_managed = wiphy->regulatory_flags & 8576 REGULATORY_WIPHY_SELF_MANAGED; 8577 8578 rcu_read_lock(); 8579 8580 regdom = get_wiphy_regdom(wiphy); 8581 8582 /* a self-managed-reg device must have a private regdom */ 8583 if (WARN_ON(!regdom && self_managed)) { 8584 err = -EINVAL; 8585 goto nla_put_failure_rcu; 8586 } 8587 8588 if (regdom && 8589 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8590 goto nla_put_failure_rcu; 8591 } else { 8592 rcu_read_lock(); 8593 } 8594 8595 if (!wiphy && reg_last_request_cell_base() && 8596 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8597 NL80211_USER_REG_HINT_CELL_BASE)) 8598 goto nla_put_failure_rcu; 8599 8600 if (!regdom) 8601 regdom = rcu_dereference(cfg80211_regdomain); 8602 8603 if (nl80211_put_regdom(regdom, msg)) 8604 goto nla_put_failure_rcu; 8605 8606 rcu_read_unlock(); 8607 8608 genlmsg_end(msg, hdr); 8609 rtnl_unlock(); 8610 return genlmsg_reply(msg, info); 8611 8612 nla_put_failure_rcu: 8613 rcu_read_unlock(); 8614 nla_put_failure: 8615 rtnl_unlock(); 8616 put_failure: 8617 nlmsg_free(msg); 8618 return err; 8619 } 8620 8621 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb, 8622 u32 seq, int flags, struct wiphy *wiphy, 8623 const struct ieee80211_regdomain *regdom) 8624 { 8625 void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 8626 NL80211_CMD_GET_REG); 8627 8628 if (!hdr) 8629 return -1; 8630 8631 genl_dump_check_consistent(cb, hdr); 8632 8633 if (nl80211_put_regdom(regdom, msg)) 8634 goto nla_put_failure; 8635 8636 if (!wiphy && reg_last_request_cell_base() && 8637 nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE, 8638 NL80211_USER_REG_HINT_CELL_BASE)) 8639 goto nla_put_failure; 8640 8641 if (wiphy && 8642 nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 8643 goto nla_put_failure; 8644 8645 if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 8646 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 8647 goto nla_put_failure; 8648 8649 genlmsg_end(msg, hdr); 8650 return 0; 8651 8652 nla_put_failure: 8653 genlmsg_cancel(msg, hdr); 8654 return -EMSGSIZE; 8655 } 8656 8657 static int nl80211_get_reg_dump(struct sk_buff *skb, 8658 struct netlink_callback *cb) 8659 { 8660 const struct ieee80211_regdomain *regdom = NULL; 8661 struct cfg80211_registered_device *rdev; 8662 int err, reg_idx, start = cb->args[2]; 8663 8664 rcu_read_lock(); 8665 8666 if (cfg80211_regdomain && start == 0) { 8667 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8668 NLM_F_MULTI, NULL, 8669 rcu_dereference(cfg80211_regdomain)); 8670 if (err < 0) 8671 goto out_err; 8672 } 8673 8674 /* the global regdom is idx 0 */ 8675 reg_idx = 1; 8676 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 8677 regdom = get_wiphy_regdom(&rdev->wiphy); 8678 if (!regdom) 8679 continue; 8680 8681 if (++reg_idx <= start) 8682 continue; 8683 8684 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq, 8685 NLM_F_MULTI, &rdev->wiphy, regdom); 8686 if (err < 0) { 8687 reg_idx--; 8688 break; 8689 } 8690 } 8691 8692 cb->args[2] = reg_idx; 8693 err = skb->len; 8694 out_err: 8695 rcu_read_unlock(); 8696 return err; 8697 } 8698 8699 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 8700 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = { 8701 [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 }, 8702 [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 }, 8703 [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 }, 8704 [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 }, 8705 [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 }, 8706 [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 }, 8707 [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 }, 8708 }; 8709 8710 static int parse_reg_rule(struct nlattr *tb[], 8711 struct ieee80211_reg_rule *reg_rule) 8712 { 8713 struct ieee80211_freq_range *freq_range = ®_rule->freq_range; 8714 struct ieee80211_power_rule *power_rule = ®_rule->power_rule; 8715 8716 if (!tb[NL80211_ATTR_REG_RULE_FLAGS]) 8717 return -EINVAL; 8718 if (!tb[NL80211_ATTR_FREQ_RANGE_START]) 8719 return -EINVAL; 8720 if (!tb[NL80211_ATTR_FREQ_RANGE_END]) 8721 return -EINVAL; 8722 if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]) 8723 return -EINVAL; 8724 if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]) 8725 return -EINVAL; 8726 8727 reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]); 8728 8729 freq_range->start_freq_khz = 8730 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]); 8731 freq_range->end_freq_khz = 8732 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]); 8733 freq_range->max_bandwidth_khz = 8734 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]); 8735 8736 power_rule->max_eirp = 8737 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]); 8738 8739 if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]) 8740 power_rule->max_antenna_gain = 8741 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]); 8742 8743 if (tb[NL80211_ATTR_DFS_CAC_TIME]) 8744 reg_rule->dfs_cac_ms = 8745 nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]); 8746 8747 return 0; 8748 } 8749 8750 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info) 8751 { 8752 struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1]; 8753 struct nlattr *nl_reg_rule; 8754 char *alpha2; 8755 int rem_reg_rules, r; 8756 u32 num_rules = 0, rule_idx = 0; 8757 enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET; 8758 struct ieee80211_regdomain *rd; 8759 8760 if (!info->attrs[NL80211_ATTR_REG_ALPHA2]) 8761 return -EINVAL; 8762 8763 if (!info->attrs[NL80211_ATTR_REG_RULES]) 8764 return -EINVAL; 8765 8766 alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]); 8767 8768 if (info->attrs[NL80211_ATTR_DFS_REGION]) 8769 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]); 8770 8771 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 8772 rem_reg_rules) { 8773 num_rules++; 8774 if (num_rules > NL80211_MAX_SUPP_REG_RULES) 8775 return -EINVAL; 8776 } 8777 8778 rtnl_lock(); 8779 if (!reg_is_valid_request(alpha2)) { 8780 r = -EINVAL; 8781 goto out; 8782 } 8783 8784 rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL); 8785 if (!rd) { 8786 r = -ENOMEM; 8787 goto out; 8788 } 8789 8790 rd->n_reg_rules = num_rules; 8791 rd->alpha2[0] = alpha2[0]; 8792 rd->alpha2[1] = alpha2[1]; 8793 8794 /* 8795 * Disable DFS master mode if the DFS region was 8796 * not supported or known on this kernel. 8797 */ 8798 if (reg_supported_dfs_region(dfs_region)) 8799 rd->dfs_region = dfs_region; 8800 8801 nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES], 8802 rem_reg_rules) { 8803 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX, 8804 nl_reg_rule, reg_rule_policy, 8805 info->extack); 8806 if (r) 8807 goto bad_reg; 8808 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]); 8809 if (r) 8810 goto bad_reg; 8811 8812 rule_idx++; 8813 8814 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) { 8815 r = -EINVAL; 8816 goto bad_reg; 8817 } 8818 } 8819 8820 r = set_regdom(rd, REGD_SOURCE_CRDA); 8821 /* set_regdom takes ownership of rd */ 8822 rd = NULL; 8823 bad_reg: 8824 kfree(rd); 8825 out: 8826 rtnl_unlock(); 8827 return r; 8828 } 8829 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */ 8830 8831 static int validate_scan_freqs(struct nlattr *freqs) 8832 { 8833 struct nlattr *attr1, *attr2; 8834 int n_channels = 0, tmp1, tmp2; 8835 8836 nla_for_each_nested(attr1, freqs, tmp1) 8837 if (nla_len(attr1) != sizeof(u32)) 8838 return 0; 8839 8840 nla_for_each_nested(attr1, freqs, tmp1) { 8841 n_channels++; 8842 /* 8843 * Some hardware has a limited channel list for 8844 * scanning, and it is pretty much nonsensical 8845 * to scan for a channel twice, so disallow that 8846 * and don't require drivers to check that the 8847 * channel list they get isn't longer than what 8848 * they can scan, as long as they can scan all 8849 * the channels they registered at once. 8850 */ 8851 nla_for_each_nested(attr2, freqs, tmp2) 8852 if (attr1 != attr2 && 8853 nla_get_u32(attr1) == nla_get_u32(attr2)) 8854 return 0; 8855 } 8856 8857 return n_channels; 8858 } 8859 8860 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b) 8861 { 8862 return b < NUM_NL80211_BANDS && wiphy->bands[b]; 8863 } 8864 8865 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy, 8866 struct cfg80211_bss_selection *bss_select) 8867 { 8868 struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1]; 8869 struct nlattr *nest; 8870 int err; 8871 bool found = false; 8872 int i; 8873 8874 /* only process one nested attribute */ 8875 nest = nla_data(nla); 8876 if (!nla_ok(nest, nla_len(nest))) 8877 return -EINVAL; 8878 8879 err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX, 8880 nest, nl80211_bss_select_policy, 8881 NULL); 8882 if (err) 8883 return err; 8884 8885 /* only one attribute may be given */ 8886 for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) { 8887 if (attr[i]) { 8888 if (found) 8889 return -EINVAL; 8890 found = true; 8891 } 8892 } 8893 8894 bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID; 8895 8896 if (attr[NL80211_BSS_SELECT_ATTR_RSSI]) 8897 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI; 8898 8899 if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) { 8900 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF; 8901 bss_select->param.band_pref = 8902 nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]); 8903 if (!is_band_valid(wiphy, bss_select->param.band_pref)) 8904 return -EINVAL; 8905 } 8906 8907 if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) { 8908 struct nl80211_bss_select_rssi_adjust *adj_param; 8909 8910 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]); 8911 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST; 8912 bss_select->param.adjust.band = adj_param->band; 8913 bss_select->param.adjust.delta = adj_param->delta; 8914 if (!is_band_valid(wiphy, bss_select->param.adjust.band)) 8915 return -EINVAL; 8916 } 8917 8918 /* user-space did not provide behaviour attribute */ 8919 if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID) 8920 return -EINVAL; 8921 8922 if (!(wiphy->bss_select_support & BIT(bss_select->behaviour))) 8923 return -EINVAL; 8924 8925 return 0; 8926 } 8927 8928 int nl80211_parse_random_mac(struct nlattr **attrs, 8929 u8 *mac_addr, u8 *mac_addr_mask) 8930 { 8931 int i; 8932 8933 if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) { 8934 eth_zero_addr(mac_addr); 8935 eth_zero_addr(mac_addr_mask); 8936 mac_addr[0] = 0x2; 8937 mac_addr_mask[0] = 0x3; 8938 8939 return 0; 8940 } 8941 8942 /* need both or none */ 8943 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK]) 8944 return -EINVAL; 8945 8946 memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN); 8947 memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN); 8948 8949 /* don't allow or configure an mcast address */ 8950 if (!is_multicast_ether_addr(mac_addr_mask) || 8951 is_multicast_ether_addr(mac_addr)) 8952 return -EINVAL; 8953 8954 /* 8955 * allow users to pass a MAC address that has bits set outside 8956 * of the mask, but don't bother drivers with having to deal 8957 * with such bits 8958 */ 8959 for (i = 0; i < ETH_ALEN; i++) 8960 mac_addr[i] &= mac_addr_mask[i]; 8961 8962 return 0; 8963 } 8964 8965 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev, 8966 struct ieee80211_channel *chan) 8967 { 8968 unsigned int link_id; 8969 bool all_ok = true; 8970 8971 ASSERT_WDEV_LOCK(wdev); 8972 8973 if (!cfg80211_beaconing_iface_active(wdev)) 8974 return true; 8975 8976 /* 8977 * FIXME: check if we have a free HW resource/link for chan 8978 * 8979 * This, as well as the FIXME below, requires knowing the link 8980 * capabilities of the hardware. 8981 */ 8982 8983 /* we cannot leave radar channels */ 8984 for_each_valid_link(wdev, link_id) { 8985 struct cfg80211_chan_def *chandef; 8986 8987 chandef = wdev_chandef(wdev, link_id); 8988 if (!chandef || !chandef->chan) 8989 continue; 8990 8991 /* 8992 * FIXME: don't require all_ok, but rather check only the 8993 * correct HW resource/link onto which 'chan' falls, 8994 * as only that link leaves the channel for doing 8995 * the off-channel operation. 8996 */ 8997 8998 if (chandef->chan->flags & IEEE80211_CHAN_RADAR) 8999 all_ok = false; 9000 } 9001 9002 if (all_ok) 9003 return true; 9004 9005 return regulatory_pre_cac_allowed(wdev->wiphy); 9006 } 9007 9008 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag, 9009 enum nl80211_ext_feature_index feat) 9010 { 9011 if (!(flags & flag)) 9012 return true; 9013 if (wiphy_ext_feature_isset(wiphy, feat)) 9014 return true; 9015 return false; 9016 } 9017 9018 static int 9019 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev, 9020 void *request, struct nlattr **attrs, 9021 bool is_sched_scan) 9022 { 9023 u8 *mac_addr, *mac_addr_mask; 9024 u32 *flags; 9025 enum nl80211_feature_flags randomness_flag; 9026 9027 if (!attrs[NL80211_ATTR_SCAN_FLAGS]) 9028 return 0; 9029 9030 if (is_sched_scan) { 9031 struct cfg80211_sched_scan_request *req = request; 9032 9033 randomness_flag = wdev ? 9034 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR : 9035 NL80211_FEATURE_ND_RANDOM_MAC_ADDR; 9036 flags = &req->flags; 9037 mac_addr = req->mac_addr; 9038 mac_addr_mask = req->mac_addr_mask; 9039 } else { 9040 struct cfg80211_scan_request *req = request; 9041 9042 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR; 9043 flags = &req->flags; 9044 mac_addr = req->mac_addr; 9045 mac_addr_mask = req->mac_addr_mask; 9046 } 9047 9048 *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]); 9049 9050 if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) && 9051 !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) || 9052 !nl80211_check_scan_feat(wiphy, *flags, 9053 NL80211_SCAN_FLAG_LOW_SPAN, 9054 NL80211_EXT_FEATURE_LOW_SPAN_SCAN) || 9055 !nl80211_check_scan_feat(wiphy, *flags, 9056 NL80211_SCAN_FLAG_LOW_POWER, 9057 NL80211_EXT_FEATURE_LOW_POWER_SCAN) || 9058 !nl80211_check_scan_feat(wiphy, *flags, 9059 NL80211_SCAN_FLAG_HIGH_ACCURACY, 9060 NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) || 9061 !nl80211_check_scan_feat(wiphy, *flags, 9062 NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME, 9063 NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) || 9064 !nl80211_check_scan_feat(wiphy, *flags, 9065 NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP, 9066 NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) || 9067 !nl80211_check_scan_feat(wiphy, *flags, 9068 NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION, 9069 NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) || 9070 !nl80211_check_scan_feat(wiphy, *flags, 9071 NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE, 9072 NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) || 9073 !nl80211_check_scan_feat(wiphy, *flags, 9074 NL80211_SCAN_FLAG_RANDOM_SN, 9075 NL80211_EXT_FEATURE_SCAN_RANDOM_SN) || 9076 !nl80211_check_scan_feat(wiphy, *flags, 9077 NL80211_SCAN_FLAG_MIN_PREQ_CONTENT, 9078 NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT)) 9079 return -EOPNOTSUPP; 9080 9081 if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) { 9082 int err; 9083 9084 if (!(wiphy->features & randomness_flag) || 9085 (wdev && wdev->connected)) 9086 return -EOPNOTSUPP; 9087 9088 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask); 9089 if (err) 9090 return err; 9091 } 9092 9093 return 0; 9094 } 9095 9096 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info) 9097 { 9098 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9099 struct wireless_dev *wdev = info->user_ptr[1]; 9100 struct cfg80211_scan_request *request; 9101 struct nlattr *scan_freqs = NULL; 9102 bool scan_freqs_khz = false; 9103 struct nlattr *attr; 9104 struct wiphy *wiphy; 9105 int err, tmp, n_ssids = 0, n_channels, i; 9106 size_t ie_len, size; 9107 9108 wiphy = &rdev->wiphy; 9109 9110 if (wdev->iftype == NL80211_IFTYPE_NAN) 9111 return -EOPNOTSUPP; 9112 9113 if (!rdev->ops->scan) 9114 return -EOPNOTSUPP; 9115 9116 if (rdev->scan_req || rdev->scan_msg) 9117 return -EBUSY; 9118 9119 if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) { 9120 if (!wiphy_ext_feature_isset(wiphy, 9121 NL80211_EXT_FEATURE_SCAN_FREQ_KHZ)) 9122 return -EOPNOTSUPP; 9123 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]; 9124 scan_freqs_khz = true; 9125 } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) 9126 scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]; 9127 9128 if (scan_freqs) { 9129 n_channels = validate_scan_freqs(scan_freqs); 9130 if (!n_channels) 9131 return -EINVAL; 9132 } else { 9133 n_channels = ieee80211_get_num_supported_channels(wiphy); 9134 } 9135 9136 if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) 9137 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) 9138 n_ssids++; 9139 9140 if (n_ssids > wiphy->max_scan_ssids) 9141 return -EINVAL; 9142 9143 if (info->attrs[NL80211_ATTR_IE]) 9144 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9145 else 9146 ie_len = 0; 9147 9148 if (ie_len > wiphy->max_scan_ie_len) 9149 return -EINVAL; 9150 9151 size = struct_size(request, channels, n_channels); 9152 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9153 size = size_add(size, ie_len); 9154 request = kzalloc(size, GFP_KERNEL); 9155 if (!request) 9156 return -ENOMEM; 9157 9158 if (n_ssids) 9159 request->ssids = (void *)&request->channels[n_channels]; 9160 request->n_ssids = n_ssids; 9161 if (ie_len) { 9162 if (n_ssids) 9163 request->ie = (void *)(request->ssids + n_ssids); 9164 else 9165 request->ie = (void *)(request->channels + n_channels); 9166 } 9167 9168 i = 0; 9169 if (scan_freqs) { 9170 /* user specified, bail out if channel not found */ 9171 nla_for_each_nested(attr, scan_freqs, tmp) { 9172 struct ieee80211_channel *chan; 9173 int freq = nla_get_u32(attr); 9174 9175 if (!scan_freqs_khz) 9176 freq = MHZ_TO_KHZ(freq); 9177 9178 chan = ieee80211_get_channel_khz(wiphy, freq); 9179 if (!chan) { 9180 err = -EINVAL; 9181 goto out_free; 9182 } 9183 9184 /* ignore disabled channels */ 9185 if (chan->flags & IEEE80211_CHAN_DISABLED) 9186 continue; 9187 9188 request->channels[i] = chan; 9189 i++; 9190 } 9191 } else { 9192 enum nl80211_band band; 9193 9194 /* all channels */ 9195 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9196 int j; 9197 9198 if (!wiphy->bands[band]) 9199 continue; 9200 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9201 struct ieee80211_channel *chan; 9202 9203 chan = &wiphy->bands[band]->channels[j]; 9204 9205 if (chan->flags & IEEE80211_CHAN_DISABLED) 9206 continue; 9207 9208 request->channels[i] = chan; 9209 i++; 9210 } 9211 } 9212 } 9213 9214 if (!i) { 9215 err = -EINVAL; 9216 goto out_free; 9217 } 9218 9219 request->n_channels = i; 9220 9221 wdev_lock(wdev); 9222 for (i = 0; i < request->n_channels; i++) { 9223 struct ieee80211_channel *chan = request->channels[i]; 9224 9225 /* if we can go off-channel to the target channel we're good */ 9226 if (cfg80211_off_channel_oper_allowed(wdev, chan)) 9227 continue; 9228 9229 if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) { 9230 wdev_unlock(wdev); 9231 err = -EBUSY; 9232 goto out_free; 9233 } 9234 } 9235 wdev_unlock(wdev); 9236 9237 i = 0; 9238 if (n_ssids) { 9239 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) { 9240 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9241 err = -EINVAL; 9242 goto out_free; 9243 } 9244 request->ssids[i].ssid_len = nla_len(attr); 9245 memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr)); 9246 i++; 9247 } 9248 } 9249 9250 if (info->attrs[NL80211_ATTR_IE]) { 9251 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 9252 memcpy((void *)request->ie, 9253 nla_data(info->attrs[NL80211_ATTR_IE]), 9254 request->ie_len); 9255 } 9256 9257 for (i = 0; i < NUM_NL80211_BANDS; i++) 9258 if (wiphy->bands[i]) 9259 request->rates[i] = 9260 (1 << wiphy->bands[i]->n_bitrates) - 1; 9261 9262 if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) { 9263 nla_for_each_nested(attr, 9264 info->attrs[NL80211_ATTR_SCAN_SUPP_RATES], 9265 tmp) { 9266 enum nl80211_band band = nla_type(attr); 9267 9268 if (band < 0 || band >= NUM_NL80211_BANDS) { 9269 err = -EINVAL; 9270 goto out_free; 9271 } 9272 9273 if (!wiphy->bands[band]) 9274 continue; 9275 9276 err = ieee80211_get_ratemask(wiphy->bands[band], 9277 nla_data(attr), 9278 nla_len(attr), 9279 &request->rates[band]); 9280 if (err) 9281 goto out_free; 9282 } 9283 } 9284 9285 if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) { 9286 request->duration = 9287 nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]); 9288 request->duration_mandatory = 9289 nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]); 9290 } 9291 9292 err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs, 9293 false); 9294 if (err) 9295 goto out_free; 9296 9297 request->no_cck = 9298 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 9299 9300 /* Initial implementation used NL80211_ATTR_MAC to set the specific 9301 * BSSID to scan for. This was problematic because that same attribute 9302 * was already used for another purpose (local random MAC address). The 9303 * NL80211_ATTR_BSSID attribute was added to fix this. For backwards 9304 * compatibility with older userspace components, also use the 9305 * NL80211_ATTR_MAC value here if it can be determined to be used for 9306 * the specific BSSID use case instead of the random MAC address 9307 * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use). 9308 */ 9309 if (info->attrs[NL80211_ATTR_BSSID]) 9310 memcpy(request->bssid, 9311 nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN); 9312 else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) && 9313 info->attrs[NL80211_ATTR_MAC]) 9314 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]), 9315 ETH_ALEN); 9316 else 9317 eth_broadcast_addr(request->bssid); 9318 9319 request->wdev = wdev; 9320 request->wiphy = &rdev->wiphy; 9321 request->scan_start = jiffies; 9322 9323 rdev->scan_req = request; 9324 err = cfg80211_scan(rdev); 9325 9326 if (err) 9327 goto out_free; 9328 9329 nl80211_send_scan_start(rdev, wdev); 9330 dev_hold(wdev->netdev); 9331 9332 return 0; 9333 9334 out_free: 9335 rdev->scan_req = NULL; 9336 kfree(request); 9337 9338 return err; 9339 } 9340 9341 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info) 9342 { 9343 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9344 struct wireless_dev *wdev = info->user_ptr[1]; 9345 9346 if (!rdev->ops->abort_scan) 9347 return -EOPNOTSUPP; 9348 9349 if (rdev->scan_msg) 9350 return 0; 9351 9352 if (!rdev->scan_req) 9353 return -ENOENT; 9354 9355 rdev_abort_scan(rdev, wdev); 9356 return 0; 9357 } 9358 9359 static int 9360 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans, 9361 struct cfg80211_sched_scan_request *request, 9362 struct nlattr **attrs) 9363 { 9364 int tmp, err, i = 0; 9365 struct nlattr *attr; 9366 9367 if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9368 u32 interval; 9369 9370 /* 9371 * If scan plans are not specified, 9372 * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this 9373 * case one scan plan will be set with the specified scan 9374 * interval and infinite number of iterations. 9375 */ 9376 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]); 9377 if (!interval) 9378 return -EINVAL; 9379 9380 request->scan_plans[0].interval = 9381 DIV_ROUND_UP(interval, MSEC_PER_SEC); 9382 if (!request->scan_plans[0].interval) 9383 return -EINVAL; 9384 9385 if (request->scan_plans[0].interval > 9386 wiphy->max_sched_scan_plan_interval) 9387 request->scan_plans[0].interval = 9388 wiphy->max_sched_scan_plan_interval; 9389 9390 return 0; 9391 } 9392 9393 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) { 9394 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1]; 9395 9396 if (WARN_ON(i >= n_plans)) 9397 return -EINVAL; 9398 9399 err = nla_parse_nested_deprecated(plan, 9400 NL80211_SCHED_SCAN_PLAN_MAX, 9401 attr, nl80211_plan_policy, 9402 NULL); 9403 if (err) 9404 return err; 9405 9406 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]) 9407 return -EINVAL; 9408 9409 request->scan_plans[i].interval = 9410 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]); 9411 if (!request->scan_plans[i].interval || 9412 request->scan_plans[i].interval > 9413 wiphy->max_sched_scan_plan_interval) 9414 return -EINVAL; 9415 9416 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) { 9417 request->scan_plans[i].iterations = 9418 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]); 9419 if (!request->scan_plans[i].iterations || 9420 (request->scan_plans[i].iterations > 9421 wiphy->max_sched_scan_plan_iterations)) 9422 return -EINVAL; 9423 } else if (i < n_plans - 1) { 9424 /* 9425 * All scan plans but the last one must specify 9426 * a finite number of iterations 9427 */ 9428 return -EINVAL; 9429 } 9430 9431 i++; 9432 } 9433 9434 /* 9435 * The last scan plan must not specify the number of 9436 * iterations, it is supposed to run infinitely 9437 */ 9438 if (request->scan_plans[n_plans - 1].iterations) 9439 return -EINVAL; 9440 9441 return 0; 9442 } 9443 9444 static int 9445 nl80211_parse_sched_scan_per_band_rssi(struct wiphy *wiphy, 9446 struct cfg80211_match_set *match_sets, 9447 struct nlattr *tb_band_rssi, 9448 s32 rssi_thold) 9449 { 9450 struct nlattr *attr; 9451 int i, tmp, ret = 0; 9452 9453 if (!wiphy_ext_feature_isset(wiphy, 9454 NL80211_EXT_FEATURE_SCHED_SCAN_BAND_SPECIFIC_RSSI_THOLD)) { 9455 if (tb_band_rssi) 9456 ret = -EOPNOTSUPP; 9457 else 9458 for (i = 0; i < NUM_NL80211_BANDS; i++) 9459 match_sets->per_band_rssi_thold[i] = 9460 NL80211_SCAN_RSSI_THOLD_OFF; 9461 return ret; 9462 } 9463 9464 for (i = 0; i < NUM_NL80211_BANDS; i++) 9465 match_sets->per_band_rssi_thold[i] = rssi_thold; 9466 9467 nla_for_each_nested(attr, tb_band_rssi, tmp) { 9468 enum nl80211_band band = nla_type(attr); 9469 9470 if (band < 0 || band >= NUM_NL80211_BANDS) 9471 return -EINVAL; 9472 9473 match_sets->per_band_rssi_thold[band] = nla_get_s32(attr); 9474 } 9475 9476 return 0; 9477 } 9478 9479 static struct cfg80211_sched_scan_request * 9480 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev, 9481 struct nlattr **attrs, int max_match_sets) 9482 { 9483 struct cfg80211_sched_scan_request *request; 9484 struct nlattr *attr; 9485 int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0; 9486 enum nl80211_band band; 9487 size_t ie_len, size; 9488 struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1]; 9489 s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF; 9490 9491 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9492 n_channels = validate_scan_freqs( 9493 attrs[NL80211_ATTR_SCAN_FREQUENCIES]); 9494 if (!n_channels) 9495 return ERR_PTR(-EINVAL); 9496 } else { 9497 n_channels = ieee80211_get_num_supported_channels(wiphy); 9498 } 9499 9500 if (attrs[NL80211_ATTR_SCAN_SSIDS]) 9501 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9502 tmp) 9503 n_ssids++; 9504 9505 if (n_ssids > wiphy->max_sched_scan_ssids) 9506 return ERR_PTR(-EINVAL); 9507 9508 /* 9509 * First, count the number of 'real' matchsets. Due to an issue with 9510 * the old implementation, matchsets containing only the RSSI attribute 9511 * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default' 9512 * RSSI for all matchsets, rather than their own matchset for reporting 9513 * all APs with a strong RSSI. This is needed to be compatible with 9514 * older userspace that treated a matchset with only the RSSI as the 9515 * global RSSI for all other matchsets - if there are other matchsets. 9516 */ 9517 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9518 nla_for_each_nested(attr, 9519 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9520 tmp) { 9521 struct nlattr *rssi; 9522 9523 err = nla_parse_nested_deprecated(tb, 9524 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9525 attr, 9526 nl80211_match_policy, 9527 NULL); 9528 if (err) 9529 return ERR_PTR(err); 9530 9531 /* SSID and BSSID are mutually exclusive */ 9532 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] && 9533 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) 9534 return ERR_PTR(-EINVAL); 9535 9536 /* add other standalone attributes here */ 9537 if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] || 9538 tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) { 9539 n_match_sets++; 9540 continue; 9541 } 9542 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9543 if (rssi) 9544 default_match_rssi = nla_get_s32(rssi); 9545 } 9546 } 9547 9548 /* However, if there's no other matchset, add the RSSI one */ 9549 if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF) 9550 n_match_sets = 1; 9551 9552 if (n_match_sets > max_match_sets) 9553 return ERR_PTR(-EINVAL); 9554 9555 if (attrs[NL80211_ATTR_IE]) 9556 ie_len = nla_len(attrs[NL80211_ATTR_IE]); 9557 else 9558 ie_len = 0; 9559 9560 if (ie_len > wiphy->max_sched_scan_ie_len) 9561 return ERR_PTR(-EINVAL); 9562 9563 if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) { 9564 /* 9565 * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since 9566 * each scan plan already specifies its own interval 9567 */ 9568 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9569 return ERR_PTR(-EINVAL); 9570 9571 nla_for_each_nested(attr, 9572 attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) 9573 n_plans++; 9574 } else { 9575 /* 9576 * The scan interval attribute is kept for backward 9577 * compatibility. If no scan plans are specified and sched scan 9578 * interval is specified, one scan plan will be set with this 9579 * scan interval and infinite number of iterations. 9580 */ 9581 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]) 9582 return ERR_PTR(-EINVAL); 9583 9584 n_plans = 1; 9585 } 9586 9587 if (!n_plans || n_plans > wiphy->max_sched_scan_plans) 9588 return ERR_PTR(-EINVAL); 9589 9590 if (!wiphy_ext_feature_isset( 9591 wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) && 9592 (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] || 9593 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST])) 9594 return ERR_PTR(-EINVAL); 9595 9596 size = struct_size(request, channels, n_channels); 9597 size = size_add(size, array_size(sizeof(*request->ssids), n_ssids)); 9598 size = size_add(size, array_size(sizeof(*request->match_sets), 9599 n_match_sets)); 9600 size = size_add(size, array_size(sizeof(*request->scan_plans), 9601 n_plans)); 9602 size = size_add(size, ie_len); 9603 request = kzalloc(size, GFP_KERNEL); 9604 if (!request) 9605 return ERR_PTR(-ENOMEM); 9606 9607 if (n_ssids) 9608 request->ssids = (void *)&request->channels[n_channels]; 9609 request->n_ssids = n_ssids; 9610 if (ie_len) { 9611 if (n_ssids) 9612 request->ie = (void *)(request->ssids + n_ssids); 9613 else 9614 request->ie = (void *)(request->channels + n_channels); 9615 } 9616 9617 if (n_match_sets) { 9618 if (request->ie) 9619 request->match_sets = (void *)(request->ie + ie_len); 9620 else if (n_ssids) 9621 request->match_sets = 9622 (void *)(request->ssids + n_ssids); 9623 else 9624 request->match_sets = 9625 (void *)(request->channels + n_channels); 9626 } 9627 request->n_match_sets = n_match_sets; 9628 9629 if (n_match_sets) 9630 request->scan_plans = (void *)(request->match_sets + 9631 n_match_sets); 9632 else if (request->ie) 9633 request->scan_plans = (void *)(request->ie + ie_len); 9634 else if (n_ssids) 9635 request->scan_plans = (void *)(request->ssids + n_ssids); 9636 else 9637 request->scan_plans = (void *)(request->channels + n_channels); 9638 9639 request->n_scan_plans = n_plans; 9640 9641 i = 0; 9642 if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) { 9643 /* user specified, bail out if channel not found */ 9644 nla_for_each_nested(attr, 9645 attrs[NL80211_ATTR_SCAN_FREQUENCIES], 9646 tmp) { 9647 struct ieee80211_channel *chan; 9648 9649 chan = ieee80211_get_channel(wiphy, nla_get_u32(attr)); 9650 9651 if (!chan) { 9652 err = -EINVAL; 9653 goto out_free; 9654 } 9655 9656 /* ignore disabled channels */ 9657 if (chan->flags & IEEE80211_CHAN_DISABLED) 9658 continue; 9659 9660 request->channels[i] = chan; 9661 i++; 9662 } 9663 } else { 9664 /* all channels */ 9665 for (band = 0; band < NUM_NL80211_BANDS; band++) { 9666 int j; 9667 9668 if (!wiphy->bands[band]) 9669 continue; 9670 for (j = 0; j < wiphy->bands[band]->n_channels; j++) { 9671 struct ieee80211_channel *chan; 9672 9673 chan = &wiphy->bands[band]->channels[j]; 9674 9675 if (chan->flags & IEEE80211_CHAN_DISABLED) 9676 continue; 9677 9678 request->channels[i] = chan; 9679 i++; 9680 } 9681 } 9682 } 9683 9684 if (!i) { 9685 err = -EINVAL; 9686 goto out_free; 9687 } 9688 9689 request->n_channels = i; 9690 9691 i = 0; 9692 if (n_ssids) { 9693 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS], 9694 tmp) { 9695 if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) { 9696 err = -EINVAL; 9697 goto out_free; 9698 } 9699 request->ssids[i].ssid_len = nla_len(attr); 9700 memcpy(request->ssids[i].ssid, nla_data(attr), 9701 nla_len(attr)); 9702 i++; 9703 } 9704 } 9705 9706 i = 0; 9707 if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) { 9708 nla_for_each_nested(attr, 9709 attrs[NL80211_ATTR_SCHED_SCAN_MATCH], 9710 tmp) { 9711 struct nlattr *ssid, *bssid, *rssi; 9712 9713 err = nla_parse_nested_deprecated(tb, 9714 NL80211_SCHED_SCAN_MATCH_ATTR_MAX, 9715 attr, 9716 nl80211_match_policy, 9717 NULL); 9718 if (err) 9719 goto out_free; 9720 ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]; 9721 bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]; 9722 9723 if (!ssid && !bssid) { 9724 i++; 9725 continue; 9726 } 9727 9728 if (WARN_ON(i >= n_match_sets)) { 9729 /* this indicates a programming error, 9730 * the loop above should have verified 9731 * things properly 9732 */ 9733 err = -EINVAL; 9734 goto out_free; 9735 } 9736 9737 if (ssid) { 9738 memcpy(request->match_sets[i].ssid.ssid, 9739 nla_data(ssid), nla_len(ssid)); 9740 request->match_sets[i].ssid.ssid_len = 9741 nla_len(ssid); 9742 } 9743 if (bssid) 9744 memcpy(request->match_sets[i].bssid, 9745 nla_data(bssid), ETH_ALEN); 9746 9747 /* special attribute - old implementation w/a */ 9748 request->match_sets[i].rssi_thold = default_match_rssi; 9749 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI]; 9750 if (rssi) 9751 request->match_sets[i].rssi_thold = 9752 nla_get_s32(rssi); 9753 9754 /* Parse per band RSSI attribute */ 9755 err = nl80211_parse_sched_scan_per_band_rssi(wiphy, 9756 &request->match_sets[i], 9757 tb[NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI], 9758 request->match_sets[i].rssi_thold); 9759 if (err) 9760 goto out_free; 9761 9762 i++; 9763 } 9764 9765 /* there was no other matchset, so the RSSI one is alone */ 9766 if (i == 0 && n_match_sets) 9767 request->match_sets[0].rssi_thold = default_match_rssi; 9768 9769 request->min_rssi_thold = INT_MAX; 9770 for (i = 0; i < n_match_sets; i++) 9771 request->min_rssi_thold = 9772 min(request->match_sets[i].rssi_thold, 9773 request->min_rssi_thold); 9774 } else { 9775 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF; 9776 } 9777 9778 if (ie_len) { 9779 request->ie_len = ie_len; 9780 memcpy((void *)request->ie, 9781 nla_data(attrs[NL80211_ATTR_IE]), 9782 request->ie_len); 9783 } 9784 9785 err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true); 9786 if (err) 9787 goto out_free; 9788 9789 if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY]) 9790 request->delay = 9791 nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]); 9792 9793 if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) { 9794 request->relative_rssi = nla_get_s8( 9795 attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]); 9796 request->relative_rssi_set = true; 9797 } 9798 9799 if (request->relative_rssi_set && 9800 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) { 9801 struct nl80211_bss_select_rssi_adjust *rssi_adjust; 9802 9803 rssi_adjust = nla_data( 9804 attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]); 9805 request->rssi_adjust.band = rssi_adjust->band; 9806 request->rssi_adjust.delta = rssi_adjust->delta; 9807 if (!is_band_valid(wiphy, request->rssi_adjust.band)) { 9808 err = -EINVAL; 9809 goto out_free; 9810 } 9811 } 9812 9813 err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs); 9814 if (err) 9815 goto out_free; 9816 9817 request->scan_start = jiffies; 9818 9819 return request; 9820 9821 out_free: 9822 kfree(request); 9823 return ERR_PTR(err); 9824 } 9825 9826 static int nl80211_start_sched_scan(struct sk_buff *skb, 9827 struct genl_info *info) 9828 { 9829 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9830 struct net_device *dev = info->user_ptr[1]; 9831 struct wireless_dev *wdev = dev->ieee80211_ptr; 9832 struct cfg80211_sched_scan_request *sched_scan_req; 9833 bool want_multi; 9834 int err; 9835 9836 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start) 9837 return -EOPNOTSUPP; 9838 9839 want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI]; 9840 err = cfg80211_sched_scan_req_possible(rdev, want_multi); 9841 if (err) 9842 return err; 9843 9844 sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev, 9845 info->attrs, 9846 rdev->wiphy.max_match_sets); 9847 9848 err = PTR_ERR_OR_ZERO(sched_scan_req); 9849 if (err) 9850 goto out_err; 9851 9852 /* leave request id zero for legacy request 9853 * or if driver does not support multi-scheduled scan 9854 */ 9855 if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) 9856 sched_scan_req->reqid = cfg80211_assign_cookie(rdev); 9857 9858 err = rdev_sched_scan_start(rdev, dev, sched_scan_req); 9859 if (err) 9860 goto out_free; 9861 9862 sched_scan_req->dev = dev; 9863 sched_scan_req->wiphy = &rdev->wiphy; 9864 9865 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 9866 sched_scan_req->owner_nlportid = info->snd_portid; 9867 9868 cfg80211_add_sched_scan_req(rdev, sched_scan_req); 9869 9870 nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN); 9871 return 0; 9872 9873 out_free: 9874 kfree(sched_scan_req); 9875 out_err: 9876 return err; 9877 } 9878 9879 static int nl80211_stop_sched_scan(struct sk_buff *skb, 9880 struct genl_info *info) 9881 { 9882 struct cfg80211_sched_scan_request *req; 9883 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9884 u64 cookie; 9885 9886 if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop) 9887 return -EOPNOTSUPP; 9888 9889 if (info->attrs[NL80211_ATTR_COOKIE]) { 9890 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 9891 return __cfg80211_stop_sched_scan(rdev, cookie, false); 9892 } 9893 9894 req = list_first_or_null_rcu(&rdev->sched_scan_req_list, 9895 struct cfg80211_sched_scan_request, 9896 list); 9897 if (!req || req->reqid || 9898 (req->owner_nlportid && 9899 req->owner_nlportid != info->snd_portid)) 9900 return -ENOENT; 9901 9902 return cfg80211_stop_sched_scan_req(rdev, req, false); 9903 } 9904 9905 static int nl80211_start_radar_detection(struct sk_buff *skb, 9906 struct genl_info *info) 9907 { 9908 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9909 struct net_device *dev = info->user_ptr[1]; 9910 struct wireless_dev *wdev = dev->ieee80211_ptr; 9911 struct wiphy *wiphy = wdev->wiphy; 9912 struct cfg80211_chan_def chandef; 9913 enum nl80211_dfs_regions dfs_region; 9914 unsigned int cac_time_ms; 9915 int err = -EINVAL; 9916 9917 flush_delayed_work(&rdev->dfs_update_channels_wk); 9918 9919 wiphy_lock(wiphy); 9920 9921 dfs_region = reg_get_dfs_region(wiphy); 9922 if (dfs_region == NL80211_DFS_UNSET) 9923 goto unlock; 9924 9925 err = nl80211_parse_chandef(rdev, info, &chandef); 9926 if (err) 9927 goto unlock; 9928 9929 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 9930 if (err < 0) 9931 goto unlock; 9932 9933 if (err == 0) { 9934 err = -EINVAL; 9935 goto unlock; 9936 } 9937 9938 if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) { 9939 err = -EINVAL; 9940 goto unlock; 9941 } 9942 9943 if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) { 9944 err = cfg80211_start_background_radar_detection(rdev, wdev, 9945 &chandef); 9946 goto unlock; 9947 } 9948 9949 if (netif_carrier_ok(dev)) { 9950 err = -EBUSY; 9951 goto unlock; 9952 } 9953 9954 if (wdev->cac_started) { 9955 err = -EBUSY; 9956 goto unlock; 9957 } 9958 9959 /* CAC start is offloaded to HW and can't be started manually */ 9960 if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) { 9961 err = -EOPNOTSUPP; 9962 goto unlock; 9963 } 9964 9965 if (!rdev->ops->start_radar_detection) { 9966 err = -EOPNOTSUPP; 9967 goto unlock; 9968 } 9969 9970 cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef); 9971 if (WARN_ON(!cac_time_ms)) 9972 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS; 9973 9974 err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms); 9975 if (!err) { 9976 wdev->links[0].ap.chandef = chandef; 9977 wdev->cac_started = true; 9978 wdev->cac_start_time = jiffies; 9979 wdev->cac_time_ms = cac_time_ms; 9980 } 9981 unlock: 9982 wiphy_unlock(wiphy); 9983 9984 return err; 9985 } 9986 9987 static int nl80211_notify_radar_detection(struct sk_buff *skb, 9988 struct genl_info *info) 9989 { 9990 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 9991 struct net_device *dev = info->user_ptr[1]; 9992 struct wireless_dev *wdev = dev->ieee80211_ptr; 9993 struct wiphy *wiphy = wdev->wiphy; 9994 struct cfg80211_chan_def chandef; 9995 enum nl80211_dfs_regions dfs_region; 9996 int err; 9997 9998 dfs_region = reg_get_dfs_region(wiphy); 9999 if (dfs_region == NL80211_DFS_UNSET) { 10000 GENL_SET_ERR_MSG(info, 10001 "DFS Region is not set. Unexpected Radar indication"); 10002 return -EINVAL; 10003 } 10004 10005 err = nl80211_parse_chandef(rdev, info, &chandef); 10006 if (err) { 10007 GENL_SET_ERR_MSG(info, "Unable to extract chandef info"); 10008 return err; 10009 } 10010 10011 err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype); 10012 if (err < 0) { 10013 GENL_SET_ERR_MSG(info, "chandef is invalid"); 10014 return err; 10015 } 10016 10017 if (err == 0) { 10018 GENL_SET_ERR_MSG(info, 10019 "Unexpected Radar indication for chandef/iftype"); 10020 return -EINVAL; 10021 } 10022 10023 /* Do not process this notification if radar is already detected 10024 * by kernel on this channel, and return success. 10025 */ 10026 if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE) 10027 return 0; 10028 10029 cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE); 10030 10031 cfg80211_sched_dfs_chan_update(rdev); 10032 10033 rdev->radar_chandef = chandef; 10034 10035 /* Propagate this notification to other radios as well */ 10036 queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk); 10037 10038 return 0; 10039 } 10040 10041 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info) 10042 { 10043 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10044 unsigned int link_id = nl80211_link_id(info->attrs); 10045 struct net_device *dev = info->user_ptr[1]; 10046 struct wireless_dev *wdev = dev->ieee80211_ptr; 10047 struct cfg80211_csa_settings params; 10048 struct nlattr **csa_attrs = NULL; 10049 int err; 10050 bool need_new_beacon = false; 10051 bool need_handle_dfs_flag = true; 10052 int len, i; 10053 u32 cs_count; 10054 10055 if (!rdev->ops->channel_switch || 10056 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 10057 return -EOPNOTSUPP; 10058 10059 switch (dev->ieee80211_ptr->iftype) { 10060 case NL80211_IFTYPE_AP: 10061 case NL80211_IFTYPE_P2P_GO: 10062 need_new_beacon = true; 10063 /* For all modes except AP the handle_dfs flag needs to be 10064 * supplied to tell the kernel that userspace will handle radar 10065 * events when they happen. Otherwise a switch to a channel 10066 * requiring DFS will be rejected. 10067 */ 10068 need_handle_dfs_flag = false; 10069 10070 /* useless if AP is not running */ 10071 if (!wdev->links[link_id].ap.beacon_interval) 10072 return -ENOTCONN; 10073 break; 10074 case NL80211_IFTYPE_ADHOC: 10075 if (!wdev->u.ibss.ssid_len) 10076 return -ENOTCONN; 10077 break; 10078 case NL80211_IFTYPE_MESH_POINT: 10079 if (!wdev->u.mesh.id_len) 10080 return -ENOTCONN; 10081 break; 10082 default: 10083 return -EOPNOTSUPP; 10084 } 10085 10086 memset(¶ms, 0, sizeof(params)); 10087 params.beacon_csa.ftm_responder = -1; 10088 10089 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 10090 !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]) 10091 return -EINVAL; 10092 10093 /* only important for AP, IBSS and mesh create IEs internally */ 10094 if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES]) 10095 return -EINVAL; 10096 10097 /* Even though the attribute is u32, the specification says 10098 * u8, so let's make sure we don't overflow. 10099 */ 10100 cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]); 10101 if (cs_count > 255) 10102 return -EINVAL; 10103 10104 params.count = cs_count; 10105 10106 if (!need_new_beacon) 10107 goto skip_beacons; 10108 10109 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_after, 10110 info->extack); 10111 if (err) 10112 goto free; 10113 10114 csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs), 10115 GFP_KERNEL); 10116 if (!csa_attrs) { 10117 err = -ENOMEM; 10118 goto free; 10119 } 10120 10121 err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX, 10122 info->attrs[NL80211_ATTR_CSA_IES], 10123 nl80211_policy, info->extack); 10124 if (err) 10125 goto free; 10126 10127 err = nl80211_parse_beacon(rdev, csa_attrs, ¶ms.beacon_csa, 10128 info->extack); 10129 if (err) 10130 goto free; 10131 10132 if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 10133 err = -EINVAL; 10134 goto free; 10135 } 10136 10137 len = nla_len(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 10138 if (!len || (len % sizeof(u16))) { 10139 err = -EINVAL; 10140 goto free; 10141 } 10142 10143 params.n_counter_offsets_beacon = len / sizeof(u16); 10144 if (rdev->wiphy.max_num_csa_counters && 10145 (params.n_counter_offsets_beacon > 10146 rdev->wiphy.max_num_csa_counters)) { 10147 err = -EINVAL; 10148 goto free; 10149 } 10150 10151 params.counter_offsets_beacon = 10152 nla_data(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 10153 10154 /* sanity checks - counters should fit and be the same */ 10155 for (i = 0; i < params.n_counter_offsets_beacon; i++) { 10156 u16 offset = params.counter_offsets_beacon[i]; 10157 10158 if (offset >= params.beacon_csa.tail_len) { 10159 err = -EINVAL; 10160 goto free; 10161 } 10162 10163 if (params.beacon_csa.tail[offset] != params.count) { 10164 err = -EINVAL; 10165 goto free; 10166 } 10167 } 10168 10169 if (csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 10170 len = nla_len(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 10171 if (!len || (len % sizeof(u16))) { 10172 err = -EINVAL; 10173 goto free; 10174 } 10175 10176 params.n_counter_offsets_presp = len / sizeof(u16); 10177 if (rdev->wiphy.max_num_csa_counters && 10178 (params.n_counter_offsets_presp > 10179 rdev->wiphy.max_num_csa_counters)) { 10180 err = -EINVAL; 10181 goto free; 10182 } 10183 10184 params.counter_offsets_presp = 10185 nla_data(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 10186 10187 /* sanity checks - counters should fit and be the same */ 10188 for (i = 0; i < params.n_counter_offsets_presp; i++) { 10189 u16 offset = params.counter_offsets_presp[i]; 10190 10191 if (offset >= params.beacon_csa.probe_resp_len) { 10192 err = -EINVAL; 10193 goto free; 10194 } 10195 10196 if (params.beacon_csa.probe_resp[offset] != 10197 params.count) { 10198 err = -EINVAL; 10199 goto free; 10200 } 10201 } 10202 } 10203 10204 skip_beacons: 10205 err = nl80211_parse_chandef(rdev, info, ¶ms.chandef); 10206 if (err) 10207 goto free; 10208 10209 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, ¶ms.chandef, 10210 wdev->iftype)) { 10211 err = -EINVAL; 10212 goto free; 10213 } 10214 10215 err = cfg80211_chandef_dfs_required(wdev->wiphy, 10216 ¶ms.chandef, 10217 wdev->iftype); 10218 if (err < 0) 10219 goto free; 10220 10221 if (err > 0) { 10222 params.radar_required = true; 10223 if (need_handle_dfs_flag && 10224 !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) { 10225 err = -EINVAL; 10226 goto free; 10227 } 10228 } 10229 10230 if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX]) 10231 params.block_tx = true; 10232 10233 if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) { 10234 err = nl80211_parse_punct_bitmap(rdev, info, 10235 ¶ms.chandef, 10236 ¶ms.punct_bitmap); 10237 if (err) 10238 goto free; 10239 } 10240 10241 wdev_lock(wdev); 10242 err = rdev_channel_switch(rdev, dev, ¶ms); 10243 wdev_unlock(wdev); 10244 10245 free: 10246 kfree(params.beacon_after.mbssid_ies); 10247 kfree(params.beacon_csa.mbssid_ies); 10248 kfree(params.beacon_after.rnr_ies); 10249 kfree(params.beacon_csa.rnr_ies); 10250 kfree(csa_attrs); 10251 return err; 10252 } 10253 10254 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb, 10255 u32 seq, int flags, 10256 struct cfg80211_registered_device *rdev, 10257 struct wireless_dev *wdev, 10258 struct cfg80211_internal_bss *intbss) 10259 { 10260 struct cfg80211_bss *res = &intbss->pub; 10261 const struct cfg80211_bss_ies *ies; 10262 unsigned int link_id; 10263 void *hdr; 10264 struct nlattr *bss; 10265 10266 ASSERT_WDEV_LOCK(wdev); 10267 10268 hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags, 10269 NL80211_CMD_NEW_SCAN_RESULTS); 10270 if (!hdr) 10271 return -1; 10272 10273 genl_dump_check_consistent(cb, hdr); 10274 10275 if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation)) 10276 goto nla_put_failure; 10277 if (wdev->netdev && 10278 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex)) 10279 goto nla_put_failure; 10280 if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 10281 NL80211_ATTR_PAD)) 10282 goto nla_put_failure; 10283 10284 bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS); 10285 if (!bss) 10286 goto nla_put_failure; 10287 if ((!is_zero_ether_addr(res->bssid) && 10288 nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid))) 10289 goto nla_put_failure; 10290 10291 rcu_read_lock(); 10292 /* indicate whether we have probe response data or not */ 10293 if (rcu_access_pointer(res->proberesp_ies) && 10294 nla_put_flag(msg, NL80211_BSS_PRESP_DATA)) 10295 goto fail_unlock_rcu; 10296 10297 /* this pointer prefers to be pointed to probe response data 10298 * but is always valid 10299 */ 10300 ies = rcu_dereference(res->ies); 10301 if (ies) { 10302 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf, 10303 NL80211_BSS_PAD)) 10304 goto fail_unlock_rcu; 10305 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS, 10306 ies->len, ies->data)) 10307 goto fail_unlock_rcu; 10308 } 10309 10310 /* and this pointer is always (unless driver didn't know) beacon data */ 10311 ies = rcu_dereference(res->beacon_ies); 10312 if (ies && ies->from_beacon) { 10313 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf, 10314 NL80211_BSS_PAD)) 10315 goto fail_unlock_rcu; 10316 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES, 10317 ies->len, ies->data)) 10318 goto fail_unlock_rcu; 10319 } 10320 rcu_read_unlock(); 10321 10322 if (res->beacon_interval && 10323 nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval)) 10324 goto nla_put_failure; 10325 if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) || 10326 nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) || 10327 nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET, 10328 res->channel->freq_offset) || 10329 nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) || 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 nla_nest_end(msg, bss); 10390 10391 genlmsg_end(msg, hdr); 10392 return 0; 10393 10394 fail_unlock_rcu: 10395 rcu_read_unlock(); 10396 nla_put_failure: 10397 genlmsg_cancel(msg, hdr); 10398 return -EMSGSIZE; 10399 } 10400 10401 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb) 10402 { 10403 struct cfg80211_registered_device *rdev; 10404 struct cfg80211_internal_bss *scan; 10405 struct wireless_dev *wdev; 10406 int start = cb->args[2], idx = 0; 10407 int err; 10408 10409 err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL); 10410 if (err) 10411 return err; 10412 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10413 __acquire(&rdev->wiphy.mtx); 10414 10415 wdev_lock(wdev); 10416 spin_lock_bh(&rdev->bss_lock); 10417 10418 /* 10419 * dump_scan will be called multiple times to break up the scan results 10420 * into multiple messages. It is unlikely that any more bss-es will be 10421 * expired after the first call, so only call only call this on the 10422 * first dump_scan invocation. 10423 */ 10424 if (start == 0) 10425 cfg80211_bss_expire(rdev); 10426 10427 cb->seq = rdev->bss_generation; 10428 10429 list_for_each_entry(scan, &rdev->bss_list, list) { 10430 if (++idx <= start) 10431 continue; 10432 if (nl80211_send_bss(skb, cb, 10433 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10434 rdev, wdev, scan) < 0) { 10435 idx--; 10436 break; 10437 } 10438 } 10439 10440 spin_unlock_bh(&rdev->bss_lock); 10441 wdev_unlock(wdev); 10442 10443 cb->args[2] = idx; 10444 wiphy_unlock(&rdev->wiphy); 10445 10446 return skb->len; 10447 } 10448 10449 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq, 10450 int flags, struct net_device *dev, 10451 bool allow_radio_stats, 10452 struct survey_info *survey) 10453 { 10454 void *hdr; 10455 struct nlattr *infoattr; 10456 10457 /* skip radio stats if userspace didn't request them */ 10458 if (!survey->channel && !allow_radio_stats) 10459 return 0; 10460 10461 hdr = nl80211hdr_put(msg, portid, seq, flags, 10462 NL80211_CMD_NEW_SURVEY_RESULTS); 10463 if (!hdr) 10464 return -ENOMEM; 10465 10466 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 10467 goto nla_put_failure; 10468 10469 infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO); 10470 if (!infoattr) 10471 goto nla_put_failure; 10472 10473 if (survey->channel && 10474 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY, 10475 survey->channel->center_freq)) 10476 goto nla_put_failure; 10477 10478 if (survey->channel && survey->channel->freq_offset && 10479 nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET, 10480 survey->channel->freq_offset)) 10481 goto nla_put_failure; 10482 10483 if ((survey->filled & SURVEY_INFO_NOISE_DBM) && 10484 nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise)) 10485 goto nla_put_failure; 10486 if ((survey->filled & SURVEY_INFO_IN_USE) && 10487 nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE)) 10488 goto nla_put_failure; 10489 if ((survey->filled & SURVEY_INFO_TIME) && 10490 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME, 10491 survey->time, NL80211_SURVEY_INFO_PAD)) 10492 goto nla_put_failure; 10493 if ((survey->filled & SURVEY_INFO_TIME_BUSY) && 10494 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY, 10495 survey->time_busy, NL80211_SURVEY_INFO_PAD)) 10496 goto nla_put_failure; 10497 if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) && 10498 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY, 10499 survey->time_ext_busy, NL80211_SURVEY_INFO_PAD)) 10500 goto nla_put_failure; 10501 if ((survey->filled & SURVEY_INFO_TIME_RX) && 10502 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX, 10503 survey->time_rx, NL80211_SURVEY_INFO_PAD)) 10504 goto nla_put_failure; 10505 if ((survey->filled & SURVEY_INFO_TIME_TX) && 10506 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX, 10507 survey->time_tx, NL80211_SURVEY_INFO_PAD)) 10508 goto nla_put_failure; 10509 if ((survey->filled & SURVEY_INFO_TIME_SCAN) && 10510 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN, 10511 survey->time_scan, NL80211_SURVEY_INFO_PAD)) 10512 goto nla_put_failure; 10513 if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) && 10514 nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX, 10515 survey->time_bss_rx, NL80211_SURVEY_INFO_PAD)) 10516 goto nla_put_failure; 10517 10518 nla_nest_end(msg, infoattr); 10519 10520 genlmsg_end(msg, hdr); 10521 return 0; 10522 10523 nla_put_failure: 10524 genlmsg_cancel(msg, hdr); 10525 return -EMSGSIZE; 10526 } 10527 10528 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb) 10529 { 10530 struct nlattr **attrbuf; 10531 struct survey_info survey; 10532 struct cfg80211_registered_device *rdev; 10533 struct wireless_dev *wdev; 10534 int survey_idx = cb->args[2]; 10535 int res; 10536 bool radio_stats; 10537 10538 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 10539 if (!attrbuf) 10540 return -ENOMEM; 10541 10542 res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf); 10543 if (res) { 10544 kfree(attrbuf); 10545 return res; 10546 } 10547 /* nl80211_prepare_wdev_dump acquired it in the successful case */ 10548 __acquire(&rdev->wiphy.mtx); 10549 10550 /* prepare_wdev_dump parsed the attributes */ 10551 radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS]; 10552 10553 if (!wdev->netdev) { 10554 res = -EINVAL; 10555 goto out_err; 10556 } 10557 10558 if (!rdev->ops->dump_survey) { 10559 res = -EOPNOTSUPP; 10560 goto out_err; 10561 } 10562 10563 while (1) { 10564 wdev_lock(wdev); 10565 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey); 10566 wdev_unlock(wdev); 10567 if (res == -ENOENT) 10568 break; 10569 if (res) 10570 goto out_err; 10571 10572 /* don't send disabled channels, but do send non-channel data */ 10573 if (survey.channel && 10574 survey.channel->flags & IEEE80211_CHAN_DISABLED) { 10575 survey_idx++; 10576 continue; 10577 } 10578 10579 if (nl80211_send_survey(skb, 10580 NETLINK_CB(cb->skb).portid, 10581 cb->nlh->nlmsg_seq, NLM_F_MULTI, 10582 wdev->netdev, radio_stats, &survey) < 0) 10583 goto out; 10584 survey_idx++; 10585 } 10586 10587 out: 10588 cb->args[2] = survey_idx; 10589 res = skb->len; 10590 out_err: 10591 kfree(attrbuf); 10592 wiphy_unlock(&rdev->wiphy); 10593 return res; 10594 } 10595 10596 static bool nl80211_valid_wpa_versions(u32 wpa_versions) 10597 { 10598 return !(wpa_versions & ~(NL80211_WPA_VERSION_1 | 10599 NL80211_WPA_VERSION_2 | 10600 NL80211_WPA_VERSION_3)); 10601 } 10602 10603 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info) 10604 { 10605 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10606 struct net_device *dev = info->user_ptr[1]; 10607 struct ieee80211_channel *chan; 10608 const u8 *bssid, *ssid; 10609 int err, ssid_len; 10610 enum nl80211_auth_type auth_type; 10611 struct key_parse key; 10612 bool local_state_change; 10613 struct cfg80211_auth_request req = {}; 10614 u32 freq; 10615 10616 if (!info->attrs[NL80211_ATTR_MAC]) 10617 return -EINVAL; 10618 10619 if (!info->attrs[NL80211_ATTR_AUTH_TYPE]) 10620 return -EINVAL; 10621 10622 if (!info->attrs[NL80211_ATTR_SSID]) 10623 return -EINVAL; 10624 10625 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 10626 return -EINVAL; 10627 10628 err = nl80211_parse_key(info, &key); 10629 if (err) 10630 return err; 10631 10632 if (key.idx >= 0) { 10633 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP) 10634 return -EINVAL; 10635 if (!key.p.key || !key.p.key_len) 10636 return -EINVAL; 10637 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 || 10638 key.p.key_len != WLAN_KEY_LEN_WEP40) && 10639 (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 || 10640 key.p.key_len != WLAN_KEY_LEN_WEP104)) 10641 return -EINVAL; 10642 if (key.idx > 3) 10643 return -EINVAL; 10644 } else { 10645 key.p.key_len = 0; 10646 key.p.key = NULL; 10647 } 10648 10649 if (key.idx >= 0) { 10650 int i; 10651 bool ok = false; 10652 10653 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) { 10654 if (key.p.cipher == rdev->wiphy.cipher_suites[i]) { 10655 ok = true; 10656 break; 10657 } 10658 } 10659 if (!ok) 10660 return -EINVAL; 10661 } 10662 10663 if (!rdev->ops->auth) 10664 return -EOPNOTSUPP; 10665 10666 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10667 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10668 return -EOPNOTSUPP; 10669 10670 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 10671 freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ])); 10672 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 10673 freq += 10674 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 10675 10676 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 10677 if (!chan) 10678 return -EINVAL; 10679 10680 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10681 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10682 10683 if (info->attrs[NL80211_ATTR_IE]) { 10684 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10685 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10686 } 10687 10688 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 10689 if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE)) 10690 return -EINVAL; 10691 10692 if ((auth_type == NL80211_AUTHTYPE_SAE || 10693 auth_type == NL80211_AUTHTYPE_FILS_SK || 10694 auth_type == NL80211_AUTHTYPE_FILS_SK_PFS || 10695 auth_type == NL80211_AUTHTYPE_FILS_PK) && 10696 !info->attrs[NL80211_ATTR_AUTH_DATA]) 10697 return -EINVAL; 10698 10699 if (info->attrs[NL80211_ATTR_AUTH_DATA]) { 10700 if (auth_type != NL80211_AUTHTYPE_SAE && 10701 auth_type != NL80211_AUTHTYPE_FILS_SK && 10702 auth_type != NL80211_AUTHTYPE_FILS_SK_PFS && 10703 auth_type != NL80211_AUTHTYPE_FILS_PK) 10704 return -EINVAL; 10705 req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]); 10706 req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]); 10707 } 10708 10709 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 10710 10711 /* 10712 * Since we no longer track auth state, ignore 10713 * requests to only change local state. 10714 */ 10715 if (local_state_change) 10716 return 0; 10717 10718 req.auth_type = auth_type; 10719 req.key = key.p.key; 10720 req.key_len = key.p.key_len; 10721 req.key_idx = key.idx; 10722 req.link_id = nl80211_link_id_or_invalid(info->attrs); 10723 if (req.link_id >= 0) { 10724 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 10725 return -EINVAL; 10726 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 10727 return -EINVAL; 10728 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 10729 if (!is_valid_ether_addr(req.ap_mld_addr)) 10730 return -EINVAL; 10731 } 10732 10733 req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, 10734 IEEE80211_BSS_TYPE_ESS, 10735 IEEE80211_PRIVACY_ANY); 10736 if (!req.bss) 10737 return -ENOENT; 10738 10739 wdev_lock(dev->ieee80211_ptr); 10740 err = cfg80211_mlme_auth(rdev, dev, &req); 10741 wdev_unlock(dev->ieee80211_ptr); 10742 10743 cfg80211_put_bss(&rdev->wiphy, req.bss); 10744 10745 return err; 10746 } 10747 10748 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev, 10749 struct genl_info *info) 10750 { 10751 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 10752 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set"); 10753 return -EINVAL; 10754 } 10755 10756 if (!rdev->ops->tx_control_port || 10757 !wiphy_ext_feature_isset(&rdev->wiphy, 10758 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 10759 return -EOPNOTSUPP; 10760 10761 return 0; 10762 } 10763 10764 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev, 10765 struct genl_info *info, 10766 struct cfg80211_crypto_settings *settings, 10767 int cipher_limit) 10768 { 10769 memset(settings, 0, sizeof(*settings)); 10770 10771 settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT]; 10772 10773 if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 10774 u16 proto; 10775 10776 proto = nla_get_u16( 10777 info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 10778 settings->control_port_ethertype = cpu_to_be16(proto); 10779 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) && 10780 proto != ETH_P_PAE) 10781 return -EINVAL; 10782 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]) 10783 settings->control_port_no_encrypt = true; 10784 } else 10785 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE); 10786 10787 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 10788 int r = validate_pae_over_nl80211(rdev, info); 10789 10790 if (r < 0) 10791 return r; 10792 10793 settings->control_port_over_nl80211 = true; 10794 10795 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH]) 10796 settings->control_port_no_preauth = true; 10797 } 10798 10799 if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) { 10800 void *data; 10801 int len, i; 10802 10803 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 10804 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]); 10805 settings->n_ciphers_pairwise = len / sizeof(u32); 10806 10807 if (len % sizeof(u32)) 10808 return -EINVAL; 10809 10810 if (settings->n_ciphers_pairwise > cipher_limit) 10811 return -EINVAL; 10812 10813 memcpy(settings->ciphers_pairwise, data, len); 10814 10815 for (i = 0; i < settings->n_ciphers_pairwise; i++) 10816 if (!cfg80211_supported_cipher_suite( 10817 &rdev->wiphy, 10818 settings->ciphers_pairwise[i])) 10819 return -EINVAL; 10820 } 10821 10822 if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) { 10823 settings->cipher_group = 10824 nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]); 10825 if (!cfg80211_supported_cipher_suite(&rdev->wiphy, 10826 settings->cipher_group)) 10827 return -EINVAL; 10828 } 10829 10830 if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) { 10831 settings->wpa_versions = 10832 nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]); 10833 if (!nl80211_valid_wpa_versions(settings->wpa_versions)) 10834 return -EINVAL; 10835 } 10836 10837 if (info->attrs[NL80211_ATTR_AKM_SUITES]) { 10838 void *data; 10839 int len; 10840 10841 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]); 10842 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]); 10843 settings->n_akm_suites = len / sizeof(u32); 10844 10845 if (len % sizeof(u32)) 10846 return -EINVAL; 10847 10848 if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites) 10849 return -EINVAL; 10850 10851 memcpy(settings->akm_suites, data, len); 10852 } 10853 10854 if (info->attrs[NL80211_ATTR_PMK]) { 10855 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN) 10856 return -EINVAL; 10857 if (!wiphy_ext_feature_isset(&rdev->wiphy, 10858 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) && 10859 !wiphy_ext_feature_isset(&rdev->wiphy, 10860 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK)) 10861 return -EINVAL; 10862 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]); 10863 } 10864 10865 if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) { 10866 if (!wiphy_ext_feature_isset(&rdev->wiphy, 10867 NL80211_EXT_FEATURE_SAE_OFFLOAD) && 10868 !wiphy_ext_feature_isset(&rdev->wiphy, 10869 NL80211_EXT_FEATURE_SAE_OFFLOAD_AP)) 10870 return -EINVAL; 10871 settings->sae_pwd = 10872 nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 10873 settings->sae_pwd_len = 10874 nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]); 10875 } 10876 10877 if (info->attrs[NL80211_ATTR_SAE_PWE]) 10878 settings->sae_pwe = 10879 nla_get_u8(info->attrs[NL80211_ATTR_SAE_PWE]); 10880 else 10881 settings->sae_pwe = NL80211_SAE_PWE_UNSPECIFIED; 10882 10883 return 0; 10884 } 10885 10886 static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev, 10887 const u8 *ssid, int ssid_len, 10888 struct nlattr **attrs) 10889 { 10890 struct ieee80211_channel *chan; 10891 struct cfg80211_bss *bss; 10892 const u8 *bssid; 10893 u32 freq; 10894 10895 if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ]) 10896 return ERR_PTR(-EINVAL); 10897 10898 bssid = nla_data(attrs[NL80211_ATTR_MAC]); 10899 10900 freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ])); 10901 if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 10902 freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 10903 10904 chan = nl80211_get_valid_chan(&rdev->wiphy, freq); 10905 if (!chan) 10906 return ERR_PTR(-EINVAL); 10907 10908 bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, 10909 ssid, ssid_len, 10910 IEEE80211_BSS_TYPE_ESS, 10911 IEEE80211_PRIVACY_ANY); 10912 if (!bss) 10913 return ERR_PTR(-ENOENT); 10914 10915 return bss; 10916 } 10917 10918 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info) 10919 { 10920 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 10921 struct net_device *dev = info->user_ptr[1]; 10922 struct cfg80211_assoc_request req = {}; 10923 struct nlattr **attrs = NULL; 10924 const u8 *ap_addr, *ssid; 10925 unsigned int link_id; 10926 int err, ssid_len; 10927 10928 if (dev->ieee80211_ptr->conn_owner_nlportid && 10929 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 10930 return -EPERM; 10931 10932 if (!info->attrs[NL80211_ATTR_SSID]) 10933 return -EINVAL; 10934 10935 if (!rdev->ops->assoc) 10936 return -EOPNOTSUPP; 10937 10938 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 10939 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 10940 return -EOPNOTSUPP; 10941 10942 ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 10943 ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 10944 10945 if (info->attrs[NL80211_ATTR_IE]) { 10946 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 10947 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 10948 10949 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 10950 req.ie, req.ie_len)) { 10951 GENL_SET_ERR_MSG(info, 10952 "non-inheritance makes no sense"); 10953 return -EINVAL; 10954 } 10955 } 10956 10957 if (info->attrs[NL80211_ATTR_USE_MFP]) { 10958 enum nl80211_mfp mfp = 10959 nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 10960 if (mfp == NL80211_MFP_REQUIRED) 10961 req.use_mfp = true; 10962 else if (mfp != NL80211_MFP_NO) 10963 return -EINVAL; 10964 } 10965 10966 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 10967 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 10968 10969 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 10970 req.flags |= ASSOC_REQ_DISABLE_HT; 10971 10972 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 10973 memcpy(&req.ht_capa_mask, 10974 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 10975 sizeof(req.ht_capa_mask)); 10976 10977 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 10978 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 10979 return -EINVAL; 10980 memcpy(&req.ht_capa, 10981 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 10982 sizeof(req.ht_capa)); 10983 } 10984 10985 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 10986 req.flags |= ASSOC_REQ_DISABLE_VHT; 10987 10988 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 10989 req.flags |= ASSOC_REQ_DISABLE_HE; 10990 10991 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 10992 req.flags |= ASSOC_REQ_DISABLE_EHT; 10993 10994 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 10995 memcpy(&req.vht_capa_mask, 10996 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 10997 sizeof(req.vht_capa_mask)); 10998 10999 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 11000 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11001 return -EINVAL; 11002 memcpy(&req.vht_capa, 11003 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 11004 sizeof(req.vht_capa)); 11005 } 11006 11007 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 11008 if (!((rdev->wiphy.features & 11009 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 11010 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 11011 !wiphy_ext_feature_isset(&rdev->wiphy, 11012 NL80211_EXT_FEATURE_RRM)) 11013 return -EINVAL; 11014 req.flags |= ASSOC_REQ_USE_RRM; 11015 } 11016 11017 if (info->attrs[NL80211_ATTR_FILS_KEK]) { 11018 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 11019 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 11020 if (!info->attrs[NL80211_ATTR_FILS_NONCES]) 11021 return -EINVAL; 11022 req.fils_nonces = 11023 nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 11024 } 11025 11026 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) { 11027 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY]) 11028 return -EINVAL; 11029 memcpy(&req.s1g_capa_mask, 11030 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]), 11031 sizeof(req.s1g_capa_mask)); 11032 } 11033 11034 if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) { 11035 if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) 11036 return -EINVAL; 11037 memcpy(&req.s1g_capa, 11038 nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]), 11039 sizeof(req.s1g_capa)); 11040 } 11041 11042 req.link_id = nl80211_link_id_or_invalid(info->attrs); 11043 11044 if (info->attrs[NL80211_ATTR_MLO_LINKS]) { 11045 unsigned int attrsize = NUM_NL80211_ATTR * sizeof(*attrs); 11046 struct nlattr *link; 11047 int rem = 0; 11048 11049 if (req.link_id < 0) 11050 return -EINVAL; 11051 11052 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)) 11053 return -EINVAL; 11054 11055 if (info->attrs[NL80211_ATTR_MAC] || 11056 info->attrs[NL80211_ATTR_WIPHY_FREQ] || 11057 !info->attrs[NL80211_ATTR_MLD_ADDR]) 11058 return -EINVAL; 11059 11060 req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 11061 ap_addr = req.ap_mld_addr; 11062 11063 attrs = kzalloc(attrsize, GFP_KERNEL); 11064 if (!attrs) 11065 return -ENOMEM; 11066 11067 nla_for_each_nested(link, 11068 info->attrs[NL80211_ATTR_MLO_LINKS], 11069 rem) { 11070 memset(attrs, 0, attrsize); 11071 11072 nla_parse_nested(attrs, NL80211_ATTR_MAX, 11073 link, NULL, NULL); 11074 11075 if (!attrs[NL80211_ATTR_MLO_LINK_ID]) { 11076 err = -EINVAL; 11077 goto free; 11078 } 11079 11080 link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]); 11081 /* cannot use the same link ID again */ 11082 if (req.links[link_id].bss) { 11083 err = -EINVAL; 11084 goto free; 11085 } 11086 req.links[link_id].bss = 11087 nl80211_assoc_bss(rdev, ssid, ssid_len, attrs); 11088 if (IS_ERR(req.links[link_id].bss)) { 11089 err = PTR_ERR(req.links[link_id].bss); 11090 req.links[link_id].bss = NULL; 11091 goto free; 11092 } 11093 11094 if (attrs[NL80211_ATTR_IE]) { 11095 req.links[link_id].elems = 11096 nla_data(attrs[NL80211_ATTR_IE]); 11097 req.links[link_id].elems_len = 11098 nla_len(attrs[NL80211_ATTR_IE]); 11099 11100 if (cfg80211_find_elem(WLAN_EID_FRAGMENT, 11101 req.links[link_id].elems, 11102 req.links[link_id].elems_len)) { 11103 GENL_SET_ERR_MSG(info, 11104 "cannot deal with fragmentation"); 11105 err = -EINVAL; 11106 goto free; 11107 } 11108 11109 if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE, 11110 req.links[link_id].elems, 11111 req.links[link_id].elems_len)) { 11112 GENL_SET_ERR_MSG(info, 11113 "cannot deal with non-inheritance"); 11114 err = -EINVAL; 11115 goto free; 11116 } 11117 } 11118 } 11119 11120 if (!req.links[req.link_id].bss) { 11121 err = -EINVAL; 11122 goto free; 11123 } 11124 11125 if (req.links[req.link_id].elems_len) { 11126 GENL_SET_ERR_MSG(info, 11127 "cannot have per-link elems on assoc link"); 11128 err = -EINVAL; 11129 goto free; 11130 } 11131 11132 kfree(attrs); 11133 attrs = NULL; 11134 } else { 11135 if (req.link_id >= 0) 11136 return -EINVAL; 11137 11138 req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs); 11139 if (IS_ERR(req.bss)) 11140 return PTR_ERR(req.bss); 11141 ap_addr = req.bss->bssid; 11142 } 11143 11144 err = nl80211_crypto_settings(rdev, info, &req.crypto, 1); 11145 if (!err) { 11146 wdev_lock(dev->ieee80211_ptr); 11147 11148 err = cfg80211_mlme_assoc(rdev, dev, &req); 11149 11150 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 11151 dev->ieee80211_ptr->conn_owner_nlportid = 11152 info->snd_portid; 11153 memcpy(dev->ieee80211_ptr->disconnect_bssid, 11154 ap_addr, ETH_ALEN); 11155 } 11156 11157 wdev_unlock(dev->ieee80211_ptr); 11158 } 11159 11160 free: 11161 for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++) 11162 cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss); 11163 cfg80211_put_bss(&rdev->wiphy, req.bss); 11164 kfree(attrs); 11165 11166 return err; 11167 } 11168 11169 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info) 11170 { 11171 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11172 struct net_device *dev = info->user_ptr[1]; 11173 const u8 *ie = NULL, *bssid; 11174 int ie_len = 0, err; 11175 u16 reason_code; 11176 bool local_state_change; 11177 11178 if (dev->ieee80211_ptr->conn_owner_nlportid && 11179 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11180 return -EPERM; 11181 11182 if (!info->attrs[NL80211_ATTR_MAC]) 11183 return -EINVAL; 11184 11185 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11186 return -EINVAL; 11187 11188 if (!rdev->ops->deauth) 11189 return -EOPNOTSUPP; 11190 11191 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11192 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11193 return -EOPNOTSUPP; 11194 11195 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11196 11197 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11198 if (reason_code == 0) { 11199 /* Reason Code 0 is reserved */ 11200 return -EINVAL; 11201 } 11202 11203 if (info->attrs[NL80211_ATTR_IE]) { 11204 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11205 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11206 } 11207 11208 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11209 11210 wdev_lock(dev->ieee80211_ptr); 11211 err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code, 11212 local_state_change); 11213 wdev_unlock(dev->ieee80211_ptr); 11214 return err; 11215 } 11216 11217 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info) 11218 { 11219 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11220 struct net_device *dev = info->user_ptr[1]; 11221 const u8 *ie = NULL, *bssid; 11222 int ie_len = 0, err; 11223 u16 reason_code; 11224 bool local_state_change; 11225 11226 if (dev->ieee80211_ptr->conn_owner_nlportid && 11227 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 11228 return -EPERM; 11229 11230 if (!info->attrs[NL80211_ATTR_MAC]) 11231 return -EINVAL; 11232 11233 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 11234 return -EINVAL; 11235 11236 if (!rdev->ops->disassoc) 11237 return -EOPNOTSUPP; 11238 11239 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11240 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11241 return -EOPNOTSUPP; 11242 11243 bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11244 11245 reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 11246 if (reason_code == 0) { 11247 /* Reason Code 0 is reserved */ 11248 return -EINVAL; 11249 } 11250 11251 if (info->attrs[NL80211_ATTR_IE]) { 11252 ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11253 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11254 } 11255 11256 local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE]; 11257 11258 wdev_lock(dev->ieee80211_ptr); 11259 err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code, 11260 local_state_change); 11261 wdev_unlock(dev->ieee80211_ptr); 11262 return err; 11263 } 11264 11265 static bool 11266 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev, 11267 int mcast_rate[NUM_NL80211_BANDS], 11268 int rateval) 11269 { 11270 struct wiphy *wiphy = &rdev->wiphy; 11271 bool found = false; 11272 int band, i; 11273 11274 for (band = 0; band < NUM_NL80211_BANDS; band++) { 11275 struct ieee80211_supported_band *sband; 11276 11277 sband = wiphy->bands[band]; 11278 if (!sband) 11279 continue; 11280 11281 for (i = 0; i < sband->n_bitrates; i++) { 11282 if (sband->bitrates[i].bitrate == rateval) { 11283 mcast_rate[band] = i + 1; 11284 found = true; 11285 break; 11286 } 11287 } 11288 } 11289 11290 return found; 11291 } 11292 11293 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info) 11294 { 11295 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11296 struct net_device *dev = info->user_ptr[1]; 11297 struct cfg80211_ibss_params ibss; 11298 struct wiphy *wiphy; 11299 struct cfg80211_cached_keys *connkeys = NULL; 11300 int err; 11301 11302 memset(&ibss, 0, sizeof(ibss)); 11303 11304 if (!info->attrs[NL80211_ATTR_SSID] || 11305 !nla_len(info->attrs[NL80211_ATTR_SSID])) 11306 return -EINVAL; 11307 11308 ibss.beacon_interval = 100; 11309 11310 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) 11311 ibss.beacon_interval = 11312 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 11313 11314 err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC, 11315 ibss.beacon_interval); 11316 if (err) 11317 return err; 11318 11319 if (!rdev->ops->join_ibss) 11320 return -EOPNOTSUPP; 11321 11322 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11323 return -EOPNOTSUPP; 11324 11325 wiphy = &rdev->wiphy; 11326 11327 if (info->attrs[NL80211_ATTR_MAC]) { 11328 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11329 11330 if (!is_valid_ether_addr(ibss.bssid)) 11331 return -EINVAL; 11332 } 11333 ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11334 ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11335 11336 if (info->attrs[NL80211_ATTR_IE]) { 11337 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11338 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11339 } 11340 11341 err = nl80211_parse_chandef(rdev, info, &ibss.chandef); 11342 if (err) 11343 return err; 11344 11345 if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef, 11346 NL80211_IFTYPE_ADHOC)) 11347 return -EINVAL; 11348 11349 switch (ibss.chandef.width) { 11350 case NL80211_CHAN_WIDTH_5: 11351 case NL80211_CHAN_WIDTH_10: 11352 case NL80211_CHAN_WIDTH_20_NOHT: 11353 break; 11354 case NL80211_CHAN_WIDTH_20: 11355 case NL80211_CHAN_WIDTH_40: 11356 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11357 return -EINVAL; 11358 break; 11359 case NL80211_CHAN_WIDTH_80: 11360 case NL80211_CHAN_WIDTH_80P80: 11361 case NL80211_CHAN_WIDTH_160: 11362 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS)) 11363 return -EINVAL; 11364 if (!wiphy_ext_feature_isset(&rdev->wiphy, 11365 NL80211_EXT_FEATURE_VHT_IBSS)) 11366 return -EINVAL; 11367 break; 11368 case NL80211_CHAN_WIDTH_320: 11369 return -EINVAL; 11370 default: 11371 return -EINVAL; 11372 } 11373 11374 ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED]; 11375 ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY]; 11376 11377 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 11378 u8 *rates = 11379 nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11380 int n_rates = 11381 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 11382 struct ieee80211_supported_band *sband = 11383 wiphy->bands[ibss.chandef.chan->band]; 11384 11385 err = ieee80211_get_ratemask(sband, rates, n_rates, 11386 &ibss.basic_rates); 11387 if (err) 11388 return err; 11389 } 11390 11391 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11392 memcpy(&ibss.ht_capa_mask, 11393 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11394 sizeof(ibss.ht_capa_mask)); 11395 11396 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11397 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11398 return -EINVAL; 11399 memcpy(&ibss.ht_capa, 11400 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11401 sizeof(ibss.ht_capa)); 11402 } 11403 11404 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 11405 !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate, 11406 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 11407 return -EINVAL; 11408 11409 if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) { 11410 bool no_ht = false; 11411 11412 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht); 11413 if (IS_ERR(connkeys)) 11414 return PTR_ERR(connkeys); 11415 11416 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) && 11417 no_ht) { 11418 kfree_sensitive(connkeys); 11419 return -EINVAL; 11420 } 11421 } 11422 11423 ibss.control_port = 11424 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]); 11425 11426 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 11427 int r = validate_pae_over_nl80211(rdev, info); 11428 11429 if (r < 0) { 11430 kfree_sensitive(connkeys); 11431 return r; 11432 } 11433 11434 ibss.control_port_over_nl80211 = true; 11435 } 11436 11437 ibss.userspace_handles_dfs = 11438 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 11439 11440 wdev_lock(dev->ieee80211_ptr); 11441 err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys); 11442 if (err) 11443 kfree_sensitive(connkeys); 11444 else if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) 11445 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 11446 wdev_unlock(dev->ieee80211_ptr); 11447 11448 return err; 11449 } 11450 11451 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info) 11452 { 11453 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11454 struct net_device *dev = info->user_ptr[1]; 11455 11456 if (!rdev->ops->leave_ibss) 11457 return -EOPNOTSUPP; 11458 11459 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC) 11460 return -EOPNOTSUPP; 11461 11462 return cfg80211_leave_ibss(rdev, dev, false); 11463 } 11464 11465 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info) 11466 { 11467 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11468 struct net_device *dev = info->user_ptr[1]; 11469 int mcast_rate[NUM_NL80211_BANDS]; 11470 u32 nla_rate; 11471 11472 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC && 11473 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT && 11474 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB) 11475 return -EOPNOTSUPP; 11476 11477 if (!rdev->ops->set_mcast_rate) 11478 return -EOPNOTSUPP; 11479 11480 memset(mcast_rate, 0, sizeof(mcast_rate)); 11481 11482 if (!info->attrs[NL80211_ATTR_MCAST_RATE]) 11483 return -EINVAL; 11484 11485 nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]); 11486 if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate)) 11487 return -EINVAL; 11488 11489 return rdev_set_mcast_rate(rdev, dev, mcast_rate); 11490 } 11491 11492 static struct sk_buff * 11493 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev, 11494 struct wireless_dev *wdev, int approxlen, 11495 u32 portid, u32 seq, enum nl80211_commands cmd, 11496 enum nl80211_attrs attr, 11497 const struct nl80211_vendor_cmd_info *info, 11498 gfp_t gfp) 11499 { 11500 struct sk_buff *skb; 11501 void *hdr; 11502 struct nlattr *data; 11503 11504 skb = nlmsg_new(approxlen + 100, gfp); 11505 if (!skb) 11506 return NULL; 11507 11508 hdr = nl80211hdr_put(skb, portid, seq, 0, cmd); 11509 if (!hdr) { 11510 kfree_skb(skb); 11511 return NULL; 11512 } 11513 11514 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 11515 goto nla_put_failure; 11516 11517 if (info) { 11518 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID, 11519 info->vendor_id)) 11520 goto nla_put_failure; 11521 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD, 11522 info->subcmd)) 11523 goto nla_put_failure; 11524 } 11525 11526 if (wdev) { 11527 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 11528 wdev_id(wdev), NL80211_ATTR_PAD)) 11529 goto nla_put_failure; 11530 if (wdev->netdev && 11531 nla_put_u32(skb, NL80211_ATTR_IFINDEX, 11532 wdev->netdev->ifindex)) 11533 goto nla_put_failure; 11534 } 11535 11536 data = nla_nest_start_noflag(skb, attr); 11537 if (!data) 11538 goto nla_put_failure; 11539 11540 ((void **)skb->cb)[0] = rdev; 11541 ((void **)skb->cb)[1] = hdr; 11542 ((void **)skb->cb)[2] = data; 11543 11544 return skb; 11545 11546 nla_put_failure: 11547 kfree_skb(skb); 11548 return NULL; 11549 } 11550 11551 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy, 11552 struct wireless_dev *wdev, 11553 enum nl80211_commands cmd, 11554 enum nl80211_attrs attr, 11555 unsigned int portid, 11556 int vendor_event_idx, 11557 int approxlen, gfp_t gfp) 11558 { 11559 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 11560 const struct nl80211_vendor_cmd_info *info; 11561 11562 switch (cmd) { 11563 case NL80211_CMD_TESTMODE: 11564 if (WARN_ON(vendor_event_idx != -1)) 11565 return NULL; 11566 info = NULL; 11567 break; 11568 case NL80211_CMD_VENDOR: 11569 if (WARN_ON(vendor_event_idx < 0 || 11570 vendor_event_idx >= wiphy->n_vendor_events)) 11571 return NULL; 11572 info = &wiphy->vendor_events[vendor_event_idx]; 11573 break; 11574 default: 11575 WARN_ON(1); 11576 return NULL; 11577 } 11578 11579 return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0, 11580 cmd, attr, info, gfp); 11581 } 11582 EXPORT_SYMBOL(__cfg80211_alloc_event_skb); 11583 11584 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp) 11585 { 11586 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 11587 void *hdr = ((void **)skb->cb)[1]; 11588 struct nlmsghdr *nlhdr = nlmsg_hdr(skb); 11589 struct nlattr *data = ((void **)skb->cb)[2]; 11590 enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE; 11591 11592 /* clear CB data for netlink core to own from now on */ 11593 memset(skb->cb, 0, sizeof(skb->cb)); 11594 11595 nla_nest_end(skb, data); 11596 genlmsg_end(skb, hdr); 11597 11598 if (nlhdr->nlmsg_pid) { 11599 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb, 11600 nlhdr->nlmsg_pid); 11601 } else { 11602 if (data->nla_type == NL80211_ATTR_VENDOR_DATA) 11603 mcgrp = NL80211_MCGRP_VENDOR; 11604 11605 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 11606 skb, 0, mcgrp, gfp); 11607 } 11608 } 11609 EXPORT_SYMBOL(__cfg80211_send_event_skb); 11610 11611 #ifdef CONFIG_NL80211_TESTMODE 11612 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info) 11613 { 11614 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11615 struct wireless_dev *wdev; 11616 int err; 11617 11618 lockdep_assert_held(&rdev->wiphy.mtx); 11619 11620 wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 11621 info->attrs); 11622 11623 if (!rdev->ops->testmode_cmd) 11624 return -EOPNOTSUPP; 11625 11626 if (IS_ERR(wdev)) { 11627 err = PTR_ERR(wdev); 11628 if (err != -EINVAL) 11629 return err; 11630 wdev = NULL; 11631 } else if (wdev->wiphy != &rdev->wiphy) { 11632 return -EINVAL; 11633 } 11634 11635 if (!info->attrs[NL80211_ATTR_TESTDATA]) 11636 return -EINVAL; 11637 11638 rdev->cur_cmd_info = info; 11639 err = rdev_testmode_cmd(rdev, wdev, 11640 nla_data(info->attrs[NL80211_ATTR_TESTDATA]), 11641 nla_len(info->attrs[NL80211_ATTR_TESTDATA])); 11642 rdev->cur_cmd_info = NULL; 11643 11644 return err; 11645 } 11646 11647 static int nl80211_testmode_dump(struct sk_buff *skb, 11648 struct netlink_callback *cb) 11649 { 11650 struct cfg80211_registered_device *rdev; 11651 struct nlattr **attrbuf = NULL; 11652 int err; 11653 long phy_idx; 11654 void *data = NULL; 11655 int data_len = 0; 11656 11657 rtnl_lock(); 11658 11659 if (cb->args[0]) { 11660 /* 11661 * 0 is a valid index, but not valid for args[0], 11662 * so we need to offset by 1. 11663 */ 11664 phy_idx = cb->args[0] - 1; 11665 11666 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx); 11667 if (!rdev) { 11668 err = -ENOENT; 11669 goto out_err; 11670 } 11671 } else { 11672 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), 11673 GFP_KERNEL); 11674 if (!attrbuf) { 11675 err = -ENOMEM; 11676 goto out_err; 11677 } 11678 11679 err = nlmsg_parse_deprecated(cb->nlh, 11680 GENL_HDRLEN + nl80211_fam.hdrsize, 11681 attrbuf, nl80211_fam.maxattr, 11682 nl80211_policy, NULL); 11683 if (err) 11684 goto out_err; 11685 11686 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 11687 if (IS_ERR(rdev)) { 11688 err = PTR_ERR(rdev); 11689 goto out_err; 11690 } 11691 phy_idx = rdev->wiphy_idx; 11692 11693 if (attrbuf[NL80211_ATTR_TESTDATA]) 11694 cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA]; 11695 } 11696 11697 if (cb->args[1]) { 11698 data = nla_data((void *)cb->args[1]); 11699 data_len = nla_len((void *)cb->args[1]); 11700 } 11701 11702 if (!rdev->ops->testmode_dump) { 11703 err = -EOPNOTSUPP; 11704 goto out_err; 11705 } 11706 11707 while (1) { 11708 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 11709 cb->nlh->nlmsg_seq, NLM_F_MULTI, 11710 NL80211_CMD_TESTMODE); 11711 struct nlattr *tmdata; 11712 11713 if (!hdr) 11714 break; 11715 11716 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) { 11717 genlmsg_cancel(skb, hdr); 11718 break; 11719 } 11720 11721 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA); 11722 if (!tmdata) { 11723 genlmsg_cancel(skb, hdr); 11724 break; 11725 } 11726 err = rdev_testmode_dump(rdev, skb, cb, data, data_len); 11727 nla_nest_end(skb, tmdata); 11728 11729 if (err == -ENOBUFS || err == -ENOENT) { 11730 genlmsg_cancel(skb, hdr); 11731 break; 11732 } else if (err) { 11733 genlmsg_cancel(skb, hdr); 11734 goto out_err; 11735 } 11736 11737 genlmsg_end(skb, hdr); 11738 } 11739 11740 err = skb->len; 11741 /* see above */ 11742 cb->args[0] = phy_idx + 1; 11743 out_err: 11744 kfree(attrbuf); 11745 rtnl_unlock(); 11746 return err; 11747 } 11748 #endif 11749 11750 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info) 11751 { 11752 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 11753 struct net_device *dev = info->user_ptr[1]; 11754 struct cfg80211_connect_params connect; 11755 struct wiphy *wiphy; 11756 struct cfg80211_cached_keys *connkeys = NULL; 11757 u32 freq = 0; 11758 int err; 11759 11760 memset(&connect, 0, sizeof(connect)); 11761 11762 if (!info->attrs[NL80211_ATTR_SSID] || 11763 !nla_len(info->attrs[NL80211_ATTR_SSID])) 11764 return -EINVAL; 11765 11766 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 11767 connect.auth_type = 11768 nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 11769 if (!nl80211_valid_auth_type(rdev, connect.auth_type, 11770 NL80211_CMD_CONNECT)) 11771 return -EINVAL; 11772 } else 11773 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC; 11774 11775 connect.privacy = info->attrs[NL80211_ATTR_PRIVACY]; 11776 11777 if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] && 11778 !wiphy_ext_feature_isset(&rdev->wiphy, 11779 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 11780 return -EINVAL; 11781 connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS]; 11782 11783 err = nl80211_crypto_settings(rdev, info, &connect.crypto, 11784 NL80211_MAX_NR_CIPHER_SUITES); 11785 if (err) 11786 return err; 11787 11788 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 11789 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 11790 return -EOPNOTSUPP; 11791 11792 wiphy = &rdev->wiphy; 11793 11794 connect.bg_scan_period = -1; 11795 if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] && 11796 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) { 11797 connect.bg_scan_period = 11798 nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]); 11799 } 11800 11801 if (info->attrs[NL80211_ATTR_MAC]) 11802 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 11803 else if (info->attrs[NL80211_ATTR_MAC_HINT]) 11804 connect.bssid_hint = 11805 nla_data(info->attrs[NL80211_ATTR_MAC_HINT]); 11806 connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 11807 connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 11808 11809 if (info->attrs[NL80211_ATTR_IE]) { 11810 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 11811 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 11812 } 11813 11814 if (info->attrs[NL80211_ATTR_USE_MFP]) { 11815 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]); 11816 if (connect.mfp == NL80211_MFP_OPTIONAL && 11817 !wiphy_ext_feature_isset(&rdev->wiphy, 11818 NL80211_EXT_FEATURE_MFP_OPTIONAL)) 11819 return -EOPNOTSUPP; 11820 } else { 11821 connect.mfp = NL80211_MFP_NO; 11822 } 11823 11824 if (info->attrs[NL80211_ATTR_PREV_BSSID]) 11825 connect.prev_bssid = 11826 nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]); 11827 11828 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) 11829 freq = MHZ_TO_KHZ(nla_get_u32( 11830 info->attrs[NL80211_ATTR_WIPHY_FREQ])); 11831 if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]) 11832 freq += 11833 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]); 11834 11835 if (freq) { 11836 connect.channel = nl80211_get_valid_chan(wiphy, freq); 11837 if (!connect.channel) 11838 return -EINVAL; 11839 } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) { 11840 freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]); 11841 freq = MHZ_TO_KHZ(freq); 11842 connect.channel_hint = nl80211_get_valid_chan(wiphy, freq); 11843 if (!connect.channel_hint) 11844 return -EINVAL; 11845 } 11846 11847 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) { 11848 connect.edmg.channels = 11849 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]); 11850 11851 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]) 11852 connect.edmg.bw_config = 11853 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]); 11854 } 11855 11856 if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) { 11857 connkeys = nl80211_parse_connkeys(rdev, info, NULL); 11858 if (IS_ERR(connkeys)) 11859 return PTR_ERR(connkeys); 11860 } 11861 11862 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT])) 11863 connect.flags |= ASSOC_REQ_DISABLE_HT; 11864 11865 if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) 11866 memcpy(&connect.ht_capa_mask, 11867 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]), 11868 sizeof(connect.ht_capa_mask)); 11869 11870 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) { 11871 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) { 11872 kfree_sensitive(connkeys); 11873 return -EINVAL; 11874 } 11875 memcpy(&connect.ht_capa, 11876 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]), 11877 sizeof(connect.ht_capa)); 11878 } 11879 11880 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT])) 11881 connect.flags |= ASSOC_REQ_DISABLE_VHT; 11882 11883 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE])) 11884 connect.flags |= ASSOC_REQ_DISABLE_HE; 11885 11886 if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT])) 11887 connect.flags |= ASSOC_REQ_DISABLE_EHT; 11888 11889 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) 11890 memcpy(&connect.vht_capa_mask, 11891 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]), 11892 sizeof(connect.vht_capa_mask)); 11893 11894 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) { 11895 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) { 11896 kfree_sensitive(connkeys); 11897 return -EINVAL; 11898 } 11899 memcpy(&connect.vht_capa, 11900 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]), 11901 sizeof(connect.vht_capa)); 11902 } 11903 11904 if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) { 11905 if (!((rdev->wiphy.features & 11906 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) && 11907 (rdev->wiphy.features & NL80211_FEATURE_QUIET)) && 11908 !wiphy_ext_feature_isset(&rdev->wiphy, 11909 NL80211_EXT_FEATURE_RRM)) { 11910 kfree_sensitive(connkeys); 11911 return -EINVAL; 11912 } 11913 connect.flags |= ASSOC_REQ_USE_RRM; 11914 } 11915 11916 connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]); 11917 if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) { 11918 kfree_sensitive(connkeys); 11919 return -EOPNOTSUPP; 11920 } 11921 11922 if (info->attrs[NL80211_ATTR_BSS_SELECT]) { 11923 /* bss selection makes no sense if bssid is set */ 11924 if (connect.bssid) { 11925 kfree_sensitive(connkeys); 11926 return -EINVAL; 11927 } 11928 11929 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT], 11930 wiphy, &connect.bss_select); 11931 if (err) { 11932 kfree_sensitive(connkeys); 11933 return err; 11934 } 11935 } 11936 11937 if (wiphy_ext_feature_isset(&rdev->wiphy, 11938 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) && 11939 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 11940 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 11941 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 11942 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 11943 connect.fils_erp_username = 11944 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 11945 connect.fils_erp_username_len = 11946 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 11947 connect.fils_erp_realm = 11948 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 11949 connect.fils_erp_realm_len = 11950 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 11951 connect.fils_erp_next_seq_num = 11952 nla_get_u16( 11953 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 11954 connect.fils_erp_rrk = 11955 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 11956 connect.fils_erp_rrk_len = 11957 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 11958 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 11959 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 11960 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 11961 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 11962 kfree_sensitive(connkeys); 11963 return -EINVAL; 11964 } 11965 11966 if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) { 11967 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 11968 kfree_sensitive(connkeys); 11969 GENL_SET_ERR_MSG(info, 11970 "external auth requires connection ownership"); 11971 return -EINVAL; 11972 } 11973 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT; 11974 } 11975 11976 if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT])) 11977 connect.flags |= CONNECT_REQ_MLO_SUPPORT; 11978 11979 wdev_lock(dev->ieee80211_ptr); 11980 11981 err = cfg80211_connect(rdev, dev, &connect, connkeys, 11982 connect.prev_bssid); 11983 if (err) 11984 kfree_sensitive(connkeys); 11985 11986 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) { 11987 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 11988 if (connect.bssid) 11989 memcpy(dev->ieee80211_ptr->disconnect_bssid, 11990 connect.bssid, ETH_ALEN); 11991 else 11992 eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid); 11993 } 11994 11995 wdev_unlock(dev->ieee80211_ptr); 11996 11997 return err; 11998 } 11999 12000 static int nl80211_update_connect_params(struct sk_buff *skb, 12001 struct genl_info *info) 12002 { 12003 struct cfg80211_connect_params connect = {}; 12004 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12005 struct net_device *dev = info->user_ptr[1]; 12006 struct wireless_dev *wdev = dev->ieee80211_ptr; 12007 bool fils_sk_offload; 12008 u32 auth_type; 12009 u32 changed = 0; 12010 int ret; 12011 12012 if (!rdev->ops->update_connect_params) 12013 return -EOPNOTSUPP; 12014 12015 if (info->attrs[NL80211_ATTR_IE]) { 12016 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 12017 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 12018 changed |= UPDATE_ASSOC_IES; 12019 } 12020 12021 fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy, 12022 NL80211_EXT_FEATURE_FILS_SK_OFFLOAD); 12023 12024 /* 12025 * when driver supports fils-sk offload all attributes must be 12026 * provided. So the else covers "fils-sk-not-all" and 12027 * "no-fils-sk-any". 12028 */ 12029 if (fils_sk_offload && 12030 info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] && 12031 info->attrs[NL80211_ATTR_FILS_ERP_REALM] && 12032 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] && 12033 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12034 connect.fils_erp_username = 12035 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12036 connect.fils_erp_username_len = 12037 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]); 12038 connect.fils_erp_realm = 12039 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12040 connect.fils_erp_realm_len = 12041 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]); 12042 connect.fils_erp_next_seq_num = 12043 nla_get_u16( 12044 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]); 12045 connect.fils_erp_rrk = 12046 nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12047 connect.fils_erp_rrk_len = 12048 nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]); 12049 changed |= UPDATE_FILS_ERP_INFO; 12050 } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] || 12051 info->attrs[NL80211_ATTR_FILS_ERP_REALM] || 12052 info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] || 12053 info->attrs[NL80211_ATTR_FILS_ERP_RRK]) { 12054 return -EINVAL; 12055 } 12056 12057 if (info->attrs[NL80211_ATTR_AUTH_TYPE]) { 12058 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]); 12059 if (!nl80211_valid_auth_type(rdev, auth_type, 12060 NL80211_CMD_CONNECT)) 12061 return -EINVAL; 12062 12063 if (auth_type == NL80211_AUTHTYPE_FILS_SK && 12064 fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO)) 12065 return -EINVAL; 12066 12067 connect.auth_type = auth_type; 12068 changed |= UPDATE_AUTH_TYPE; 12069 } 12070 12071 wdev_lock(dev->ieee80211_ptr); 12072 if (!wdev->connected) 12073 ret = -ENOLINK; 12074 else 12075 ret = rdev_update_connect_params(rdev, dev, &connect, changed); 12076 wdev_unlock(dev->ieee80211_ptr); 12077 12078 return ret; 12079 } 12080 12081 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info) 12082 { 12083 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12084 struct net_device *dev = info->user_ptr[1]; 12085 u16 reason; 12086 int ret; 12087 12088 if (dev->ieee80211_ptr->conn_owner_nlportid && 12089 dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid) 12090 return -EPERM; 12091 12092 if (!info->attrs[NL80211_ATTR_REASON_CODE]) 12093 reason = WLAN_REASON_DEAUTH_LEAVING; 12094 else 12095 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]); 12096 12097 if (reason == 0) 12098 return -EINVAL; 12099 12100 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12101 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12102 return -EOPNOTSUPP; 12103 12104 wdev_lock(dev->ieee80211_ptr); 12105 ret = cfg80211_disconnect(rdev, dev, reason, true); 12106 wdev_unlock(dev->ieee80211_ptr); 12107 return ret; 12108 } 12109 12110 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info) 12111 { 12112 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12113 struct net *net; 12114 int err; 12115 12116 if (info->attrs[NL80211_ATTR_PID]) { 12117 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]); 12118 12119 net = get_net_ns_by_pid(pid); 12120 } else if (info->attrs[NL80211_ATTR_NETNS_FD]) { 12121 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]); 12122 12123 net = get_net_ns_by_fd(fd); 12124 } else { 12125 return -EINVAL; 12126 } 12127 12128 if (IS_ERR(net)) 12129 return PTR_ERR(net); 12130 12131 err = 0; 12132 12133 /* check if anything to do */ 12134 if (!net_eq(wiphy_net(&rdev->wiphy), net)) 12135 err = cfg80211_switch_netns(rdev, net); 12136 12137 put_net(net); 12138 return err; 12139 } 12140 12141 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info) 12142 { 12143 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12144 int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev, 12145 struct cfg80211_pmksa *pmksa) = NULL; 12146 struct net_device *dev = info->user_ptr[1]; 12147 struct cfg80211_pmksa pmksa; 12148 12149 memset(&pmksa, 0, sizeof(struct cfg80211_pmksa)); 12150 12151 if (!info->attrs[NL80211_ATTR_PMKID]) 12152 return -EINVAL; 12153 12154 pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 12155 12156 if (info->attrs[NL80211_ATTR_MAC]) { 12157 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]); 12158 } else if (info->attrs[NL80211_ATTR_SSID] && 12159 info->attrs[NL80211_ATTR_FILS_CACHE_ID] && 12160 (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA || 12161 info->attrs[NL80211_ATTR_PMK])) { 12162 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]); 12163 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 12164 pmksa.cache_id = 12165 nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]); 12166 } else { 12167 return -EINVAL; 12168 } 12169 if (info->attrs[NL80211_ATTR_PMK]) { 12170 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 12171 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 12172 } 12173 12174 if (info->attrs[NL80211_ATTR_PMK_LIFETIME]) 12175 pmksa.pmk_lifetime = 12176 nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]); 12177 12178 if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]) 12179 pmksa.pmk_reauth_threshold = 12180 nla_get_u8( 12181 info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]); 12182 12183 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12184 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT && 12185 !(dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP && 12186 wiphy_ext_feature_isset(&rdev->wiphy, 12187 NL80211_EXT_FEATURE_AP_PMKSA_CACHING))) 12188 return -EOPNOTSUPP; 12189 12190 switch (info->genlhdr->cmd) { 12191 case NL80211_CMD_SET_PMKSA: 12192 rdev_ops = rdev->ops->set_pmksa; 12193 break; 12194 case NL80211_CMD_DEL_PMKSA: 12195 rdev_ops = rdev->ops->del_pmksa; 12196 break; 12197 default: 12198 WARN_ON(1); 12199 break; 12200 } 12201 12202 if (!rdev_ops) 12203 return -EOPNOTSUPP; 12204 12205 return rdev_ops(&rdev->wiphy, dev, &pmksa); 12206 } 12207 12208 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info) 12209 { 12210 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12211 struct net_device *dev = info->user_ptr[1]; 12212 12213 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION && 12214 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT) 12215 return -EOPNOTSUPP; 12216 12217 if (!rdev->ops->flush_pmksa) 12218 return -EOPNOTSUPP; 12219 12220 return rdev_flush_pmksa(rdev, dev); 12221 } 12222 12223 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info) 12224 { 12225 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12226 struct net_device *dev = info->user_ptr[1]; 12227 u8 action_code, dialog_token; 12228 u32 peer_capability = 0; 12229 u16 status_code; 12230 u8 *peer; 12231 bool initiator; 12232 12233 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12234 !rdev->ops->tdls_mgmt) 12235 return -EOPNOTSUPP; 12236 12237 if (!info->attrs[NL80211_ATTR_TDLS_ACTION] || 12238 !info->attrs[NL80211_ATTR_STATUS_CODE] || 12239 !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] || 12240 !info->attrs[NL80211_ATTR_IE] || 12241 !info->attrs[NL80211_ATTR_MAC]) 12242 return -EINVAL; 12243 12244 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12245 action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]); 12246 status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 12247 dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]); 12248 initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]); 12249 if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]) 12250 peer_capability = 12251 nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]); 12252 12253 return rdev_tdls_mgmt(rdev, dev, peer, action_code, 12254 dialog_token, status_code, peer_capability, 12255 initiator, 12256 nla_data(info->attrs[NL80211_ATTR_IE]), 12257 nla_len(info->attrs[NL80211_ATTR_IE])); 12258 } 12259 12260 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info) 12261 { 12262 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12263 struct net_device *dev = info->user_ptr[1]; 12264 enum nl80211_tdls_operation operation; 12265 u8 *peer; 12266 12267 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) || 12268 !rdev->ops->tdls_oper) 12269 return -EOPNOTSUPP; 12270 12271 if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] || 12272 !info->attrs[NL80211_ATTR_MAC]) 12273 return -EINVAL; 12274 12275 operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]); 12276 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 12277 12278 return rdev_tdls_oper(rdev, dev, peer, operation); 12279 } 12280 12281 static int nl80211_remain_on_channel(struct sk_buff *skb, 12282 struct genl_info *info) 12283 { 12284 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12285 unsigned int link_id = nl80211_link_id(info->attrs); 12286 struct wireless_dev *wdev = info->user_ptr[1]; 12287 struct cfg80211_chan_def chandef; 12288 struct sk_buff *msg; 12289 void *hdr; 12290 u64 cookie; 12291 u32 duration; 12292 int err; 12293 12294 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] || 12295 !info->attrs[NL80211_ATTR_DURATION]) 12296 return -EINVAL; 12297 12298 duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12299 12300 if (!rdev->ops->remain_on_channel || 12301 !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)) 12302 return -EOPNOTSUPP; 12303 12304 /* 12305 * We should be on that channel for at least a minimum amount of 12306 * time (10ms) but no longer than the driver supports. 12307 */ 12308 if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12309 duration > rdev->wiphy.max_remain_on_channel_duration) 12310 return -EINVAL; 12311 12312 err = nl80211_parse_chandef(rdev, info, &chandef); 12313 if (err) 12314 return err; 12315 12316 wdev_lock(wdev); 12317 if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) { 12318 const struct cfg80211_chan_def *oper_chandef, *compat_chandef; 12319 12320 oper_chandef = wdev_chandef(wdev, link_id); 12321 12322 if (WARN_ON(!oper_chandef)) { 12323 /* cannot happen since we must beacon to get here */ 12324 WARN_ON(1); 12325 wdev_unlock(wdev); 12326 return -EBUSY; 12327 } 12328 12329 /* note: returns first one if identical chandefs */ 12330 compat_chandef = cfg80211_chandef_compatible(&chandef, 12331 oper_chandef); 12332 12333 if (compat_chandef != &chandef) { 12334 wdev_unlock(wdev); 12335 return -EBUSY; 12336 } 12337 } 12338 wdev_unlock(wdev); 12339 12340 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12341 if (!msg) 12342 return -ENOMEM; 12343 12344 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12345 NL80211_CMD_REMAIN_ON_CHANNEL); 12346 if (!hdr) { 12347 err = -ENOBUFS; 12348 goto free_msg; 12349 } 12350 12351 err = rdev_remain_on_channel(rdev, wdev, chandef.chan, 12352 duration, &cookie); 12353 12354 if (err) 12355 goto free_msg; 12356 12357 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12358 NL80211_ATTR_PAD)) 12359 goto nla_put_failure; 12360 12361 genlmsg_end(msg, hdr); 12362 12363 return genlmsg_reply(msg, info); 12364 12365 nla_put_failure: 12366 err = -ENOBUFS; 12367 free_msg: 12368 nlmsg_free(msg); 12369 return err; 12370 } 12371 12372 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb, 12373 struct genl_info *info) 12374 { 12375 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12376 struct wireless_dev *wdev = info->user_ptr[1]; 12377 u64 cookie; 12378 12379 if (!info->attrs[NL80211_ATTR_COOKIE]) 12380 return -EINVAL; 12381 12382 if (!rdev->ops->cancel_remain_on_channel) 12383 return -EOPNOTSUPP; 12384 12385 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12386 12387 return rdev_cancel_remain_on_channel(rdev, wdev, cookie); 12388 } 12389 12390 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb, 12391 struct genl_info *info) 12392 { 12393 struct cfg80211_bitrate_mask mask; 12394 unsigned int link_id = nl80211_link_id(info->attrs); 12395 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12396 struct net_device *dev = info->user_ptr[1]; 12397 struct wireless_dev *wdev = dev->ieee80211_ptr; 12398 int err; 12399 12400 if (!rdev->ops->set_bitrate_mask) 12401 return -EOPNOTSUPP; 12402 12403 wdev_lock(wdev); 12404 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 12405 NL80211_ATTR_TX_RATES, &mask, 12406 dev, true, link_id); 12407 if (err) 12408 goto out; 12409 12410 err = rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask); 12411 out: 12412 wdev_unlock(wdev); 12413 return err; 12414 } 12415 12416 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info) 12417 { 12418 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12419 struct wireless_dev *wdev = info->user_ptr[1]; 12420 u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION; 12421 12422 if (!info->attrs[NL80211_ATTR_FRAME_MATCH]) 12423 return -EINVAL; 12424 12425 if (info->attrs[NL80211_ATTR_FRAME_TYPE]) 12426 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]); 12427 12428 switch (wdev->iftype) { 12429 case NL80211_IFTYPE_STATION: 12430 case NL80211_IFTYPE_ADHOC: 12431 case NL80211_IFTYPE_P2P_CLIENT: 12432 case NL80211_IFTYPE_AP: 12433 case NL80211_IFTYPE_AP_VLAN: 12434 case NL80211_IFTYPE_MESH_POINT: 12435 case NL80211_IFTYPE_P2P_GO: 12436 case NL80211_IFTYPE_P2P_DEVICE: 12437 break; 12438 case NL80211_IFTYPE_NAN: 12439 if (!wiphy_ext_feature_isset(wdev->wiphy, 12440 NL80211_EXT_FEATURE_SECURE_NAN)) 12441 return -EOPNOTSUPP; 12442 break; 12443 default: 12444 return -EOPNOTSUPP; 12445 } 12446 12447 /* not much point in registering if we can't reply */ 12448 if (!rdev->ops->mgmt_tx) 12449 return -EOPNOTSUPP; 12450 12451 if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] && 12452 !wiphy_ext_feature_isset(&rdev->wiphy, 12453 NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) { 12454 GENL_SET_ERR_MSG(info, 12455 "multicast RX registrations are not supported"); 12456 return -EOPNOTSUPP; 12457 } 12458 12459 return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type, 12460 nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12461 nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]), 12462 info->attrs[NL80211_ATTR_RECEIVE_MULTICAST], 12463 info->extack); 12464 } 12465 12466 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info) 12467 { 12468 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12469 struct wireless_dev *wdev = info->user_ptr[1]; 12470 struct cfg80211_chan_def chandef; 12471 int err; 12472 void *hdr = NULL; 12473 u64 cookie; 12474 struct sk_buff *msg = NULL; 12475 struct cfg80211_mgmt_tx_params params = { 12476 .dont_wait_for_ack = 12477 info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK], 12478 }; 12479 12480 if (!info->attrs[NL80211_ATTR_FRAME]) 12481 return -EINVAL; 12482 12483 if (!rdev->ops->mgmt_tx) 12484 return -EOPNOTSUPP; 12485 12486 switch (wdev->iftype) { 12487 case NL80211_IFTYPE_P2P_DEVICE: 12488 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ]) 12489 return -EINVAL; 12490 break; 12491 case NL80211_IFTYPE_STATION: 12492 case NL80211_IFTYPE_ADHOC: 12493 case NL80211_IFTYPE_P2P_CLIENT: 12494 case NL80211_IFTYPE_AP: 12495 case NL80211_IFTYPE_AP_VLAN: 12496 case NL80211_IFTYPE_MESH_POINT: 12497 case NL80211_IFTYPE_P2P_GO: 12498 break; 12499 case NL80211_IFTYPE_NAN: 12500 if (!wiphy_ext_feature_isset(wdev->wiphy, 12501 NL80211_EXT_FEATURE_SECURE_NAN)) 12502 return -EOPNOTSUPP; 12503 break; 12504 default: 12505 return -EOPNOTSUPP; 12506 } 12507 12508 if (info->attrs[NL80211_ATTR_DURATION]) { 12509 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12510 return -EINVAL; 12511 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]); 12512 12513 /* 12514 * We should wait on the channel for at least a minimum amount 12515 * of time (10ms) but no longer than the driver supports. 12516 */ 12517 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME || 12518 params.wait > rdev->wiphy.max_remain_on_channel_duration) 12519 return -EINVAL; 12520 } 12521 12522 params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK]; 12523 12524 if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX)) 12525 return -EINVAL; 12526 12527 params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]); 12528 12529 /* get the channel if any has been specified, otherwise pass NULL to 12530 * the driver. The latter will use the current one 12531 */ 12532 chandef.chan = NULL; 12533 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 12534 err = nl80211_parse_chandef(rdev, info, &chandef); 12535 if (err) 12536 return err; 12537 } 12538 12539 if (!chandef.chan && params.offchan) 12540 return -EINVAL; 12541 12542 wdev_lock(wdev); 12543 if (params.offchan && 12544 !cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) { 12545 wdev_unlock(wdev); 12546 return -EBUSY; 12547 } 12548 12549 params.link_id = nl80211_link_id_or_invalid(info->attrs); 12550 /* 12551 * This now races due to the unlock, but we cannot check 12552 * the valid links for the _station_ anyway, so that's up 12553 * to the driver. 12554 */ 12555 if (params.link_id >= 0 && 12556 !(wdev->valid_links & BIT(params.link_id))) { 12557 wdev_unlock(wdev); 12558 return -EINVAL; 12559 } 12560 wdev_unlock(wdev); 12561 12562 params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 12563 params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 12564 12565 if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) { 12566 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]); 12567 int i; 12568 12569 if (len % sizeof(u16)) 12570 return -EINVAL; 12571 12572 params.n_csa_offsets = len / sizeof(u16); 12573 params.csa_offsets = 12574 nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]); 12575 12576 /* check that all the offsets fit the frame */ 12577 for (i = 0; i < params.n_csa_offsets; i++) { 12578 if (params.csa_offsets[i] >= params.len) 12579 return -EINVAL; 12580 } 12581 } 12582 12583 if (!params.dont_wait_for_ack) { 12584 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12585 if (!msg) 12586 return -ENOMEM; 12587 12588 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12589 NL80211_CMD_FRAME); 12590 if (!hdr) { 12591 err = -ENOBUFS; 12592 goto free_msg; 12593 } 12594 } 12595 12596 params.chan = chandef.chan; 12597 err = cfg80211_mlme_mgmt_tx(rdev, wdev, ¶ms, &cookie); 12598 if (err) 12599 goto free_msg; 12600 12601 if (msg) { 12602 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 12603 NL80211_ATTR_PAD)) 12604 goto nla_put_failure; 12605 12606 genlmsg_end(msg, hdr); 12607 return genlmsg_reply(msg, info); 12608 } 12609 12610 return 0; 12611 12612 nla_put_failure: 12613 err = -ENOBUFS; 12614 free_msg: 12615 nlmsg_free(msg); 12616 return err; 12617 } 12618 12619 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info) 12620 { 12621 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12622 struct wireless_dev *wdev = info->user_ptr[1]; 12623 u64 cookie; 12624 12625 if (!info->attrs[NL80211_ATTR_COOKIE]) 12626 return -EINVAL; 12627 12628 if (!rdev->ops->mgmt_tx_cancel_wait) 12629 return -EOPNOTSUPP; 12630 12631 switch (wdev->iftype) { 12632 case NL80211_IFTYPE_STATION: 12633 case NL80211_IFTYPE_ADHOC: 12634 case NL80211_IFTYPE_P2P_CLIENT: 12635 case NL80211_IFTYPE_AP: 12636 case NL80211_IFTYPE_AP_VLAN: 12637 case NL80211_IFTYPE_P2P_GO: 12638 case NL80211_IFTYPE_P2P_DEVICE: 12639 break; 12640 case NL80211_IFTYPE_NAN: 12641 if (!wiphy_ext_feature_isset(wdev->wiphy, 12642 NL80211_EXT_FEATURE_SECURE_NAN)) 12643 return -EOPNOTSUPP; 12644 break; 12645 default: 12646 return -EOPNOTSUPP; 12647 } 12648 12649 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 12650 12651 return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie); 12652 } 12653 12654 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info) 12655 { 12656 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12657 struct wireless_dev *wdev; 12658 struct net_device *dev = info->user_ptr[1]; 12659 u8 ps_state; 12660 bool state; 12661 int err; 12662 12663 if (!info->attrs[NL80211_ATTR_PS_STATE]) 12664 return -EINVAL; 12665 12666 ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]); 12667 12668 wdev = dev->ieee80211_ptr; 12669 12670 if (!rdev->ops->set_power_mgmt) 12671 return -EOPNOTSUPP; 12672 12673 state = (ps_state == NL80211_PS_ENABLED) ? true : false; 12674 12675 if (state == wdev->ps) 12676 return 0; 12677 12678 err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout); 12679 if (!err) 12680 wdev->ps = state; 12681 return err; 12682 } 12683 12684 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info) 12685 { 12686 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12687 enum nl80211_ps_state ps_state; 12688 struct wireless_dev *wdev; 12689 struct net_device *dev = info->user_ptr[1]; 12690 struct sk_buff *msg; 12691 void *hdr; 12692 int err; 12693 12694 wdev = dev->ieee80211_ptr; 12695 12696 if (!rdev->ops->set_power_mgmt) 12697 return -EOPNOTSUPP; 12698 12699 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 12700 if (!msg) 12701 return -ENOMEM; 12702 12703 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 12704 NL80211_CMD_GET_POWER_SAVE); 12705 if (!hdr) { 12706 err = -ENOBUFS; 12707 goto free_msg; 12708 } 12709 12710 if (wdev->ps) 12711 ps_state = NL80211_PS_ENABLED; 12712 else 12713 ps_state = NL80211_PS_DISABLED; 12714 12715 if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state)) 12716 goto nla_put_failure; 12717 12718 genlmsg_end(msg, hdr); 12719 return genlmsg_reply(msg, info); 12720 12721 nla_put_failure: 12722 err = -ENOBUFS; 12723 free_msg: 12724 nlmsg_free(msg); 12725 return err; 12726 } 12727 12728 static const struct nla_policy 12729 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = { 12730 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY }, 12731 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 }, 12732 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 }, 12733 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 }, 12734 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 }, 12735 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 }, 12736 [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 }, 12737 }; 12738 12739 static int nl80211_set_cqm_txe(struct genl_info *info, 12740 u32 rate, u32 pkts, u32 intvl) 12741 { 12742 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12743 struct net_device *dev = info->user_ptr[1]; 12744 struct wireless_dev *wdev = dev->ieee80211_ptr; 12745 12746 if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL) 12747 return -EINVAL; 12748 12749 if (!rdev->ops->set_cqm_txe_config) 12750 return -EOPNOTSUPP; 12751 12752 if (wdev->iftype != NL80211_IFTYPE_STATION && 12753 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 12754 return -EOPNOTSUPP; 12755 12756 return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl); 12757 } 12758 12759 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev, 12760 struct net_device *dev) 12761 { 12762 struct wireless_dev *wdev = dev->ieee80211_ptr; 12763 s32 last, low, high; 12764 u32 hyst; 12765 int i, n, low_index; 12766 int err; 12767 12768 /* RSSI reporting disabled? */ 12769 if (!wdev->cqm_config) 12770 return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0); 12771 12772 /* 12773 * Obtain current RSSI value if possible, if not and no RSSI threshold 12774 * event has been received yet, we should receive an event after a 12775 * connection is established and enough beacons received to calculate 12776 * the average. 12777 */ 12778 if (!wdev->cqm_config->last_rssi_event_value && 12779 wdev->links[0].client.current_bss && 12780 rdev->ops->get_station) { 12781 struct station_info sinfo = {}; 12782 u8 *mac_addr; 12783 12784 mac_addr = wdev->links[0].client.current_bss->pub.bssid; 12785 12786 err = rdev_get_station(rdev, dev, mac_addr, &sinfo); 12787 if (err) 12788 return err; 12789 12790 cfg80211_sinfo_release_content(&sinfo); 12791 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG)) 12792 wdev->cqm_config->last_rssi_event_value = 12793 (s8) sinfo.rx_beacon_signal_avg; 12794 } 12795 12796 last = wdev->cqm_config->last_rssi_event_value; 12797 hyst = wdev->cqm_config->rssi_hyst; 12798 n = wdev->cqm_config->n_rssi_thresholds; 12799 12800 for (i = 0; i < n; i++) { 12801 i = array_index_nospec(i, n); 12802 if (last < wdev->cqm_config->rssi_thresholds[i]) 12803 break; 12804 } 12805 12806 low_index = i - 1; 12807 if (low_index >= 0) { 12808 low_index = array_index_nospec(low_index, n); 12809 low = wdev->cqm_config->rssi_thresholds[low_index] - hyst; 12810 } else { 12811 low = S32_MIN; 12812 } 12813 if (i < n) { 12814 i = array_index_nospec(i, n); 12815 high = wdev->cqm_config->rssi_thresholds[i] + hyst - 1; 12816 } else { 12817 high = S32_MAX; 12818 } 12819 12820 return rdev_set_cqm_rssi_range_config(rdev, dev, low, high); 12821 } 12822 12823 static int nl80211_set_cqm_rssi(struct genl_info *info, 12824 const s32 *thresholds, int n_thresholds, 12825 u32 hysteresis) 12826 { 12827 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12828 struct net_device *dev = info->user_ptr[1]; 12829 struct wireless_dev *wdev = dev->ieee80211_ptr; 12830 int i, err; 12831 s32 prev = S32_MIN; 12832 12833 /* Check all values negative and sorted */ 12834 for (i = 0; i < n_thresholds; i++) { 12835 if (thresholds[i] > 0 || thresholds[i] <= prev) 12836 return -EINVAL; 12837 12838 prev = thresholds[i]; 12839 } 12840 12841 if (wdev->iftype != NL80211_IFTYPE_STATION && 12842 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 12843 return -EOPNOTSUPP; 12844 12845 wdev_lock(wdev); 12846 cfg80211_cqm_config_free(wdev); 12847 wdev_unlock(wdev); 12848 12849 if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) { 12850 if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */ 12851 return rdev_set_cqm_rssi_config(rdev, dev, 0, 0); 12852 12853 return rdev_set_cqm_rssi_config(rdev, dev, 12854 thresholds[0], hysteresis); 12855 } 12856 12857 if (!wiphy_ext_feature_isset(&rdev->wiphy, 12858 NL80211_EXT_FEATURE_CQM_RSSI_LIST)) 12859 return -EOPNOTSUPP; 12860 12861 if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */ 12862 n_thresholds = 0; 12863 12864 wdev_lock(wdev); 12865 if (n_thresholds) { 12866 struct cfg80211_cqm_config *cqm_config; 12867 12868 cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds, 12869 n_thresholds), 12870 GFP_KERNEL); 12871 if (!cqm_config) { 12872 err = -ENOMEM; 12873 goto unlock; 12874 } 12875 12876 cqm_config->rssi_hyst = hysteresis; 12877 cqm_config->n_rssi_thresholds = n_thresholds; 12878 memcpy(cqm_config->rssi_thresholds, thresholds, 12879 flex_array_size(cqm_config, rssi_thresholds, 12880 n_thresholds)); 12881 12882 wdev->cqm_config = cqm_config; 12883 } 12884 12885 err = cfg80211_cqm_rssi_update(rdev, dev); 12886 12887 unlock: 12888 wdev_unlock(wdev); 12889 12890 return err; 12891 } 12892 12893 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info) 12894 { 12895 struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1]; 12896 struct nlattr *cqm; 12897 int err; 12898 12899 cqm = info->attrs[NL80211_ATTR_CQM]; 12900 if (!cqm) 12901 return -EINVAL; 12902 12903 err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm, 12904 nl80211_attr_cqm_policy, 12905 info->extack); 12906 if (err) 12907 return err; 12908 12909 if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] && 12910 attrs[NL80211_ATTR_CQM_RSSI_HYST]) { 12911 const s32 *thresholds = 12912 nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 12913 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]); 12914 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]); 12915 12916 if (len % 4) 12917 return -EINVAL; 12918 12919 return nl80211_set_cqm_rssi(info, thresholds, len / 4, 12920 hysteresis); 12921 } 12922 12923 if (attrs[NL80211_ATTR_CQM_TXE_RATE] && 12924 attrs[NL80211_ATTR_CQM_TXE_PKTS] && 12925 attrs[NL80211_ATTR_CQM_TXE_INTVL]) { 12926 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]); 12927 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]); 12928 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]); 12929 12930 return nl80211_set_cqm_txe(info, rate, pkts, intvl); 12931 } 12932 12933 return -EINVAL; 12934 } 12935 12936 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info) 12937 { 12938 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12939 struct net_device *dev = info->user_ptr[1]; 12940 struct ocb_setup setup = {}; 12941 int err; 12942 12943 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 12944 if (err) 12945 return err; 12946 12947 return cfg80211_join_ocb(rdev, dev, &setup); 12948 } 12949 12950 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info) 12951 { 12952 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12953 struct net_device *dev = info->user_ptr[1]; 12954 12955 return cfg80211_leave_ocb(rdev, dev); 12956 } 12957 12958 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info) 12959 { 12960 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 12961 struct net_device *dev = info->user_ptr[1]; 12962 struct mesh_config cfg; 12963 struct mesh_setup setup; 12964 int err; 12965 12966 /* start with default */ 12967 memcpy(&cfg, &default_mesh_config, sizeof(cfg)); 12968 memcpy(&setup, &default_mesh_setup, sizeof(setup)); 12969 12970 if (info->attrs[NL80211_ATTR_MESH_CONFIG]) { 12971 /* and parse parameters if given */ 12972 err = nl80211_parse_mesh_config(info, &cfg, NULL); 12973 if (err) 12974 return err; 12975 } 12976 12977 if (!info->attrs[NL80211_ATTR_MESH_ID] || 12978 !nla_len(info->attrs[NL80211_ATTR_MESH_ID])) 12979 return -EINVAL; 12980 12981 setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]); 12982 setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]); 12983 12984 if (info->attrs[NL80211_ATTR_MCAST_RATE] && 12985 !nl80211_parse_mcast_rate(rdev, setup.mcast_rate, 12986 nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]))) 12987 return -EINVAL; 12988 12989 if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) { 12990 setup.beacon_interval = 12991 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]); 12992 12993 err = cfg80211_validate_beacon_int(rdev, 12994 NL80211_IFTYPE_MESH_POINT, 12995 setup.beacon_interval); 12996 if (err) 12997 return err; 12998 } 12999 13000 if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) { 13001 setup.dtim_period = 13002 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]); 13003 if (setup.dtim_period < 1 || setup.dtim_period > 100) 13004 return -EINVAL; 13005 } 13006 13007 if (info->attrs[NL80211_ATTR_MESH_SETUP]) { 13008 /* parse additional setup parameters if given */ 13009 err = nl80211_parse_mesh_setup(info, &setup); 13010 if (err) 13011 return err; 13012 } 13013 13014 if (setup.user_mpm) 13015 cfg.auto_open_plinks = false; 13016 13017 if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) { 13018 err = nl80211_parse_chandef(rdev, info, &setup.chandef); 13019 if (err) 13020 return err; 13021 } else { 13022 /* __cfg80211_join_mesh() will sort it out */ 13023 setup.chandef.chan = NULL; 13024 } 13025 13026 if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) { 13027 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13028 int n_rates = 13029 nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]); 13030 struct ieee80211_supported_band *sband; 13031 13032 if (!setup.chandef.chan) 13033 return -EINVAL; 13034 13035 sband = rdev->wiphy.bands[setup.chandef.chan->band]; 13036 13037 err = ieee80211_get_ratemask(sband, rates, n_rates, 13038 &setup.basic_rates); 13039 if (err) 13040 return err; 13041 } 13042 13043 if (info->attrs[NL80211_ATTR_TX_RATES]) { 13044 err = nl80211_parse_tx_bitrate_mask(info, info->attrs, 13045 NL80211_ATTR_TX_RATES, 13046 &setup.beacon_rate, 13047 dev, false, 0); 13048 if (err) 13049 return err; 13050 13051 if (!setup.chandef.chan) 13052 return -EINVAL; 13053 13054 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band, 13055 &setup.beacon_rate); 13056 if (err) 13057 return err; 13058 } 13059 13060 setup.userspace_handles_dfs = 13061 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]); 13062 13063 if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) { 13064 int r = validate_pae_over_nl80211(rdev, info); 13065 13066 if (r < 0) 13067 return r; 13068 13069 setup.control_port_over_nl80211 = true; 13070 } 13071 13072 wdev_lock(dev->ieee80211_ptr); 13073 err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg); 13074 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) 13075 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid; 13076 wdev_unlock(dev->ieee80211_ptr); 13077 13078 return err; 13079 } 13080 13081 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info) 13082 { 13083 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13084 struct net_device *dev = info->user_ptr[1]; 13085 13086 return cfg80211_leave_mesh(rdev, dev); 13087 } 13088 13089 #ifdef CONFIG_PM 13090 static int nl80211_send_wowlan_patterns(struct sk_buff *msg, 13091 struct cfg80211_registered_device *rdev) 13092 { 13093 struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config; 13094 struct nlattr *nl_pats, *nl_pat; 13095 int i, pat_len; 13096 13097 if (!wowlan->n_patterns) 13098 return 0; 13099 13100 nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN); 13101 if (!nl_pats) 13102 return -ENOBUFS; 13103 13104 for (i = 0; i < wowlan->n_patterns; i++) { 13105 nl_pat = nla_nest_start_noflag(msg, i + 1); 13106 if (!nl_pat) 13107 return -ENOBUFS; 13108 pat_len = wowlan->patterns[i].pattern_len; 13109 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8), 13110 wowlan->patterns[i].mask) || 13111 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 13112 wowlan->patterns[i].pattern) || 13113 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 13114 wowlan->patterns[i].pkt_offset)) 13115 return -ENOBUFS; 13116 nla_nest_end(msg, nl_pat); 13117 } 13118 nla_nest_end(msg, nl_pats); 13119 13120 return 0; 13121 } 13122 13123 static int nl80211_send_wowlan_tcp(struct sk_buff *msg, 13124 struct cfg80211_wowlan_tcp *tcp) 13125 { 13126 struct nlattr *nl_tcp; 13127 13128 if (!tcp) 13129 return 0; 13130 13131 nl_tcp = nla_nest_start_noflag(msg, 13132 NL80211_WOWLAN_TRIG_TCP_CONNECTION); 13133 if (!nl_tcp) 13134 return -ENOBUFS; 13135 13136 if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) || 13137 nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) || 13138 nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) || 13139 nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) || 13140 nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) || 13141 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD, 13142 tcp->payload_len, tcp->payload) || 13143 nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL, 13144 tcp->data_interval) || 13145 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD, 13146 tcp->wake_len, tcp->wake_data) || 13147 nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK, 13148 DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask)) 13149 return -ENOBUFS; 13150 13151 if (tcp->payload_seq.len && 13152 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ, 13153 sizeof(tcp->payload_seq), &tcp->payload_seq)) 13154 return -ENOBUFS; 13155 13156 if (tcp->payload_tok.len && 13157 nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN, 13158 sizeof(tcp->payload_tok) + tcp->tokens_size, 13159 &tcp->payload_tok)) 13160 return -ENOBUFS; 13161 13162 nla_nest_end(msg, nl_tcp); 13163 13164 return 0; 13165 } 13166 13167 static int nl80211_send_wowlan_nd(struct sk_buff *msg, 13168 struct cfg80211_sched_scan_request *req) 13169 { 13170 struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan; 13171 int i; 13172 13173 if (!req) 13174 return 0; 13175 13176 nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT); 13177 if (!nd) 13178 return -ENOBUFS; 13179 13180 if (req->n_scan_plans == 1 && 13181 nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL, 13182 req->scan_plans[0].interval * 1000)) 13183 return -ENOBUFS; 13184 13185 if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay)) 13186 return -ENOBUFS; 13187 13188 if (req->relative_rssi_set) { 13189 struct nl80211_bss_select_rssi_adjust rssi_adjust; 13190 13191 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI, 13192 req->relative_rssi)) 13193 return -ENOBUFS; 13194 13195 rssi_adjust.band = req->rssi_adjust.band; 13196 rssi_adjust.delta = req->rssi_adjust.delta; 13197 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST, 13198 sizeof(rssi_adjust), &rssi_adjust)) 13199 return -ENOBUFS; 13200 } 13201 13202 freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES); 13203 if (!freqs) 13204 return -ENOBUFS; 13205 13206 for (i = 0; i < req->n_channels; i++) { 13207 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 13208 return -ENOBUFS; 13209 } 13210 13211 nla_nest_end(msg, freqs); 13212 13213 if (req->n_match_sets) { 13214 matches = nla_nest_start_noflag(msg, 13215 NL80211_ATTR_SCHED_SCAN_MATCH); 13216 if (!matches) 13217 return -ENOBUFS; 13218 13219 for (i = 0; i < req->n_match_sets; i++) { 13220 match = nla_nest_start_noflag(msg, i); 13221 if (!match) 13222 return -ENOBUFS; 13223 13224 if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID, 13225 req->match_sets[i].ssid.ssid_len, 13226 req->match_sets[i].ssid.ssid)) 13227 return -ENOBUFS; 13228 nla_nest_end(msg, match); 13229 } 13230 nla_nest_end(msg, matches); 13231 } 13232 13233 scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS); 13234 if (!scan_plans) 13235 return -ENOBUFS; 13236 13237 for (i = 0; i < req->n_scan_plans; i++) { 13238 scan_plan = nla_nest_start_noflag(msg, i + 1); 13239 if (!scan_plan) 13240 return -ENOBUFS; 13241 13242 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL, 13243 req->scan_plans[i].interval) || 13244 (req->scan_plans[i].iterations && 13245 nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS, 13246 req->scan_plans[i].iterations))) 13247 return -ENOBUFS; 13248 nla_nest_end(msg, scan_plan); 13249 } 13250 nla_nest_end(msg, scan_plans); 13251 13252 nla_nest_end(msg, nd); 13253 13254 return 0; 13255 } 13256 13257 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info) 13258 { 13259 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13260 struct sk_buff *msg; 13261 void *hdr; 13262 u32 size = NLMSG_DEFAULT_SIZE; 13263 13264 if (!rdev->wiphy.wowlan) 13265 return -EOPNOTSUPP; 13266 13267 if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) { 13268 /* adjust size to have room for all the data */ 13269 size += rdev->wiphy.wowlan_config->tcp->tokens_size + 13270 rdev->wiphy.wowlan_config->tcp->payload_len + 13271 rdev->wiphy.wowlan_config->tcp->wake_len + 13272 rdev->wiphy.wowlan_config->tcp->wake_len / 8; 13273 } 13274 13275 msg = nlmsg_new(size, GFP_KERNEL); 13276 if (!msg) 13277 return -ENOMEM; 13278 13279 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13280 NL80211_CMD_GET_WOWLAN); 13281 if (!hdr) 13282 goto nla_put_failure; 13283 13284 if (rdev->wiphy.wowlan_config) { 13285 struct nlattr *nl_wowlan; 13286 13287 nl_wowlan = nla_nest_start_noflag(msg, 13288 NL80211_ATTR_WOWLAN_TRIGGERS); 13289 if (!nl_wowlan) 13290 goto nla_put_failure; 13291 13292 if ((rdev->wiphy.wowlan_config->any && 13293 nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) || 13294 (rdev->wiphy.wowlan_config->disconnect && 13295 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) || 13296 (rdev->wiphy.wowlan_config->magic_pkt && 13297 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) || 13298 (rdev->wiphy.wowlan_config->gtk_rekey_failure && 13299 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) || 13300 (rdev->wiphy.wowlan_config->eap_identity_req && 13301 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) || 13302 (rdev->wiphy.wowlan_config->four_way_handshake && 13303 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) || 13304 (rdev->wiphy.wowlan_config->rfkill_release && 13305 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))) 13306 goto nla_put_failure; 13307 13308 if (nl80211_send_wowlan_patterns(msg, rdev)) 13309 goto nla_put_failure; 13310 13311 if (nl80211_send_wowlan_tcp(msg, 13312 rdev->wiphy.wowlan_config->tcp)) 13313 goto nla_put_failure; 13314 13315 if (nl80211_send_wowlan_nd( 13316 msg, 13317 rdev->wiphy.wowlan_config->nd_config)) 13318 goto nla_put_failure; 13319 13320 nla_nest_end(msg, nl_wowlan); 13321 } 13322 13323 genlmsg_end(msg, hdr); 13324 return genlmsg_reply(msg, info); 13325 13326 nla_put_failure: 13327 nlmsg_free(msg); 13328 return -ENOBUFS; 13329 } 13330 13331 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev, 13332 struct nlattr *attr, 13333 struct cfg80211_wowlan *trig) 13334 { 13335 struct nlattr *tb[NUM_NL80211_WOWLAN_TCP]; 13336 struct cfg80211_wowlan_tcp *cfg; 13337 struct nl80211_wowlan_tcp_data_token *tok = NULL; 13338 struct nl80211_wowlan_tcp_data_seq *seq = NULL; 13339 u32 size; 13340 u32 data_size, wake_size, tokens_size = 0, wake_mask_size; 13341 int err, port; 13342 13343 if (!rdev->wiphy.wowlan->tcp) 13344 return -EINVAL; 13345 13346 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr, 13347 nl80211_wowlan_tcp_policy, NULL); 13348 if (err) 13349 return err; 13350 13351 if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] || 13352 !tb[NL80211_WOWLAN_TCP_DST_IPV4] || 13353 !tb[NL80211_WOWLAN_TCP_DST_MAC] || 13354 !tb[NL80211_WOWLAN_TCP_DST_PORT] || 13355 !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] || 13356 !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] || 13357 !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] || 13358 !tb[NL80211_WOWLAN_TCP_WAKE_MASK]) 13359 return -EINVAL; 13360 13361 data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]); 13362 if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max) 13363 return -EINVAL; 13364 13365 if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) > 13366 rdev->wiphy.wowlan->tcp->data_interval_max || 13367 nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0) 13368 return -EINVAL; 13369 13370 wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]); 13371 if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max) 13372 return -EINVAL; 13373 13374 wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]); 13375 if (wake_mask_size != DIV_ROUND_UP(wake_size, 8)) 13376 return -EINVAL; 13377 13378 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) { 13379 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13380 13381 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]); 13382 tokens_size = tokln - sizeof(*tok); 13383 13384 if (!tok->len || tokens_size % tok->len) 13385 return -EINVAL; 13386 if (!rdev->wiphy.wowlan->tcp->tok) 13387 return -EINVAL; 13388 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len) 13389 return -EINVAL; 13390 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len) 13391 return -EINVAL; 13392 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize) 13393 return -EINVAL; 13394 if (tok->offset + tok->len > data_size) 13395 return -EINVAL; 13396 } 13397 13398 if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) { 13399 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]); 13400 if (!rdev->wiphy.wowlan->tcp->seq) 13401 return -EINVAL; 13402 if (seq->len == 0 || seq->len > 4) 13403 return -EINVAL; 13404 if (seq->len + seq->offset > data_size) 13405 return -EINVAL; 13406 } 13407 13408 size = sizeof(*cfg); 13409 size += data_size; 13410 size += wake_size + wake_mask_size; 13411 size += tokens_size; 13412 13413 cfg = kzalloc(size, GFP_KERNEL); 13414 if (!cfg) 13415 return -ENOMEM; 13416 cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]); 13417 cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]); 13418 memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]), 13419 ETH_ALEN); 13420 if (tb[NL80211_WOWLAN_TCP_SRC_PORT]) 13421 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]); 13422 else 13423 port = 0; 13424 #ifdef CONFIG_INET 13425 /* allocate a socket and port for it and use it */ 13426 err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM, 13427 IPPROTO_TCP, &cfg->sock, 1); 13428 if (err) { 13429 kfree(cfg); 13430 return err; 13431 } 13432 if (inet_csk_get_port(cfg->sock->sk, port)) { 13433 sock_release(cfg->sock); 13434 kfree(cfg); 13435 return -EADDRINUSE; 13436 } 13437 cfg->src_port = inet_sk(cfg->sock->sk)->inet_num; 13438 #else 13439 if (!port) { 13440 kfree(cfg); 13441 return -EINVAL; 13442 } 13443 cfg->src_port = port; 13444 #endif 13445 13446 cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]); 13447 cfg->payload_len = data_size; 13448 cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size; 13449 memcpy((void *)cfg->payload, 13450 nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]), 13451 data_size); 13452 if (seq) 13453 cfg->payload_seq = *seq; 13454 cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]); 13455 cfg->wake_len = wake_size; 13456 cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size; 13457 memcpy((void *)cfg->wake_data, 13458 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]), 13459 wake_size); 13460 cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size + 13461 data_size + wake_size; 13462 memcpy((void *)cfg->wake_mask, 13463 nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]), 13464 wake_mask_size); 13465 if (tok) { 13466 cfg->tokens_size = tokens_size; 13467 cfg->payload_tok = *tok; 13468 memcpy(cfg->payload_tok.token_stream, tok->token_stream, 13469 tokens_size); 13470 } 13471 13472 trig->tcp = cfg; 13473 13474 return 0; 13475 } 13476 13477 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev, 13478 const struct wiphy_wowlan_support *wowlan, 13479 struct nlattr *attr, 13480 struct cfg80211_wowlan *trig) 13481 { 13482 struct nlattr **tb; 13483 int err; 13484 13485 tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL); 13486 if (!tb) 13487 return -ENOMEM; 13488 13489 if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) { 13490 err = -EOPNOTSUPP; 13491 goto out; 13492 } 13493 13494 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr, 13495 nl80211_policy, NULL); 13496 if (err) 13497 goto out; 13498 13499 trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb, 13500 wowlan->max_nd_match_sets); 13501 err = PTR_ERR_OR_ZERO(trig->nd_config); 13502 if (err) 13503 trig->nd_config = NULL; 13504 13505 out: 13506 kfree(tb); 13507 return err; 13508 } 13509 13510 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info) 13511 { 13512 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13513 struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG]; 13514 struct cfg80211_wowlan new_triggers = {}; 13515 struct cfg80211_wowlan *ntrig; 13516 const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan; 13517 int err, i; 13518 bool prev_enabled = rdev->wiphy.wowlan_config; 13519 bool regular = false; 13520 13521 if (!wowlan) 13522 return -EOPNOTSUPP; 13523 13524 if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) { 13525 cfg80211_rdev_free_wowlan(rdev); 13526 rdev->wiphy.wowlan_config = NULL; 13527 goto set_wakeup; 13528 } 13529 13530 err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG, 13531 info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS], 13532 nl80211_wowlan_policy, info->extack); 13533 if (err) 13534 return err; 13535 13536 if (tb[NL80211_WOWLAN_TRIG_ANY]) { 13537 if (!(wowlan->flags & WIPHY_WOWLAN_ANY)) 13538 return -EINVAL; 13539 new_triggers.any = true; 13540 } 13541 13542 if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) { 13543 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT)) 13544 return -EINVAL; 13545 new_triggers.disconnect = true; 13546 regular = true; 13547 } 13548 13549 if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) { 13550 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT)) 13551 return -EINVAL; 13552 new_triggers.magic_pkt = true; 13553 regular = true; 13554 } 13555 13556 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED]) 13557 return -EINVAL; 13558 13559 if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) { 13560 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE)) 13561 return -EINVAL; 13562 new_triggers.gtk_rekey_failure = true; 13563 regular = true; 13564 } 13565 13566 if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) { 13567 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ)) 13568 return -EINVAL; 13569 new_triggers.eap_identity_req = true; 13570 regular = true; 13571 } 13572 13573 if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) { 13574 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE)) 13575 return -EINVAL; 13576 new_triggers.four_way_handshake = true; 13577 regular = true; 13578 } 13579 13580 if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) { 13581 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE)) 13582 return -EINVAL; 13583 new_triggers.rfkill_release = true; 13584 regular = true; 13585 } 13586 13587 if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) { 13588 struct nlattr *pat; 13589 int n_patterns = 0; 13590 int rem, pat_len, mask_len, pkt_offset; 13591 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 13592 13593 regular = true; 13594 13595 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13596 rem) 13597 n_patterns++; 13598 if (n_patterns > wowlan->n_patterns) 13599 return -EINVAL; 13600 13601 new_triggers.patterns = kcalloc(n_patterns, 13602 sizeof(new_triggers.patterns[0]), 13603 GFP_KERNEL); 13604 if (!new_triggers.patterns) 13605 return -ENOMEM; 13606 13607 new_triggers.n_patterns = n_patterns; 13608 i = 0; 13609 13610 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN], 13611 rem) { 13612 u8 *mask_pat; 13613 13614 err = nla_parse_nested_deprecated(pat_tb, 13615 MAX_NL80211_PKTPAT, 13616 pat, 13617 nl80211_packet_pattern_policy, 13618 info->extack); 13619 if (err) 13620 goto error; 13621 13622 err = -EINVAL; 13623 if (!pat_tb[NL80211_PKTPAT_MASK] || 13624 !pat_tb[NL80211_PKTPAT_PATTERN]) 13625 goto error; 13626 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 13627 mask_len = DIV_ROUND_UP(pat_len, 8); 13628 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 13629 goto error; 13630 if (pat_len > wowlan->pattern_max_len || 13631 pat_len < wowlan->pattern_min_len) 13632 goto error; 13633 13634 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 13635 pkt_offset = 0; 13636 else 13637 pkt_offset = nla_get_u32( 13638 pat_tb[NL80211_PKTPAT_OFFSET]); 13639 if (pkt_offset > wowlan->max_pkt_offset) 13640 goto error; 13641 new_triggers.patterns[i].pkt_offset = pkt_offset; 13642 13643 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 13644 if (!mask_pat) { 13645 err = -ENOMEM; 13646 goto error; 13647 } 13648 new_triggers.patterns[i].mask = mask_pat; 13649 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 13650 mask_len); 13651 mask_pat += mask_len; 13652 new_triggers.patterns[i].pattern = mask_pat; 13653 new_triggers.patterns[i].pattern_len = pat_len; 13654 memcpy(mask_pat, 13655 nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 13656 pat_len); 13657 i++; 13658 } 13659 } 13660 13661 if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) { 13662 regular = true; 13663 err = nl80211_parse_wowlan_tcp( 13664 rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION], 13665 &new_triggers); 13666 if (err) 13667 goto error; 13668 } 13669 13670 if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) { 13671 regular = true; 13672 err = nl80211_parse_wowlan_nd( 13673 rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT], 13674 &new_triggers); 13675 if (err) 13676 goto error; 13677 } 13678 13679 /* The 'any' trigger means the device continues operating more or less 13680 * as in its normal operation mode and wakes up the host on most of the 13681 * normal interrupts (like packet RX, ...) 13682 * It therefore makes little sense to combine with the more constrained 13683 * wakeup trigger modes. 13684 */ 13685 if (new_triggers.any && regular) { 13686 err = -EINVAL; 13687 goto error; 13688 } 13689 13690 ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL); 13691 if (!ntrig) { 13692 err = -ENOMEM; 13693 goto error; 13694 } 13695 cfg80211_rdev_free_wowlan(rdev); 13696 rdev->wiphy.wowlan_config = ntrig; 13697 13698 set_wakeup: 13699 if (rdev->ops->set_wakeup && 13700 prev_enabled != !!rdev->wiphy.wowlan_config) 13701 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config); 13702 13703 return 0; 13704 error: 13705 for (i = 0; i < new_triggers.n_patterns; i++) 13706 kfree(new_triggers.patterns[i].mask); 13707 kfree(new_triggers.patterns); 13708 if (new_triggers.tcp && new_triggers.tcp->sock) 13709 sock_release(new_triggers.tcp->sock); 13710 kfree(new_triggers.tcp); 13711 kfree(new_triggers.nd_config); 13712 return err; 13713 } 13714 #endif 13715 13716 static int nl80211_send_coalesce_rules(struct sk_buff *msg, 13717 struct cfg80211_registered_device *rdev) 13718 { 13719 struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules; 13720 int i, j, pat_len; 13721 struct cfg80211_coalesce_rules *rule; 13722 13723 if (!rdev->coalesce->n_rules) 13724 return 0; 13725 13726 nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE); 13727 if (!nl_rules) 13728 return -ENOBUFS; 13729 13730 for (i = 0; i < rdev->coalesce->n_rules; i++) { 13731 nl_rule = nla_nest_start_noflag(msg, i + 1); 13732 if (!nl_rule) 13733 return -ENOBUFS; 13734 13735 rule = &rdev->coalesce->rules[i]; 13736 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY, 13737 rule->delay)) 13738 return -ENOBUFS; 13739 13740 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION, 13741 rule->condition)) 13742 return -ENOBUFS; 13743 13744 nl_pats = nla_nest_start_noflag(msg, 13745 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN); 13746 if (!nl_pats) 13747 return -ENOBUFS; 13748 13749 for (j = 0; j < rule->n_patterns; j++) { 13750 nl_pat = nla_nest_start_noflag(msg, j + 1); 13751 if (!nl_pat) 13752 return -ENOBUFS; 13753 pat_len = rule->patterns[j].pattern_len; 13754 if (nla_put(msg, NL80211_PKTPAT_MASK, 13755 DIV_ROUND_UP(pat_len, 8), 13756 rule->patterns[j].mask) || 13757 nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len, 13758 rule->patterns[j].pattern) || 13759 nla_put_u32(msg, NL80211_PKTPAT_OFFSET, 13760 rule->patterns[j].pkt_offset)) 13761 return -ENOBUFS; 13762 nla_nest_end(msg, nl_pat); 13763 } 13764 nla_nest_end(msg, nl_pats); 13765 nla_nest_end(msg, nl_rule); 13766 } 13767 nla_nest_end(msg, nl_rules); 13768 13769 return 0; 13770 } 13771 13772 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info) 13773 { 13774 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13775 struct sk_buff *msg; 13776 void *hdr; 13777 13778 if (!rdev->wiphy.coalesce) 13779 return -EOPNOTSUPP; 13780 13781 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 13782 if (!msg) 13783 return -ENOMEM; 13784 13785 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 13786 NL80211_CMD_GET_COALESCE); 13787 if (!hdr) 13788 goto nla_put_failure; 13789 13790 if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev)) 13791 goto nla_put_failure; 13792 13793 genlmsg_end(msg, hdr); 13794 return genlmsg_reply(msg, info); 13795 13796 nla_put_failure: 13797 nlmsg_free(msg); 13798 return -ENOBUFS; 13799 } 13800 13801 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev) 13802 { 13803 struct cfg80211_coalesce *coalesce = rdev->coalesce; 13804 int i, j; 13805 struct cfg80211_coalesce_rules *rule; 13806 13807 if (!coalesce) 13808 return; 13809 13810 for (i = 0; i < coalesce->n_rules; i++) { 13811 rule = &coalesce->rules[i]; 13812 for (j = 0; j < rule->n_patterns; j++) 13813 kfree(rule->patterns[j].mask); 13814 kfree(rule->patterns); 13815 } 13816 kfree(coalesce->rules); 13817 kfree(coalesce); 13818 rdev->coalesce = NULL; 13819 } 13820 13821 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev, 13822 struct nlattr *rule, 13823 struct cfg80211_coalesce_rules *new_rule) 13824 { 13825 int err, i; 13826 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 13827 struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat; 13828 int rem, pat_len, mask_len, pkt_offset, n_patterns = 0; 13829 struct nlattr *pat_tb[NUM_NL80211_PKTPAT]; 13830 13831 err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX, 13832 rule, nl80211_coalesce_policy, NULL); 13833 if (err) 13834 return err; 13835 13836 if (tb[NL80211_ATTR_COALESCE_RULE_DELAY]) 13837 new_rule->delay = 13838 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]); 13839 if (new_rule->delay > coalesce->max_delay) 13840 return -EINVAL; 13841 13842 if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION]) 13843 new_rule->condition = 13844 nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]); 13845 13846 if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN]) 13847 return -EINVAL; 13848 13849 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 13850 rem) 13851 n_patterns++; 13852 if (n_patterns > coalesce->n_patterns) 13853 return -EINVAL; 13854 13855 new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]), 13856 GFP_KERNEL); 13857 if (!new_rule->patterns) 13858 return -ENOMEM; 13859 13860 new_rule->n_patterns = n_patterns; 13861 i = 0; 13862 13863 nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN], 13864 rem) { 13865 u8 *mask_pat; 13866 13867 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT, 13868 pat, 13869 nl80211_packet_pattern_policy, 13870 NULL); 13871 if (err) 13872 return err; 13873 13874 if (!pat_tb[NL80211_PKTPAT_MASK] || 13875 !pat_tb[NL80211_PKTPAT_PATTERN]) 13876 return -EINVAL; 13877 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]); 13878 mask_len = DIV_ROUND_UP(pat_len, 8); 13879 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len) 13880 return -EINVAL; 13881 if (pat_len > coalesce->pattern_max_len || 13882 pat_len < coalesce->pattern_min_len) 13883 return -EINVAL; 13884 13885 if (!pat_tb[NL80211_PKTPAT_OFFSET]) 13886 pkt_offset = 0; 13887 else 13888 pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]); 13889 if (pkt_offset > coalesce->max_pkt_offset) 13890 return -EINVAL; 13891 new_rule->patterns[i].pkt_offset = pkt_offset; 13892 13893 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL); 13894 if (!mask_pat) 13895 return -ENOMEM; 13896 13897 new_rule->patterns[i].mask = mask_pat; 13898 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]), 13899 mask_len); 13900 13901 mask_pat += mask_len; 13902 new_rule->patterns[i].pattern = mask_pat; 13903 new_rule->patterns[i].pattern_len = pat_len; 13904 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]), 13905 pat_len); 13906 i++; 13907 } 13908 13909 return 0; 13910 } 13911 13912 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info) 13913 { 13914 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13915 const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce; 13916 struct cfg80211_coalesce new_coalesce = {}; 13917 struct cfg80211_coalesce *n_coalesce; 13918 int err, rem_rule, n_rules = 0, i, j; 13919 struct nlattr *rule; 13920 struct cfg80211_coalesce_rules *tmp_rule; 13921 13922 if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce) 13923 return -EOPNOTSUPP; 13924 13925 if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) { 13926 cfg80211_rdev_free_coalesce(rdev); 13927 rdev_set_coalesce(rdev, NULL); 13928 return 0; 13929 } 13930 13931 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 13932 rem_rule) 13933 n_rules++; 13934 if (n_rules > coalesce->n_rules) 13935 return -EINVAL; 13936 13937 new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]), 13938 GFP_KERNEL); 13939 if (!new_coalesce.rules) 13940 return -ENOMEM; 13941 13942 new_coalesce.n_rules = n_rules; 13943 i = 0; 13944 13945 nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE], 13946 rem_rule) { 13947 err = nl80211_parse_coalesce_rule(rdev, rule, 13948 &new_coalesce.rules[i]); 13949 if (err) 13950 goto error; 13951 13952 i++; 13953 } 13954 13955 err = rdev_set_coalesce(rdev, &new_coalesce); 13956 if (err) 13957 goto error; 13958 13959 n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL); 13960 if (!n_coalesce) { 13961 err = -ENOMEM; 13962 goto error; 13963 } 13964 cfg80211_rdev_free_coalesce(rdev); 13965 rdev->coalesce = n_coalesce; 13966 13967 return 0; 13968 error: 13969 for (i = 0; i < new_coalesce.n_rules; i++) { 13970 tmp_rule = &new_coalesce.rules[i]; 13971 for (j = 0; j < tmp_rule->n_patterns; j++) 13972 kfree(tmp_rule->patterns[j].mask); 13973 kfree(tmp_rule->patterns); 13974 } 13975 kfree(new_coalesce.rules); 13976 13977 return err; 13978 } 13979 13980 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info) 13981 { 13982 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 13983 struct net_device *dev = info->user_ptr[1]; 13984 struct wireless_dev *wdev = dev->ieee80211_ptr; 13985 struct nlattr *tb[NUM_NL80211_REKEY_DATA]; 13986 struct cfg80211_gtk_rekey_data rekey_data = {}; 13987 int err; 13988 13989 if (!info->attrs[NL80211_ATTR_REKEY_DATA]) 13990 return -EINVAL; 13991 13992 err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA, 13993 info->attrs[NL80211_ATTR_REKEY_DATA], 13994 nl80211_rekey_policy, info->extack); 13995 if (err) 13996 return err; 13997 13998 if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] || 13999 !tb[NL80211_REKEY_DATA_KCK]) 14000 return -EINVAL; 14001 if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN && 14002 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14003 nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN)) 14004 return -ERANGE; 14005 if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN && 14006 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK && 14007 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) && 14008 !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 && 14009 nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32)) 14010 return -ERANGE; 14011 14012 rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]); 14013 rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]); 14014 rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]); 14015 rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]); 14016 rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]); 14017 if (tb[NL80211_REKEY_DATA_AKM]) 14018 rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]); 14019 14020 wdev_lock(wdev); 14021 if (!wdev->connected) { 14022 err = -ENOTCONN; 14023 goto out; 14024 } 14025 14026 if (!rdev->ops->set_rekey_data) { 14027 err = -EOPNOTSUPP; 14028 goto out; 14029 } 14030 14031 err = rdev_set_rekey_data(rdev, dev, &rekey_data); 14032 out: 14033 wdev_unlock(wdev); 14034 return err; 14035 } 14036 14037 static int nl80211_register_unexpected_frame(struct sk_buff *skb, 14038 struct genl_info *info) 14039 { 14040 struct net_device *dev = info->user_ptr[1]; 14041 struct wireless_dev *wdev = dev->ieee80211_ptr; 14042 14043 if (wdev->iftype != NL80211_IFTYPE_AP && 14044 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14045 return -EINVAL; 14046 14047 if (wdev->ap_unexpected_nlportid) 14048 return -EBUSY; 14049 14050 wdev->ap_unexpected_nlportid = info->snd_portid; 14051 return 0; 14052 } 14053 14054 static int nl80211_probe_client(struct sk_buff *skb, 14055 struct genl_info *info) 14056 { 14057 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14058 struct net_device *dev = info->user_ptr[1]; 14059 struct wireless_dev *wdev = dev->ieee80211_ptr; 14060 struct sk_buff *msg; 14061 void *hdr; 14062 const u8 *addr; 14063 u64 cookie; 14064 int err; 14065 14066 if (wdev->iftype != NL80211_IFTYPE_AP && 14067 wdev->iftype != NL80211_IFTYPE_P2P_GO) 14068 return -EOPNOTSUPP; 14069 14070 if (!info->attrs[NL80211_ATTR_MAC]) 14071 return -EINVAL; 14072 14073 if (!rdev->ops->probe_client) 14074 return -EOPNOTSUPP; 14075 14076 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14077 if (!msg) 14078 return -ENOMEM; 14079 14080 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14081 NL80211_CMD_PROBE_CLIENT); 14082 if (!hdr) { 14083 err = -ENOBUFS; 14084 goto free_msg; 14085 } 14086 14087 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 14088 14089 err = rdev_probe_client(rdev, dev, addr, &cookie); 14090 if (err) 14091 goto free_msg; 14092 14093 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14094 NL80211_ATTR_PAD)) 14095 goto nla_put_failure; 14096 14097 genlmsg_end(msg, hdr); 14098 14099 return genlmsg_reply(msg, info); 14100 14101 nla_put_failure: 14102 err = -ENOBUFS; 14103 free_msg: 14104 nlmsg_free(msg); 14105 return err; 14106 } 14107 14108 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info) 14109 { 14110 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14111 struct cfg80211_beacon_registration *reg, *nreg; 14112 int rv; 14113 14114 if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS)) 14115 return -EOPNOTSUPP; 14116 14117 nreg = kzalloc(sizeof(*nreg), GFP_KERNEL); 14118 if (!nreg) 14119 return -ENOMEM; 14120 14121 /* First, check if already registered. */ 14122 spin_lock_bh(&rdev->beacon_registrations_lock); 14123 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 14124 if (reg->nlportid == info->snd_portid) { 14125 rv = -EALREADY; 14126 goto out_err; 14127 } 14128 } 14129 /* Add it to the list */ 14130 nreg->nlportid = info->snd_portid; 14131 list_add(&nreg->list, &rdev->beacon_registrations); 14132 14133 spin_unlock_bh(&rdev->beacon_registrations_lock); 14134 14135 return 0; 14136 out_err: 14137 spin_unlock_bh(&rdev->beacon_registrations_lock); 14138 kfree(nreg); 14139 return rv; 14140 } 14141 14142 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info) 14143 { 14144 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14145 struct wireless_dev *wdev = info->user_ptr[1]; 14146 int err; 14147 14148 if (!rdev->ops->start_p2p_device) 14149 return -EOPNOTSUPP; 14150 14151 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14152 return -EOPNOTSUPP; 14153 14154 if (wdev_running(wdev)) 14155 return 0; 14156 14157 if (rfkill_blocked(rdev->wiphy.rfkill)) 14158 return -ERFKILL; 14159 14160 err = rdev_start_p2p_device(rdev, wdev); 14161 if (err) 14162 return err; 14163 14164 wdev->is_running = true; 14165 rdev->opencount++; 14166 14167 return 0; 14168 } 14169 14170 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info) 14171 { 14172 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14173 struct wireless_dev *wdev = info->user_ptr[1]; 14174 14175 if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE) 14176 return -EOPNOTSUPP; 14177 14178 if (!rdev->ops->stop_p2p_device) 14179 return -EOPNOTSUPP; 14180 14181 cfg80211_stop_p2p_device(rdev, wdev); 14182 14183 return 0; 14184 } 14185 14186 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info) 14187 { 14188 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14189 struct wireless_dev *wdev = info->user_ptr[1]; 14190 struct cfg80211_nan_conf conf = {}; 14191 int err; 14192 14193 if (wdev->iftype != NL80211_IFTYPE_NAN) 14194 return -EOPNOTSUPP; 14195 14196 if (wdev_running(wdev)) 14197 return -EEXIST; 14198 14199 if (rfkill_blocked(rdev->wiphy.rfkill)) 14200 return -ERFKILL; 14201 14202 if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) 14203 return -EINVAL; 14204 14205 conf.master_pref = 14206 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14207 14208 if (info->attrs[NL80211_ATTR_BANDS]) { 14209 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14210 14211 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14212 return -EOPNOTSUPP; 14213 14214 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14215 return -EINVAL; 14216 14217 conf.bands = bands; 14218 } 14219 14220 err = rdev_start_nan(rdev, wdev, &conf); 14221 if (err) 14222 return err; 14223 14224 wdev->is_running = true; 14225 rdev->opencount++; 14226 14227 return 0; 14228 } 14229 14230 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info) 14231 { 14232 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14233 struct wireless_dev *wdev = info->user_ptr[1]; 14234 14235 if (wdev->iftype != NL80211_IFTYPE_NAN) 14236 return -EOPNOTSUPP; 14237 14238 cfg80211_stop_nan(rdev, wdev); 14239 14240 return 0; 14241 } 14242 14243 static int validate_nan_filter(struct nlattr *filter_attr) 14244 { 14245 struct nlattr *attr; 14246 int len = 0, n_entries = 0, rem; 14247 14248 nla_for_each_nested(attr, filter_attr, rem) { 14249 len += nla_len(attr); 14250 n_entries++; 14251 } 14252 14253 if (len >= U8_MAX) 14254 return -EINVAL; 14255 14256 return n_entries; 14257 } 14258 14259 static int handle_nan_filter(struct nlattr *attr_filter, 14260 struct cfg80211_nan_func *func, 14261 bool tx) 14262 { 14263 struct nlattr *attr; 14264 int n_entries, rem, i; 14265 struct cfg80211_nan_func_filter *filter; 14266 14267 n_entries = validate_nan_filter(attr_filter); 14268 if (n_entries < 0) 14269 return n_entries; 14270 14271 BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters)); 14272 14273 filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL); 14274 if (!filter) 14275 return -ENOMEM; 14276 14277 i = 0; 14278 nla_for_each_nested(attr, attr_filter, rem) { 14279 filter[i].filter = nla_memdup(attr, GFP_KERNEL); 14280 if (!filter[i].filter) 14281 goto err; 14282 14283 filter[i].len = nla_len(attr); 14284 i++; 14285 } 14286 if (tx) { 14287 func->num_tx_filters = n_entries; 14288 func->tx_filters = filter; 14289 } else { 14290 func->num_rx_filters = n_entries; 14291 func->rx_filters = filter; 14292 } 14293 14294 return 0; 14295 14296 err: 14297 i = 0; 14298 nla_for_each_nested(attr, attr_filter, rem) { 14299 kfree(filter[i].filter); 14300 i++; 14301 } 14302 kfree(filter); 14303 return -ENOMEM; 14304 } 14305 14306 static int nl80211_nan_add_func(struct sk_buff *skb, 14307 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 struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr; 14312 struct cfg80211_nan_func *func; 14313 struct sk_buff *msg = NULL; 14314 void *hdr = NULL; 14315 int err = 0; 14316 14317 if (wdev->iftype != NL80211_IFTYPE_NAN) 14318 return -EOPNOTSUPP; 14319 14320 if (!wdev_running(wdev)) 14321 return -ENOTCONN; 14322 14323 if (!info->attrs[NL80211_ATTR_NAN_FUNC]) 14324 return -EINVAL; 14325 14326 err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX, 14327 info->attrs[NL80211_ATTR_NAN_FUNC], 14328 nl80211_nan_func_policy, 14329 info->extack); 14330 if (err) 14331 return err; 14332 14333 func = kzalloc(sizeof(*func), GFP_KERNEL); 14334 if (!func) 14335 return -ENOMEM; 14336 14337 func->cookie = cfg80211_assign_cookie(rdev); 14338 14339 if (!tb[NL80211_NAN_FUNC_TYPE]) { 14340 err = -EINVAL; 14341 goto out; 14342 } 14343 14344 14345 func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]); 14346 14347 if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) { 14348 err = -EINVAL; 14349 goto out; 14350 } 14351 14352 memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]), 14353 sizeof(func->service_id)); 14354 14355 func->close_range = 14356 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]); 14357 14358 if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) { 14359 func->serv_spec_info_len = 14360 nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]); 14361 func->serv_spec_info = 14362 kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]), 14363 func->serv_spec_info_len, 14364 GFP_KERNEL); 14365 if (!func->serv_spec_info) { 14366 err = -ENOMEM; 14367 goto out; 14368 } 14369 } 14370 14371 if (tb[NL80211_NAN_FUNC_TTL]) 14372 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]); 14373 14374 switch (func->type) { 14375 case NL80211_NAN_FUNC_PUBLISH: 14376 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) { 14377 err = -EINVAL; 14378 goto out; 14379 } 14380 14381 func->publish_type = 14382 nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]); 14383 func->publish_bcast = 14384 nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]); 14385 14386 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) && 14387 func->publish_bcast) { 14388 err = -EINVAL; 14389 goto out; 14390 } 14391 break; 14392 case NL80211_NAN_FUNC_SUBSCRIBE: 14393 func->subscribe_active = 14394 nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]); 14395 break; 14396 case NL80211_NAN_FUNC_FOLLOW_UP: 14397 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] || 14398 !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] || 14399 !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) { 14400 err = -EINVAL; 14401 goto out; 14402 } 14403 14404 func->followup_id = 14405 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]); 14406 func->followup_reqid = 14407 nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]); 14408 memcpy(func->followup_dest.addr, 14409 nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]), 14410 sizeof(func->followup_dest.addr)); 14411 if (func->ttl) { 14412 err = -EINVAL; 14413 goto out; 14414 } 14415 break; 14416 default: 14417 err = -EINVAL; 14418 goto out; 14419 } 14420 14421 if (tb[NL80211_NAN_FUNC_SRF]) { 14422 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR]; 14423 14424 err = nla_parse_nested_deprecated(srf_tb, 14425 NL80211_NAN_SRF_ATTR_MAX, 14426 tb[NL80211_NAN_FUNC_SRF], 14427 nl80211_nan_srf_policy, 14428 info->extack); 14429 if (err) 14430 goto out; 14431 14432 func->srf_include = 14433 nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]); 14434 14435 if (srf_tb[NL80211_NAN_SRF_BF]) { 14436 if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] || 14437 !srf_tb[NL80211_NAN_SRF_BF_IDX]) { 14438 err = -EINVAL; 14439 goto out; 14440 } 14441 14442 func->srf_bf_len = 14443 nla_len(srf_tb[NL80211_NAN_SRF_BF]); 14444 func->srf_bf = 14445 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]), 14446 func->srf_bf_len, GFP_KERNEL); 14447 if (!func->srf_bf) { 14448 err = -ENOMEM; 14449 goto out; 14450 } 14451 14452 func->srf_bf_idx = 14453 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]); 14454 } else { 14455 struct nlattr *attr, *mac_attr = 14456 srf_tb[NL80211_NAN_SRF_MAC_ADDRS]; 14457 int n_entries, rem, i = 0; 14458 14459 if (!mac_attr) { 14460 err = -EINVAL; 14461 goto out; 14462 } 14463 14464 n_entries = validate_acl_mac_addrs(mac_attr); 14465 if (n_entries <= 0) { 14466 err = -EINVAL; 14467 goto out; 14468 } 14469 14470 func->srf_num_macs = n_entries; 14471 func->srf_macs = 14472 kcalloc(n_entries, sizeof(*func->srf_macs), 14473 GFP_KERNEL); 14474 if (!func->srf_macs) { 14475 err = -ENOMEM; 14476 goto out; 14477 } 14478 14479 nla_for_each_nested(attr, mac_attr, rem) 14480 memcpy(func->srf_macs[i++].addr, nla_data(attr), 14481 sizeof(*func->srf_macs)); 14482 } 14483 } 14484 14485 if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) { 14486 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER], 14487 func, true); 14488 if (err) 14489 goto out; 14490 } 14491 14492 if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) { 14493 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER], 14494 func, false); 14495 if (err) 14496 goto out; 14497 } 14498 14499 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14500 if (!msg) { 14501 err = -ENOMEM; 14502 goto out; 14503 } 14504 14505 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14506 NL80211_CMD_ADD_NAN_FUNCTION); 14507 /* This can't really happen - we just allocated 4KB */ 14508 if (WARN_ON(!hdr)) { 14509 err = -ENOMEM; 14510 goto out; 14511 } 14512 14513 err = rdev_add_nan_func(rdev, wdev, func); 14514 out: 14515 if (err < 0) { 14516 cfg80211_free_nan_func(func); 14517 nlmsg_free(msg); 14518 return err; 14519 } 14520 14521 /* propagate the instance id and cookie to userspace */ 14522 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie, 14523 NL80211_ATTR_PAD)) 14524 goto nla_put_failure; 14525 14526 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14527 if (!func_attr) 14528 goto nla_put_failure; 14529 14530 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, 14531 func->instance_id)) 14532 goto nla_put_failure; 14533 14534 nla_nest_end(msg, func_attr); 14535 14536 genlmsg_end(msg, hdr); 14537 return genlmsg_reply(msg, info); 14538 14539 nla_put_failure: 14540 nlmsg_free(msg); 14541 return -ENOBUFS; 14542 } 14543 14544 static int nl80211_nan_del_func(struct sk_buff *skb, 14545 struct genl_info *info) 14546 { 14547 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14548 struct wireless_dev *wdev = info->user_ptr[1]; 14549 u64 cookie; 14550 14551 if (wdev->iftype != NL80211_IFTYPE_NAN) 14552 return -EOPNOTSUPP; 14553 14554 if (!wdev_running(wdev)) 14555 return -ENOTCONN; 14556 14557 if (!info->attrs[NL80211_ATTR_COOKIE]) 14558 return -EINVAL; 14559 14560 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]); 14561 14562 rdev_del_nan_func(rdev, wdev, cookie); 14563 14564 return 0; 14565 } 14566 14567 static int nl80211_nan_change_config(struct sk_buff *skb, 14568 struct genl_info *info) 14569 { 14570 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14571 struct wireless_dev *wdev = info->user_ptr[1]; 14572 struct cfg80211_nan_conf conf = {}; 14573 u32 changed = 0; 14574 14575 if (wdev->iftype != NL80211_IFTYPE_NAN) 14576 return -EOPNOTSUPP; 14577 14578 if (!wdev_running(wdev)) 14579 return -ENOTCONN; 14580 14581 if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) { 14582 conf.master_pref = 14583 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]); 14584 if (conf.master_pref <= 1 || conf.master_pref == 255) 14585 return -EINVAL; 14586 14587 changed |= CFG80211_NAN_CONF_CHANGED_PREF; 14588 } 14589 14590 if (info->attrs[NL80211_ATTR_BANDS]) { 14591 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]); 14592 14593 if (bands & ~(u32)wdev->wiphy->nan_supported_bands) 14594 return -EOPNOTSUPP; 14595 14596 if (bands && !(bands & BIT(NL80211_BAND_2GHZ))) 14597 return -EINVAL; 14598 14599 conf.bands = bands; 14600 changed |= CFG80211_NAN_CONF_CHANGED_BANDS; 14601 } 14602 14603 if (!changed) 14604 return -EINVAL; 14605 14606 return rdev_nan_change_conf(rdev, wdev, &conf, changed); 14607 } 14608 14609 void cfg80211_nan_match(struct wireless_dev *wdev, 14610 struct cfg80211_nan_match_params *match, gfp_t gfp) 14611 { 14612 struct wiphy *wiphy = wdev->wiphy; 14613 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14614 struct nlattr *match_attr, *local_func_attr, *peer_func_attr; 14615 struct sk_buff *msg; 14616 void *hdr; 14617 14618 if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr)) 14619 return; 14620 14621 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14622 if (!msg) 14623 return; 14624 14625 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH); 14626 if (!hdr) { 14627 nlmsg_free(msg); 14628 return; 14629 } 14630 14631 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14632 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14633 wdev->netdev->ifindex)) || 14634 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14635 NL80211_ATTR_PAD)) 14636 goto nla_put_failure; 14637 14638 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie, 14639 NL80211_ATTR_PAD) || 14640 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr)) 14641 goto nla_put_failure; 14642 14643 match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH); 14644 if (!match_attr) 14645 goto nla_put_failure; 14646 14647 local_func_attr = nla_nest_start_noflag(msg, 14648 NL80211_NAN_MATCH_FUNC_LOCAL); 14649 if (!local_func_attr) 14650 goto nla_put_failure; 14651 14652 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id)) 14653 goto nla_put_failure; 14654 14655 nla_nest_end(msg, local_func_attr); 14656 14657 peer_func_attr = nla_nest_start_noflag(msg, 14658 NL80211_NAN_MATCH_FUNC_PEER); 14659 if (!peer_func_attr) 14660 goto nla_put_failure; 14661 14662 if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) || 14663 nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id)) 14664 goto nla_put_failure; 14665 14666 if (match->info && match->info_len && 14667 nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len, 14668 match->info)) 14669 goto nla_put_failure; 14670 14671 nla_nest_end(msg, peer_func_attr); 14672 nla_nest_end(msg, match_attr); 14673 genlmsg_end(msg, hdr); 14674 14675 if (!wdev->owner_nlportid) 14676 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14677 msg, 0, NL80211_MCGRP_NAN, gfp); 14678 else 14679 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14680 wdev->owner_nlportid); 14681 14682 return; 14683 14684 nla_put_failure: 14685 nlmsg_free(msg); 14686 } 14687 EXPORT_SYMBOL(cfg80211_nan_match); 14688 14689 void cfg80211_nan_func_terminated(struct wireless_dev *wdev, 14690 u8 inst_id, 14691 enum nl80211_nan_func_term_reason reason, 14692 u64 cookie, gfp_t gfp) 14693 { 14694 struct wiphy *wiphy = wdev->wiphy; 14695 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 14696 struct sk_buff *msg; 14697 struct nlattr *func_attr; 14698 void *hdr; 14699 14700 if (WARN_ON(!inst_id)) 14701 return; 14702 14703 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 14704 if (!msg) 14705 return; 14706 14707 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION); 14708 if (!hdr) { 14709 nlmsg_free(msg); 14710 return; 14711 } 14712 14713 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 14714 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 14715 wdev->netdev->ifindex)) || 14716 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 14717 NL80211_ATTR_PAD)) 14718 goto nla_put_failure; 14719 14720 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 14721 NL80211_ATTR_PAD)) 14722 goto nla_put_failure; 14723 14724 func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC); 14725 if (!func_attr) 14726 goto nla_put_failure; 14727 14728 if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) || 14729 nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason)) 14730 goto nla_put_failure; 14731 14732 nla_nest_end(msg, func_attr); 14733 genlmsg_end(msg, hdr); 14734 14735 if (!wdev->owner_nlportid) 14736 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 14737 msg, 0, NL80211_MCGRP_NAN, gfp); 14738 else 14739 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 14740 wdev->owner_nlportid); 14741 14742 return; 14743 14744 nla_put_failure: 14745 nlmsg_free(msg); 14746 } 14747 EXPORT_SYMBOL(cfg80211_nan_func_terminated); 14748 14749 static int nl80211_get_protocol_features(struct sk_buff *skb, 14750 struct genl_info *info) 14751 { 14752 void *hdr; 14753 struct sk_buff *msg; 14754 14755 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 14756 if (!msg) 14757 return -ENOMEM; 14758 14759 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 14760 NL80211_CMD_GET_PROTOCOL_FEATURES); 14761 if (!hdr) 14762 goto nla_put_failure; 14763 14764 if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES, 14765 NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP)) 14766 goto nla_put_failure; 14767 14768 genlmsg_end(msg, hdr); 14769 return genlmsg_reply(msg, info); 14770 14771 nla_put_failure: 14772 kfree_skb(msg); 14773 return -ENOBUFS; 14774 } 14775 14776 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info) 14777 { 14778 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14779 struct cfg80211_update_ft_ies_params ft_params; 14780 struct net_device *dev = info->user_ptr[1]; 14781 14782 if (!rdev->ops->update_ft_ies) 14783 return -EOPNOTSUPP; 14784 14785 if (!info->attrs[NL80211_ATTR_MDID] || 14786 !info->attrs[NL80211_ATTR_IE]) 14787 return -EINVAL; 14788 14789 memset(&ft_params, 0, sizeof(ft_params)); 14790 ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]); 14791 ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 14792 ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 14793 14794 return rdev_update_ft_ies(rdev, dev, &ft_params); 14795 } 14796 14797 static int nl80211_crit_protocol_start(struct sk_buff *skb, 14798 struct genl_info *info) 14799 { 14800 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14801 struct wireless_dev *wdev = info->user_ptr[1]; 14802 enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC; 14803 u16 duration; 14804 int ret; 14805 14806 if (!rdev->ops->crit_proto_start) 14807 return -EOPNOTSUPP; 14808 14809 if (WARN_ON(!rdev->ops->crit_proto_stop)) 14810 return -EINVAL; 14811 14812 if (rdev->crit_proto_nlportid) 14813 return -EBUSY; 14814 14815 /* determine protocol if provided */ 14816 if (info->attrs[NL80211_ATTR_CRIT_PROT_ID]) 14817 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]); 14818 14819 if (proto >= NUM_NL80211_CRIT_PROTO) 14820 return -EINVAL; 14821 14822 /* timeout must be provided */ 14823 if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]) 14824 return -EINVAL; 14825 14826 duration = 14827 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]); 14828 14829 ret = rdev_crit_proto_start(rdev, wdev, proto, duration); 14830 if (!ret) 14831 rdev->crit_proto_nlportid = info->snd_portid; 14832 14833 return ret; 14834 } 14835 14836 static int nl80211_crit_protocol_stop(struct sk_buff *skb, 14837 struct genl_info *info) 14838 { 14839 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14840 struct wireless_dev *wdev = info->user_ptr[1]; 14841 14842 if (!rdev->ops->crit_proto_stop) 14843 return -EOPNOTSUPP; 14844 14845 if (rdev->crit_proto_nlportid) { 14846 rdev->crit_proto_nlportid = 0; 14847 rdev_crit_proto_stop(rdev, wdev); 14848 } 14849 return 0; 14850 } 14851 14852 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd, 14853 struct nlattr *attr, 14854 struct netlink_ext_ack *extack) 14855 { 14856 if (vcmd->policy == VENDOR_CMD_RAW_DATA) { 14857 if (attr->nla_type & NLA_F_NESTED) { 14858 NL_SET_ERR_MSG_ATTR(extack, attr, 14859 "unexpected nested data"); 14860 return -EINVAL; 14861 } 14862 14863 return 0; 14864 } 14865 14866 if (!(attr->nla_type & NLA_F_NESTED)) { 14867 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data"); 14868 return -EINVAL; 14869 } 14870 14871 return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack); 14872 } 14873 14874 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info) 14875 { 14876 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 14877 struct wireless_dev *wdev = 14878 __cfg80211_wdev_from_attrs(rdev, genl_info_net(info), 14879 info->attrs); 14880 int i, err; 14881 u32 vid, subcmd; 14882 14883 if (!rdev->wiphy.vendor_commands) 14884 return -EOPNOTSUPP; 14885 14886 if (IS_ERR(wdev)) { 14887 err = PTR_ERR(wdev); 14888 if (err != -EINVAL) 14889 return err; 14890 wdev = NULL; 14891 } else if (wdev->wiphy != &rdev->wiphy) { 14892 return -EINVAL; 14893 } 14894 14895 if (!info->attrs[NL80211_ATTR_VENDOR_ID] || 14896 !info->attrs[NL80211_ATTR_VENDOR_SUBCMD]) 14897 return -EINVAL; 14898 14899 vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]); 14900 subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]); 14901 for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) { 14902 const struct wiphy_vendor_command *vcmd; 14903 void *data = NULL; 14904 int len = 0; 14905 14906 vcmd = &rdev->wiphy.vendor_commands[i]; 14907 14908 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 14909 continue; 14910 14911 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 14912 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 14913 if (!wdev) 14914 return -EINVAL; 14915 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 14916 !wdev->netdev) 14917 return -EINVAL; 14918 14919 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 14920 if (!wdev_running(wdev)) 14921 return -ENETDOWN; 14922 } 14923 } else { 14924 wdev = NULL; 14925 } 14926 14927 if (!vcmd->doit) 14928 return -EOPNOTSUPP; 14929 14930 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) { 14931 data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]); 14932 len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]); 14933 14934 err = nl80211_vendor_check_policy(vcmd, 14935 info->attrs[NL80211_ATTR_VENDOR_DATA], 14936 info->extack); 14937 if (err) 14938 return err; 14939 } 14940 14941 rdev->cur_cmd_info = info; 14942 err = vcmd->doit(&rdev->wiphy, wdev, data, len); 14943 rdev->cur_cmd_info = NULL; 14944 return err; 14945 } 14946 14947 return -EOPNOTSUPP; 14948 } 14949 14950 static int nl80211_prepare_vendor_dump(struct sk_buff *skb, 14951 struct netlink_callback *cb, 14952 struct cfg80211_registered_device **rdev, 14953 struct wireless_dev **wdev) 14954 { 14955 struct nlattr **attrbuf; 14956 u32 vid, subcmd; 14957 unsigned int i; 14958 int vcmd_idx = -1; 14959 int err; 14960 void *data = NULL; 14961 unsigned int data_len = 0; 14962 14963 if (cb->args[0]) { 14964 /* subtract the 1 again here */ 14965 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1); 14966 struct wireless_dev *tmp; 14967 14968 if (!wiphy) 14969 return -ENODEV; 14970 *rdev = wiphy_to_rdev(wiphy); 14971 *wdev = NULL; 14972 14973 if (cb->args[1]) { 14974 list_for_each_entry(tmp, &wiphy->wdev_list, list) { 14975 if (tmp->identifier == cb->args[1] - 1) { 14976 *wdev = tmp; 14977 break; 14978 } 14979 } 14980 } 14981 14982 /* keep rtnl locked in successful case */ 14983 return 0; 14984 } 14985 14986 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL); 14987 if (!attrbuf) 14988 return -ENOMEM; 14989 14990 err = nlmsg_parse_deprecated(cb->nlh, 14991 GENL_HDRLEN + nl80211_fam.hdrsize, 14992 attrbuf, nl80211_fam.maxattr, 14993 nl80211_policy, NULL); 14994 if (err) 14995 goto out; 14996 14997 if (!attrbuf[NL80211_ATTR_VENDOR_ID] || 14998 !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) { 14999 err = -EINVAL; 15000 goto out; 15001 } 15002 15003 *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf); 15004 if (IS_ERR(*wdev)) 15005 *wdev = NULL; 15006 15007 *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf); 15008 if (IS_ERR(*rdev)) { 15009 err = PTR_ERR(*rdev); 15010 goto out; 15011 } 15012 15013 vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]); 15014 subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]); 15015 15016 for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) { 15017 const struct wiphy_vendor_command *vcmd; 15018 15019 vcmd = &(*rdev)->wiphy.vendor_commands[i]; 15020 15021 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd) 15022 continue; 15023 15024 if (!vcmd->dumpit) { 15025 err = -EOPNOTSUPP; 15026 goto out; 15027 } 15028 15029 vcmd_idx = i; 15030 break; 15031 } 15032 15033 if (vcmd_idx < 0) { 15034 err = -EOPNOTSUPP; 15035 goto out; 15036 } 15037 15038 if (attrbuf[NL80211_ATTR_VENDOR_DATA]) { 15039 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15040 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]); 15041 15042 err = nl80211_vendor_check_policy( 15043 &(*rdev)->wiphy.vendor_commands[vcmd_idx], 15044 attrbuf[NL80211_ATTR_VENDOR_DATA], 15045 cb->extack); 15046 if (err) 15047 goto out; 15048 } 15049 15050 /* 0 is the first index - add 1 to parse only once */ 15051 cb->args[0] = (*rdev)->wiphy_idx + 1; 15052 /* add 1 to know if it was NULL */ 15053 cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0; 15054 cb->args[2] = vcmd_idx; 15055 cb->args[3] = (unsigned long)data; 15056 cb->args[4] = data_len; 15057 15058 /* keep rtnl locked in successful case */ 15059 err = 0; 15060 out: 15061 kfree(attrbuf); 15062 return err; 15063 } 15064 15065 static int nl80211_vendor_cmd_dump(struct sk_buff *skb, 15066 struct netlink_callback *cb) 15067 { 15068 struct cfg80211_registered_device *rdev; 15069 struct wireless_dev *wdev; 15070 unsigned int vcmd_idx; 15071 const struct wiphy_vendor_command *vcmd; 15072 void *data; 15073 int data_len; 15074 int err; 15075 struct nlattr *vendor_data; 15076 15077 rtnl_lock(); 15078 err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev); 15079 if (err) 15080 goto out; 15081 15082 vcmd_idx = cb->args[2]; 15083 data = (void *)cb->args[3]; 15084 data_len = cb->args[4]; 15085 vcmd = &rdev->wiphy.vendor_commands[vcmd_idx]; 15086 15087 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV | 15088 WIPHY_VENDOR_CMD_NEED_NETDEV)) { 15089 if (!wdev) { 15090 err = -EINVAL; 15091 goto out; 15092 } 15093 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV && 15094 !wdev->netdev) { 15095 err = -EINVAL; 15096 goto out; 15097 } 15098 15099 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) { 15100 if (!wdev_running(wdev)) { 15101 err = -ENETDOWN; 15102 goto out; 15103 } 15104 } 15105 } 15106 15107 while (1) { 15108 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid, 15109 cb->nlh->nlmsg_seq, NLM_F_MULTI, 15110 NL80211_CMD_VENDOR); 15111 if (!hdr) 15112 break; 15113 15114 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 15115 (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV, 15116 wdev_id(wdev), 15117 NL80211_ATTR_PAD))) { 15118 genlmsg_cancel(skb, hdr); 15119 break; 15120 } 15121 15122 vendor_data = nla_nest_start_noflag(skb, 15123 NL80211_ATTR_VENDOR_DATA); 15124 if (!vendor_data) { 15125 genlmsg_cancel(skb, hdr); 15126 break; 15127 } 15128 15129 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len, 15130 (unsigned long *)&cb->args[5]); 15131 nla_nest_end(skb, vendor_data); 15132 15133 if (err == -ENOBUFS || err == -ENOENT) { 15134 genlmsg_cancel(skb, hdr); 15135 break; 15136 } else if (err <= 0) { 15137 genlmsg_cancel(skb, hdr); 15138 goto out; 15139 } 15140 15141 genlmsg_end(skb, hdr); 15142 } 15143 15144 err = skb->len; 15145 out: 15146 rtnl_unlock(); 15147 return err; 15148 } 15149 15150 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy, 15151 enum nl80211_commands cmd, 15152 enum nl80211_attrs attr, 15153 int approxlen) 15154 { 15155 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15156 15157 if (WARN_ON(!rdev->cur_cmd_info)) 15158 return NULL; 15159 15160 return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen, 15161 rdev->cur_cmd_info->snd_portid, 15162 rdev->cur_cmd_info->snd_seq, 15163 cmd, attr, NULL, GFP_KERNEL); 15164 } 15165 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb); 15166 15167 int cfg80211_vendor_cmd_reply(struct sk_buff *skb) 15168 { 15169 struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0]; 15170 void *hdr = ((void **)skb->cb)[1]; 15171 struct nlattr *data = ((void **)skb->cb)[2]; 15172 15173 /* clear CB data for netlink core to own from now on */ 15174 memset(skb->cb, 0, sizeof(skb->cb)); 15175 15176 if (WARN_ON(!rdev->cur_cmd_info)) { 15177 kfree_skb(skb); 15178 return -EINVAL; 15179 } 15180 15181 nla_nest_end(skb, data); 15182 genlmsg_end(skb, hdr); 15183 return genlmsg_reply(skb, rdev->cur_cmd_info); 15184 } 15185 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply); 15186 15187 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy) 15188 { 15189 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 15190 15191 if (WARN_ON(!rdev->cur_cmd_info)) 15192 return 0; 15193 15194 return rdev->cur_cmd_info->snd_portid; 15195 } 15196 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender); 15197 15198 static int nl80211_set_qos_map(struct sk_buff *skb, 15199 struct genl_info *info) 15200 { 15201 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15202 struct cfg80211_qos_map *qos_map = NULL; 15203 struct net_device *dev = info->user_ptr[1]; 15204 u8 *pos, len, num_des, des_len, des; 15205 int ret; 15206 15207 if (!rdev->ops->set_qos_map) 15208 return -EOPNOTSUPP; 15209 15210 if (info->attrs[NL80211_ATTR_QOS_MAP]) { 15211 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]); 15212 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]); 15213 15214 if (len % 2) 15215 return -EINVAL; 15216 15217 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL); 15218 if (!qos_map) 15219 return -ENOMEM; 15220 15221 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1; 15222 if (num_des) { 15223 des_len = num_des * 15224 sizeof(struct cfg80211_dscp_exception); 15225 memcpy(qos_map->dscp_exception, pos, des_len); 15226 qos_map->num_des = num_des; 15227 for (des = 0; des < num_des; des++) { 15228 if (qos_map->dscp_exception[des].up > 7) { 15229 kfree(qos_map); 15230 return -EINVAL; 15231 } 15232 } 15233 pos += des_len; 15234 } 15235 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN); 15236 } 15237 15238 wdev_lock(dev->ieee80211_ptr); 15239 ret = nl80211_key_allowed(dev->ieee80211_ptr); 15240 if (!ret) 15241 ret = rdev_set_qos_map(rdev, dev, qos_map); 15242 wdev_unlock(dev->ieee80211_ptr); 15243 15244 kfree(qos_map); 15245 return ret; 15246 } 15247 15248 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info) 15249 { 15250 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15251 struct net_device *dev = info->user_ptr[1]; 15252 struct wireless_dev *wdev = dev->ieee80211_ptr; 15253 const u8 *peer; 15254 u8 tsid, up; 15255 u16 admitted_time = 0; 15256 int err; 15257 15258 if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)) 15259 return -EOPNOTSUPP; 15260 15261 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] || 15262 !info->attrs[NL80211_ATTR_USER_PRIO]) 15263 return -EINVAL; 15264 15265 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15266 up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]); 15267 15268 /* WMM uses TIDs 0-7 even for TSPEC */ 15269 if (tsid >= IEEE80211_FIRST_TSPEC_TSID) { 15270 /* TODO: handle 802.11 TSPEC/admission control 15271 * need more attributes for that (e.g. BA session requirement); 15272 * change the WMM adminssion test above to allow both then 15273 */ 15274 return -EINVAL; 15275 } 15276 15277 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15278 15279 if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) { 15280 admitted_time = 15281 nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]); 15282 if (!admitted_time) 15283 return -EINVAL; 15284 } 15285 15286 wdev_lock(wdev); 15287 switch (wdev->iftype) { 15288 case NL80211_IFTYPE_STATION: 15289 case NL80211_IFTYPE_P2P_CLIENT: 15290 if (wdev->connected) 15291 break; 15292 err = -ENOTCONN; 15293 goto out; 15294 default: 15295 err = -EOPNOTSUPP; 15296 goto out; 15297 } 15298 15299 err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time); 15300 15301 out: 15302 wdev_unlock(wdev); 15303 return err; 15304 } 15305 15306 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info) 15307 { 15308 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15309 struct net_device *dev = info->user_ptr[1]; 15310 struct wireless_dev *wdev = dev->ieee80211_ptr; 15311 const u8 *peer; 15312 u8 tsid; 15313 int err; 15314 15315 if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC]) 15316 return -EINVAL; 15317 15318 tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]); 15319 peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15320 15321 wdev_lock(wdev); 15322 err = rdev_del_tx_ts(rdev, dev, tsid, peer); 15323 wdev_unlock(wdev); 15324 15325 return err; 15326 } 15327 15328 static int nl80211_tdls_channel_switch(struct sk_buff *skb, 15329 struct genl_info *info) 15330 { 15331 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15332 struct net_device *dev = info->user_ptr[1]; 15333 struct wireless_dev *wdev = dev->ieee80211_ptr; 15334 struct cfg80211_chan_def chandef = {}; 15335 const u8 *addr; 15336 u8 oper_class; 15337 int err; 15338 15339 if (!rdev->ops->tdls_channel_switch || 15340 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15341 return -EOPNOTSUPP; 15342 15343 switch (dev->ieee80211_ptr->iftype) { 15344 case NL80211_IFTYPE_STATION: 15345 case NL80211_IFTYPE_P2P_CLIENT: 15346 break; 15347 default: 15348 return -EOPNOTSUPP; 15349 } 15350 15351 if (!info->attrs[NL80211_ATTR_MAC] || 15352 !info->attrs[NL80211_ATTR_OPER_CLASS]) 15353 return -EINVAL; 15354 15355 err = nl80211_parse_chandef(rdev, info, &chandef); 15356 if (err) 15357 return err; 15358 15359 /* 15360 * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012 15361 * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the 15362 * specification is not defined for them. 15363 */ 15364 if (chandef.chan->band == NL80211_BAND_2GHZ && 15365 chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 15366 chandef.width != NL80211_CHAN_WIDTH_20) 15367 return -EINVAL; 15368 15369 /* we will be active on the TDLS link */ 15370 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef, 15371 wdev->iftype)) 15372 return -EINVAL; 15373 15374 /* don't allow switching to DFS channels */ 15375 if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype)) 15376 return -EINVAL; 15377 15378 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15379 oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]); 15380 15381 wdev_lock(wdev); 15382 err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef); 15383 wdev_unlock(wdev); 15384 15385 return err; 15386 } 15387 15388 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb, 15389 struct genl_info *info) 15390 { 15391 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15392 struct net_device *dev = info->user_ptr[1]; 15393 struct wireless_dev *wdev = dev->ieee80211_ptr; 15394 const u8 *addr; 15395 15396 if (!rdev->ops->tdls_channel_switch || 15397 !rdev->ops->tdls_cancel_channel_switch || 15398 !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH)) 15399 return -EOPNOTSUPP; 15400 15401 switch (dev->ieee80211_ptr->iftype) { 15402 case NL80211_IFTYPE_STATION: 15403 case NL80211_IFTYPE_P2P_CLIENT: 15404 break; 15405 default: 15406 return -EOPNOTSUPP; 15407 } 15408 15409 if (!info->attrs[NL80211_ATTR_MAC]) 15410 return -EINVAL; 15411 15412 addr = nla_data(info->attrs[NL80211_ATTR_MAC]); 15413 15414 wdev_lock(wdev); 15415 rdev_tdls_cancel_channel_switch(rdev, dev, addr); 15416 wdev_unlock(wdev); 15417 15418 return 0; 15419 } 15420 15421 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb, 15422 struct genl_info *info) 15423 { 15424 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15425 struct net_device *dev = info->user_ptr[1]; 15426 struct wireless_dev *wdev = dev->ieee80211_ptr; 15427 const struct nlattr *nla; 15428 bool enabled; 15429 15430 if (!rdev->ops->set_multicast_to_unicast) 15431 return -EOPNOTSUPP; 15432 15433 if (wdev->iftype != NL80211_IFTYPE_AP && 15434 wdev->iftype != NL80211_IFTYPE_P2P_GO) 15435 return -EOPNOTSUPP; 15436 15437 nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED]; 15438 enabled = nla_get_flag(nla); 15439 15440 return rdev_set_multicast_to_unicast(rdev, dev, enabled); 15441 } 15442 15443 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info) 15444 { 15445 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15446 struct net_device *dev = info->user_ptr[1]; 15447 struct wireless_dev *wdev = dev->ieee80211_ptr; 15448 struct cfg80211_pmk_conf pmk_conf = {}; 15449 int ret; 15450 15451 if (wdev->iftype != NL80211_IFTYPE_STATION && 15452 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15453 return -EOPNOTSUPP; 15454 15455 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15456 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15457 return -EOPNOTSUPP; 15458 15459 if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK]) 15460 return -EINVAL; 15461 15462 wdev_lock(wdev); 15463 if (!wdev->connected) { 15464 ret = -ENOTCONN; 15465 goto out; 15466 } 15467 15468 pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15469 if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN)) { 15470 ret = -EINVAL; 15471 goto out; 15472 } 15473 15474 pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]); 15475 pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]); 15476 if (pmk_conf.pmk_len != WLAN_PMK_LEN && 15477 pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) { 15478 ret = -EINVAL; 15479 goto out; 15480 } 15481 15482 if (info->attrs[NL80211_ATTR_PMKR0_NAME]) 15483 pmk_conf.pmk_r0_name = 15484 nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]); 15485 15486 ret = rdev_set_pmk(rdev, dev, &pmk_conf); 15487 out: 15488 wdev_unlock(wdev); 15489 return ret; 15490 } 15491 15492 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info) 15493 { 15494 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15495 struct net_device *dev = info->user_ptr[1]; 15496 struct wireless_dev *wdev = dev->ieee80211_ptr; 15497 const u8 *aa; 15498 int ret; 15499 15500 if (wdev->iftype != NL80211_IFTYPE_STATION && 15501 wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) 15502 return -EOPNOTSUPP; 15503 15504 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15505 NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X)) 15506 return -EOPNOTSUPP; 15507 15508 if (!info->attrs[NL80211_ATTR_MAC]) 15509 return -EINVAL; 15510 15511 wdev_lock(wdev); 15512 aa = nla_data(info->attrs[NL80211_ATTR_MAC]); 15513 ret = rdev_del_pmk(rdev, dev, aa); 15514 wdev_unlock(wdev); 15515 15516 return ret; 15517 } 15518 15519 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info) 15520 { 15521 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15522 struct net_device *dev = info->user_ptr[1]; 15523 struct cfg80211_external_auth_params params; 15524 15525 if (!rdev->ops->external_auth) 15526 return -EOPNOTSUPP; 15527 15528 if (!info->attrs[NL80211_ATTR_SSID] && 15529 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP && 15530 dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) 15531 return -EINVAL; 15532 15533 if (!info->attrs[NL80211_ATTR_BSSID]) 15534 return -EINVAL; 15535 15536 if (!info->attrs[NL80211_ATTR_STATUS_CODE]) 15537 return -EINVAL; 15538 15539 memset(¶ms, 0, sizeof(params)); 15540 15541 if (info->attrs[NL80211_ATTR_SSID]) { 15542 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]); 15543 if (params.ssid.ssid_len == 0) 15544 return -EINVAL; 15545 memcpy(params.ssid.ssid, 15546 nla_data(info->attrs[NL80211_ATTR_SSID]), 15547 params.ssid.ssid_len); 15548 } 15549 15550 memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]), 15551 ETH_ALEN); 15552 15553 params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15554 15555 if (info->attrs[NL80211_ATTR_PMKID]) 15556 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]); 15557 15558 return rdev_external_auth(rdev, dev, ¶ms); 15559 } 15560 15561 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info) 15562 { 15563 bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK]; 15564 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15565 struct net_device *dev = info->user_ptr[1]; 15566 struct wireless_dev *wdev = dev->ieee80211_ptr; 15567 const u8 *buf; 15568 size_t len; 15569 u8 *dest; 15570 u16 proto; 15571 bool noencrypt; 15572 u64 cookie = 0; 15573 int link_id; 15574 int err; 15575 15576 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15577 NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211)) 15578 return -EOPNOTSUPP; 15579 15580 if (!rdev->ops->tx_control_port) 15581 return -EOPNOTSUPP; 15582 15583 if (!info->attrs[NL80211_ATTR_FRAME] || 15584 !info->attrs[NL80211_ATTR_MAC] || 15585 !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) { 15586 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing"); 15587 return -EINVAL; 15588 } 15589 15590 wdev_lock(wdev); 15591 15592 switch (wdev->iftype) { 15593 case NL80211_IFTYPE_AP: 15594 case NL80211_IFTYPE_P2P_GO: 15595 case NL80211_IFTYPE_MESH_POINT: 15596 break; 15597 case NL80211_IFTYPE_ADHOC: 15598 if (wdev->u.ibss.current_bss) 15599 break; 15600 err = -ENOTCONN; 15601 goto out; 15602 case NL80211_IFTYPE_STATION: 15603 case NL80211_IFTYPE_P2P_CLIENT: 15604 if (wdev->connected) 15605 break; 15606 err = -ENOTCONN; 15607 goto out; 15608 default: 15609 err = -EOPNOTSUPP; 15610 goto out; 15611 } 15612 15613 wdev_unlock(wdev); 15614 15615 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15616 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15617 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15618 proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]); 15619 noencrypt = 15620 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]); 15621 15622 link_id = nl80211_link_id_or_invalid(info->attrs); 15623 15624 err = rdev_tx_control_port(rdev, dev, buf, len, 15625 dest, cpu_to_be16(proto), noencrypt, link_id, 15626 dont_wait_for_ack ? NULL : &cookie); 15627 if (!err && !dont_wait_for_ack) 15628 nl_set_extack_cookie_u64(info->extack, cookie); 15629 return err; 15630 out: 15631 wdev_unlock(wdev); 15632 return err; 15633 } 15634 15635 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb, 15636 struct genl_info *info) 15637 { 15638 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15639 struct net_device *dev = info->user_ptr[1]; 15640 struct wireless_dev *wdev = dev->ieee80211_ptr; 15641 struct cfg80211_ftm_responder_stats ftm_stats = {}; 15642 unsigned int link_id = nl80211_link_id(info->attrs); 15643 struct sk_buff *msg; 15644 void *hdr; 15645 struct nlattr *ftm_stats_attr; 15646 int err; 15647 15648 if (wdev->iftype != NL80211_IFTYPE_AP || 15649 !wdev->links[link_id].ap.beacon_interval) 15650 return -EOPNOTSUPP; 15651 15652 err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats); 15653 if (err) 15654 return err; 15655 15656 if (!ftm_stats.filled) 15657 return -ENODATA; 15658 15659 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 15660 if (!msg) 15661 return -ENOMEM; 15662 15663 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0, 15664 NL80211_CMD_GET_FTM_RESPONDER_STATS); 15665 if (!hdr) 15666 goto nla_put_failure; 15667 15668 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 15669 goto nla_put_failure; 15670 15671 ftm_stats_attr = nla_nest_start_noflag(msg, 15672 NL80211_ATTR_FTM_RESPONDER_STATS); 15673 if (!ftm_stats_attr) 15674 goto nla_put_failure; 15675 15676 #define SET_FTM(field, name, type) \ 15677 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15678 nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \ 15679 ftm_stats.field)) \ 15680 goto nla_put_failure; } while (0) 15681 #define SET_FTM_U64(field, name) \ 15682 do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \ 15683 nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \ 15684 ftm_stats.field, NL80211_FTM_STATS_PAD)) \ 15685 goto nla_put_failure; } while (0) 15686 15687 SET_FTM(success_num, SUCCESS_NUM, u32); 15688 SET_FTM(partial_num, PARTIAL_NUM, u32); 15689 SET_FTM(failed_num, FAILED_NUM, u32); 15690 SET_FTM(asap_num, ASAP_NUM, u32); 15691 SET_FTM(non_asap_num, NON_ASAP_NUM, u32); 15692 SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC); 15693 SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32); 15694 SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32); 15695 SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32); 15696 #undef SET_FTM 15697 15698 nla_nest_end(msg, ftm_stats_attr); 15699 15700 genlmsg_end(msg, hdr); 15701 return genlmsg_reply(msg, info); 15702 15703 nla_put_failure: 15704 nlmsg_free(msg); 15705 return -ENOBUFS; 15706 } 15707 15708 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info) 15709 { 15710 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15711 struct cfg80211_update_owe_info owe_info; 15712 struct net_device *dev = info->user_ptr[1]; 15713 15714 if (!rdev->ops->update_owe_info) 15715 return -EOPNOTSUPP; 15716 15717 if (!info->attrs[NL80211_ATTR_STATUS_CODE] || 15718 !info->attrs[NL80211_ATTR_MAC]) 15719 return -EINVAL; 15720 15721 memset(&owe_info, 0, sizeof(owe_info)); 15722 owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]); 15723 nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN); 15724 15725 if (info->attrs[NL80211_ATTR_IE]) { 15726 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]); 15727 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]); 15728 } 15729 15730 return rdev_update_owe_info(rdev, dev, &owe_info); 15731 } 15732 15733 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info) 15734 { 15735 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15736 struct net_device *dev = info->user_ptr[1]; 15737 struct wireless_dev *wdev = dev->ieee80211_ptr; 15738 struct station_info sinfo = {}; 15739 const u8 *buf; 15740 size_t len; 15741 u8 *dest; 15742 int err; 15743 15744 if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station) 15745 return -EOPNOTSUPP; 15746 15747 if (!info->attrs[NL80211_ATTR_MAC] || 15748 !info->attrs[NL80211_ATTR_FRAME]) { 15749 GENL_SET_ERR_MSG(info, "Frame or MAC missing"); 15750 return -EINVAL; 15751 } 15752 15753 if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) 15754 return -EOPNOTSUPP; 15755 15756 dest = nla_data(info->attrs[NL80211_ATTR_MAC]); 15757 buf = nla_data(info->attrs[NL80211_ATTR_FRAME]); 15758 len = nla_len(info->attrs[NL80211_ATTR_FRAME]); 15759 15760 if (len < sizeof(struct ethhdr)) 15761 return -EINVAL; 15762 15763 if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) || 15764 !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr)) 15765 return -EINVAL; 15766 15767 err = rdev_get_station(rdev, dev, dest, &sinfo); 15768 if (err) 15769 return err; 15770 15771 cfg80211_sinfo_release_content(&sinfo); 15772 15773 return rdev_probe_mesh_link(rdev, dev, dest, buf, len); 15774 } 15775 15776 static int parse_tid_conf(struct cfg80211_registered_device *rdev, 15777 struct nlattr *attrs[], struct net_device *dev, 15778 struct cfg80211_tid_cfg *tid_conf, 15779 struct genl_info *info, const u8 *peer, 15780 unsigned int link_id) 15781 { 15782 struct netlink_ext_ack *extack = info->extack; 15783 u64 mask; 15784 int err; 15785 15786 if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS]) 15787 return -EINVAL; 15788 15789 tid_conf->config_override = 15790 nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]); 15791 tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]); 15792 15793 if (tid_conf->config_override) { 15794 if (rdev->ops->reset_tid_config) { 15795 err = rdev_reset_tid_config(rdev, dev, peer, 15796 tid_conf->tids); 15797 if (err) 15798 return err; 15799 } else { 15800 return -EINVAL; 15801 } 15802 } 15803 15804 if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) { 15805 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK); 15806 tid_conf->noack = 15807 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]); 15808 } 15809 15810 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) { 15811 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT); 15812 tid_conf->retry_short = 15813 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]); 15814 15815 if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count) 15816 return -EINVAL; 15817 } 15818 15819 if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) { 15820 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG); 15821 tid_conf->retry_long = 15822 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]); 15823 15824 if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count) 15825 return -EINVAL; 15826 } 15827 15828 if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) { 15829 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL); 15830 tid_conf->ampdu = 15831 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]); 15832 } 15833 15834 if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) { 15835 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL); 15836 tid_conf->rtscts = 15837 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]); 15838 } 15839 15840 if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) { 15841 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL); 15842 tid_conf->amsdu = 15843 nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]); 15844 } 15845 15846 if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) { 15847 u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr; 15848 15849 tid_conf->txrate_type = nla_get_u8(attrs[idx]); 15850 15851 if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) { 15852 attr = NL80211_TID_CONFIG_ATTR_TX_RATE; 15853 err = nl80211_parse_tx_bitrate_mask(info, attrs, attr, 15854 &tid_conf->txrate_mask, dev, 15855 true, link_id); 15856 if (err) 15857 return err; 15858 15859 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE); 15860 } 15861 tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE); 15862 } 15863 15864 if (peer) 15865 mask = rdev->wiphy.tid_config_support.peer; 15866 else 15867 mask = rdev->wiphy.tid_config_support.vif; 15868 15869 if (tid_conf->mask & ~mask) { 15870 NL_SET_ERR_MSG(extack, "unsupported TID configuration"); 15871 return -ENOTSUPP; 15872 } 15873 15874 return 0; 15875 } 15876 15877 static int nl80211_set_tid_config(struct sk_buff *skb, 15878 struct genl_info *info) 15879 { 15880 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15881 struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1]; 15882 unsigned int link_id = nl80211_link_id(info->attrs); 15883 struct net_device *dev = info->user_ptr[1]; 15884 struct cfg80211_tid_config *tid_config; 15885 struct nlattr *tid; 15886 int conf_idx = 0, rem_conf; 15887 int ret = -EINVAL; 15888 u32 num_conf = 0; 15889 15890 if (!info->attrs[NL80211_ATTR_TID_CONFIG]) 15891 return -EINVAL; 15892 15893 if (!rdev->ops->set_tid_config) 15894 return -EOPNOTSUPP; 15895 15896 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 15897 rem_conf) 15898 num_conf++; 15899 15900 tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf), 15901 GFP_KERNEL); 15902 if (!tid_config) 15903 return -ENOMEM; 15904 15905 tid_config->n_tid_conf = num_conf; 15906 15907 if (info->attrs[NL80211_ATTR_MAC]) 15908 tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]); 15909 15910 wdev_lock(dev->ieee80211_ptr); 15911 15912 nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG], 15913 rem_conf) { 15914 ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX, 15915 tid, NULL, NULL); 15916 15917 if (ret) 15918 goto bad_tid_conf; 15919 15920 ret = parse_tid_conf(rdev, attrs, dev, 15921 &tid_config->tid_conf[conf_idx], 15922 info, tid_config->peer, link_id); 15923 if (ret) 15924 goto bad_tid_conf; 15925 15926 conf_idx++; 15927 } 15928 15929 ret = rdev_set_tid_config(rdev, dev, tid_config); 15930 15931 bad_tid_conf: 15932 kfree(tid_config); 15933 wdev_unlock(dev->ieee80211_ptr); 15934 return ret; 15935 } 15936 15937 static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info) 15938 { 15939 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 15940 struct cfg80211_color_change_settings params = {}; 15941 struct net_device *dev = info->user_ptr[1]; 15942 struct wireless_dev *wdev = dev->ieee80211_ptr; 15943 struct nlattr **tb; 15944 u16 offset; 15945 int err; 15946 15947 if (!rdev->ops->color_change) 15948 return -EOPNOTSUPP; 15949 15950 if (!wiphy_ext_feature_isset(&rdev->wiphy, 15951 NL80211_EXT_FEATURE_BSS_COLOR)) 15952 return -EOPNOTSUPP; 15953 15954 if (wdev->iftype != NL80211_IFTYPE_AP) 15955 return -EOPNOTSUPP; 15956 15957 if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] || 15958 !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] || 15959 !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS]) 15960 return -EINVAL; 15961 15962 params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]); 15963 params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]); 15964 15965 err = nl80211_parse_beacon(rdev, info->attrs, ¶ms.beacon_next, 15966 info->extack); 15967 if (err) 15968 return err; 15969 15970 tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL); 15971 if (!tb) 15972 return -ENOMEM; 15973 15974 err = nla_parse_nested(tb, NL80211_ATTR_MAX, 15975 info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS], 15976 nl80211_policy, info->extack); 15977 if (err) 15978 goto out; 15979 15980 err = nl80211_parse_beacon(rdev, tb, ¶ms.beacon_color_change, 15981 info->extack); 15982 if (err) 15983 goto out; 15984 15985 if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) { 15986 err = -EINVAL; 15987 goto out; 15988 } 15989 15990 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) { 15991 err = -EINVAL; 15992 goto out; 15993 } 15994 15995 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]); 15996 if (offset >= params.beacon_color_change.tail_len) { 15997 err = -EINVAL; 15998 goto out; 15999 } 16000 16001 if (params.beacon_color_change.tail[offset] != params.count) { 16002 err = -EINVAL; 16003 goto out; 16004 } 16005 16006 params.counter_offset_beacon = offset; 16007 16008 if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) { 16009 if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) != 16010 sizeof(u16)) { 16011 err = -EINVAL; 16012 goto out; 16013 } 16014 16015 offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]); 16016 if (offset >= params.beacon_color_change.probe_resp_len) { 16017 err = -EINVAL; 16018 goto out; 16019 } 16020 16021 if (params.beacon_color_change.probe_resp[offset] != 16022 params.count) { 16023 err = -EINVAL; 16024 goto out; 16025 } 16026 16027 params.counter_offset_presp = offset; 16028 } 16029 16030 wdev_lock(wdev); 16031 err = rdev_color_change(rdev, dev, ¶ms); 16032 wdev_unlock(wdev); 16033 16034 out: 16035 kfree(params.beacon_next.mbssid_ies); 16036 kfree(params.beacon_color_change.mbssid_ies); 16037 kfree(params.beacon_next.rnr_ies); 16038 kfree(params.beacon_color_change.rnr_ies); 16039 kfree(tb); 16040 return err; 16041 } 16042 16043 static int nl80211_set_fils_aad(struct sk_buff *skb, 16044 struct genl_info *info) 16045 { 16046 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16047 struct net_device *dev = info->user_ptr[1]; 16048 struct cfg80211_fils_aad fils_aad = {}; 16049 u8 *nonces; 16050 16051 if (!info->attrs[NL80211_ATTR_MAC] || 16052 !info->attrs[NL80211_ATTR_FILS_KEK] || 16053 !info->attrs[NL80211_ATTR_FILS_NONCES]) 16054 return -EINVAL; 16055 16056 fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16057 fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]); 16058 fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]); 16059 nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]); 16060 fils_aad.snonce = nonces; 16061 fils_aad.anonce = nonces + FILS_NONCE_LEN; 16062 16063 return rdev_set_fils_aad(rdev, dev, &fils_aad); 16064 } 16065 16066 static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info) 16067 { 16068 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16069 unsigned int link_id = nl80211_link_id(info->attrs); 16070 struct net_device *dev = info->user_ptr[1]; 16071 struct wireless_dev *wdev = dev->ieee80211_ptr; 16072 int ret; 16073 16074 if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO)) 16075 return -EINVAL; 16076 16077 switch (wdev->iftype) { 16078 case NL80211_IFTYPE_AP: 16079 break; 16080 default: 16081 return -EINVAL; 16082 } 16083 16084 if (!info->attrs[NL80211_ATTR_MAC] || 16085 !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC]))) 16086 return -EINVAL; 16087 16088 wdev_lock(wdev); 16089 wdev->valid_links |= BIT(link_id); 16090 ether_addr_copy(wdev->links[link_id].addr, 16091 nla_data(info->attrs[NL80211_ATTR_MAC])); 16092 16093 ret = rdev_add_intf_link(rdev, wdev, link_id); 16094 if (ret) { 16095 wdev->valid_links &= ~BIT(link_id); 16096 eth_zero_addr(wdev->links[link_id].addr); 16097 } 16098 wdev_unlock(wdev); 16099 16100 return ret; 16101 } 16102 16103 static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info) 16104 { 16105 unsigned int link_id = nl80211_link_id(info->attrs); 16106 struct net_device *dev = info->user_ptr[1]; 16107 struct wireless_dev *wdev = dev->ieee80211_ptr; 16108 16109 /* cannot remove if there's no link */ 16110 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16111 return -EINVAL; 16112 16113 switch (wdev->iftype) { 16114 case NL80211_IFTYPE_AP: 16115 break; 16116 default: 16117 return -EINVAL; 16118 } 16119 16120 wdev_lock(wdev); 16121 cfg80211_remove_link(wdev, link_id); 16122 wdev_unlock(wdev); 16123 16124 return 0; 16125 } 16126 16127 static int 16128 nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info, 16129 bool add) 16130 { 16131 struct link_station_parameters params = {}; 16132 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16133 struct net_device *dev = info->user_ptr[1]; 16134 int err; 16135 16136 if ((add && !rdev->ops->add_link_station) || 16137 (!add && !rdev->ops->mod_link_station)) 16138 return -EOPNOTSUPP; 16139 16140 if (add && !info->attrs[NL80211_ATTR_MAC]) 16141 return -EINVAL; 16142 16143 if (!info->attrs[NL80211_ATTR_MLD_ADDR]) 16144 return -EINVAL; 16145 16146 if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) 16147 return -EINVAL; 16148 16149 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16150 16151 if (info->attrs[NL80211_ATTR_MAC]) { 16152 params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]); 16153 if (!is_valid_ether_addr(params.link_mac)) 16154 return -EINVAL; 16155 } 16156 16157 if (!info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16158 return -EINVAL; 16159 16160 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16161 16162 if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) { 16163 params.supported_rates = 16164 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16165 params.supported_rates_len = 16166 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]); 16167 } 16168 16169 if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) 16170 params.ht_capa = 16171 nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]); 16172 16173 if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) 16174 params.vht_capa = 16175 nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]); 16176 16177 if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) { 16178 params.he_capa = 16179 nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16180 params.he_capa_len = 16181 nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]); 16182 16183 if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) { 16184 params.eht_capa = 16185 nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16186 params.eht_capa_len = 16187 nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]); 16188 16189 if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa, 16190 (const u8 *)params.eht_capa, 16191 params.eht_capa_len, 16192 false)) 16193 return -EINVAL; 16194 } 16195 } 16196 16197 if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]) 16198 params.he_6ghz_capa = 16199 nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]); 16200 16201 if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) { 16202 params.opmode_notif_used = true; 16203 params.opmode_notif = 16204 nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]); 16205 } 16206 16207 err = nl80211_parse_sta_txpower_setting(info, ¶ms.txpwr, 16208 ¶ms.txpwr_set); 16209 if (err) 16210 return err; 16211 16212 wdev_lock(dev->ieee80211_ptr); 16213 if (add) 16214 err = rdev_add_link_station(rdev, dev, ¶ms); 16215 else 16216 err = rdev_mod_link_station(rdev, dev, ¶ms); 16217 wdev_unlock(dev->ieee80211_ptr); 16218 16219 return err; 16220 } 16221 16222 static int 16223 nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info) 16224 { 16225 return nl80211_add_mod_link_station(skb, info, true); 16226 } 16227 16228 static int 16229 nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info) 16230 { 16231 return nl80211_add_mod_link_station(skb, info, false); 16232 } 16233 16234 static int 16235 nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info) 16236 { 16237 struct link_station_del_parameters params = {}; 16238 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16239 struct net_device *dev = info->user_ptr[1]; 16240 int ret; 16241 16242 if (!rdev->ops->del_link_station) 16243 return -EOPNOTSUPP; 16244 16245 if (!info->attrs[NL80211_ATTR_MLD_ADDR] || 16246 !info->attrs[NL80211_ATTR_MLO_LINK_ID]) 16247 return -EINVAL; 16248 16249 params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]); 16250 params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]); 16251 16252 wdev_lock(dev->ieee80211_ptr); 16253 ret = rdev_del_link_station(rdev, dev, ¶ms); 16254 wdev_unlock(dev->ieee80211_ptr); 16255 16256 return ret; 16257 } 16258 16259 static int nl80211_set_hw_timestamp(struct sk_buff *skb, 16260 struct genl_info *info) 16261 { 16262 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16263 struct net_device *dev = info->user_ptr[1]; 16264 struct cfg80211_set_hw_timestamp hwts = {}; 16265 16266 if (!rdev->wiphy.hw_timestamp_max_peers) 16267 return -EOPNOTSUPP; 16268 16269 if (!info->attrs[NL80211_ATTR_MAC] && 16270 rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS) 16271 return -EOPNOTSUPP; 16272 16273 if (info->attrs[NL80211_ATTR_MAC]) 16274 hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]); 16275 16276 hwts.enable = 16277 nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]); 16278 16279 return rdev_set_hw_timestamp(rdev, dev, &hwts); 16280 } 16281 16282 #define NL80211_FLAG_NEED_WIPHY 0x01 16283 #define NL80211_FLAG_NEED_NETDEV 0x02 16284 #define NL80211_FLAG_NEED_RTNL 0x04 16285 #define NL80211_FLAG_CHECK_NETDEV_UP 0x08 16286 #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\ 16287 NL80211_FLAG_CHECK_NETDEV_UP) 16288 #define NL80211_FLAG_NEED_WDEV 0x10 16289 /* If a netdev is associated, it must be UP, P2P must be started */ 16290 #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\ 16291 NL80211_FLAG_CHECK_NETDEV_UP) 16292 #define NL80211_FLAG_CLEAR_SKB 0x20 16293 #define NL80211_FLAG_NO_WIPHY_MTX 0x40 16294 #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80 16295 #define NL80211_FLAG_MLO_UNSUPPORTED 0x100 16296 16297 #define INTERNAL_FLAG_SELECTORS(__sel) \ 16298 SELECTOR(__sel, NONE, 0) /* must be first */ \ 16299 SELECTOR(__sel, WIPHY, \ 16300 NL80211_FLAG_NEED_WIPHY) \ 16301 SELECTOR(__sel, WDEV, \ 16302 NL80211_FLAG_NEED_WDEV) \ 16303 SELECTOR(__sel, NETDEV, \ 16304 NL80211_FLAG_NEED_NETDEV) \ 16305 SELECTOR(__sel, NETDEV_LINK, \ 16306 NL80211_FLAG_NEED_NETDEV | \ 16307 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16308 SELECTOR(__sel, NETDEV_NO_MLO, \ 16309 NL80211_FLAG_NEED_NETDEV | \ 16310 NL80211_FLAG_MLO_UNSUPPORTED) \ 16311 SELECTOR(__sel, WIPHY_RTNL, \ 16312 NL80211_FLAG_NEED_WIPHY | \ 16313 NL80211_FLAG_NEED_RTNL) \ 16314 SELECTOR(__sel, WIPHY_RTNL_NOMTX, \ 16315 NL80211_FLAG_NEED_WIPHY | \ 16316 NL80211_FLAG_NEED_RTNL | \ 16317 NL80211_FLAG_NO_WIPHY_MTX) \ 16318 SELECTOR(__sel, WDEV_RTNL, \ 16319 NL80211_FLAG_NEED_WDEV | \ 16320 NL80211_FLAG_NEED_RTNL) \ 16321 SELECTOR(__sel, NETDEV_RTNL, \ 16322 NL80211_FLAG_NEED_NETDEV | \ 16323 NL80211_FLAG_NEED_RTNL) \ 16324 SELECTOR(__sel, NETDEV_UP, \ 16325 NL80211_FLAG_NEED_NETDEV_UP) \ 16326 SELECTOR(__sel, NETDEV_UP_LINK, \ 16327 NL80211_FLAG_NEED_NETDEV_UP | \ 16328 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16329 SELECTOR(__sel, NETDEV_UP_NO_MLO, \ 16330 NL80211_FLAG_NEED_NETDEV_UP | \ 16331 NL80211_FLAG_MLO_UNSUPPORTED) \ 16332 SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \ 16333 NL80211_FLAG_NEED_NETDEV_UP | \ 16334 NL80211_FLAG_CLEAR_SKB | \ 16335 NL80211_FLAG_MLO_UNSUPPORTED) \ 16336 SELECTOR(__sel, NETDEV_UP_NOTMX, \ 16337 NL80211_FLAG_NEED_NETDEV_UP | \ 16338 NL80211_FLAG_NO_WIPHY_MTX) \ 16339 SELECTOR(__sel, NETDEV_UP_NOTMX_NOMLO, \ 16340 NL80211_FLAG_NEED_NETDEV_UP | \ 16341 NL80211_FLAG_NO_WIPHY_MTX | \ 16342 NL80211_FLAG_MLO_UNSUPPORTED) \ 16343 SELECTOR(__sel, NETDEV_UP_CLEAR, \ 16344 NL80211_FLAG_NEED_NETDEV_UP | \ 16345 NL80211_FLAG_CLEAR_SKB) \ 16346 SELECTOR(__sel, WDEV_UP, \ 16347 NL80211_FLAG_NEED_WDEV_UP) \ 16348 SELECTOR(__sel, WDEV_UP_LINK, \ 16349 NL80211_FLAG_NEED_WDEV_UP | \ 16350 NL80211_FLAG_MLO_VALID_LINK_ID) \ 16351 SELECTOR(__sel, WDEV_UP_RTNL, \ 16352 NL80211_FLAG_NEED_WDEV_UP | \ 16353 NL80211_FLAG_NEED_RTNL) \ 16354 SELECTOR(__sel, WIPHY_CLEAR, \ 16355 NL80211_FLAG_NEED_WIPHY | \ 16356 NL80211_FLAG_CLEAR_SKB) 16357 16358 enum nl80211_internal_flags_selector { 16359 #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name, 16360 INTERNAL_FLAG_SELECTORS(_) 16361 #undef SELECTOR 16362 }; 16363 16364 static u32 nl80211_internal_flags[] = { 16365 #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value, 16366 INTERNAL_FLAG_SELECTORS(_) 16367 #undef SELECTOR 16368 }; 16369 16370 static int nl80211_pre_doit(const struct genl_split_ops *ops, 16371 struct sk_buff *skb, 16372 struct genl_info *info) 16373 { 16374 struct cfg80211_registered_device *rdev = NULL; 16375 struct wireless_dev *wdev = NULL; 16376 struct net_device *dev = NULL; 16377 u32 internal_flags; 16378 int err; 16379 16380 if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags))) 16381 return -EINVAL; 16382 16383 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16384 16385 rtnl_lock(); 16386 if (internal_flags & NL80211_FLAG_NEED_WIPHY) { 16387 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info); 16388 if (IS_ERR(rdev)) { 16389 err = PTR_ERR(rdev); 16390 goto out_unlock; 16391 } 16392 info->user_ptr[0] = rdev; 16393 } else if (internal_flags & NL80211_FLAG_NEED_NETDEV || 16394 internal_flags & NL80211_FLAG_NEED_WDEV) { 16395 wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info), 16396 info->attrs); 16397 if (IS_ERR(wdev)) { 16398 err = PTR_ERR(wdev); 16399 goto out_unlock; 16400 } 16401 16402 dev = wdev->netdev; 16403 dev_hold(dev); 16404 rdev = wiphy_to_rdev(wdev->wiphy); 16405 16406 if (internal_flags & NL80211_FLAG_NEED_NETDEV) { 16407 if (!dev) { 16408 err = -EINVAL; 16409 goto out_unlock; 16410 } 16411 16412 info->user_ptr[1] = dev; 16413 } else { 16414 info->user_ptr[1] = wdev; 16415 } 16416 16417 if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP && 16418 !wdev_running(wdev)) { 16419 err = -ENETDOWN; 16420 goto out_unlock; 16421 } 16422 16423 info->user_ptr[0] = rdev; 16424 } 16425 16426 if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) { 16427 struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID]; 16428 16429 if (!wdev) { 16430 err = -EINVAL; 16431 goto out_unlock; 16432 } 16433 16434 /* MLO -> require valid link ID */ 16435 if (wdev->valid_links && 16436 (!link_id || 16437 !(wdev->valid_links & BIT(nla_get_u8(link_id))))) { 16438 err = -EINVAL; 16439 goto out_unlock; 16440 } 16441 16442 /* non-MLO -> no link ID attribute accepted */ 16443 if (!wdev->valid_links && link_id) { 16444 err = -EINVAL; 16445 goto out_unlock; 16446 } 16447 } 16448 16449 if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) { 16450 if (info->attrs[NL80211_ATTR_MLO_LINK_ID] || 16451 (wdev && wdev->valid_links)) { 16452 err = -EINVAL; 16453 goto out_unlock; 16454 } 16455 } 16456 16457 if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16458 wiphy_lock(&rdev->wiphy); 16459 /* we keep the mutex locked until post_doit */ 16460 __release(&rdev->wiphy.mtx); 16461 } 16462 if (!(internal_flags & NL80211_FLAG_NEED_RTNL)) 16463 rtnl_unlock(); 16464 16465 return 0; 16466 out_unlock: 16467 rtnl_unlock(); 16468 dev_put(dev); 16469 return err; 16470 } 16471 16472 static void nl80211_post_doit(const struct genl_split_ops *ops, 16473 struct sk_buff *skb, 16474 struct genl_info *info) 16475 { 16476 u32 internal_flags = nl80211_internal_flags[ops->internal_flags]; 16477 16478 if (info->user_ptr[1]) { 16479 if (internal_flags & NL80211_FLAG_NEED_WDEV) { 16480 struct wireless_dev *wdev = info->user_ptr[1]; 16481 16482 dev_put(wdev->netdev); 16483 } else { 16484 dev_put(info->user_ptr[1]); 16485 } 16486 } 16487 16488 if (info->user_ptr[0] && 16489 !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) { 16490 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16491 16492 /* we kept the mutex locked since pre_doit */ 16493 __acquire(&rdev->wiphy.mtx); 16494 wiphy_unlock(&rdev->wiphy); 16495 } 16496 16497 if (internal_flags & NL80211_FLAG_NEED_RTNL) 16498 rtnl_unlock(); 16499 16500 /* If needed, clear the netlink message payload from the SKB 16501 * as it might contain key data that shouldn't stick around on 16502 * the heap after the SKB is freed. The netlink message header 16503 * is still needed for further processing, so leave it intact. 16504 */ 16505 if (internal_flags & NL80211_FLAG_CLEAR_SKB) { 16506 struct nlmsghdr *nlh = nlmsg_hdr(skb); 16507 16508 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh)); 16509 } 16510 } 16511 16512 static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev, 16513 struct cfg80211_sar_specs *sar_specs, 16514 struct nlattr *spec[], int index) 16515 { 16516 u32 range_index, i; 16517 16518 if (!sar_specs || !spec) 16519 return -EINVAL; 16520 16521 if (!spec[NL80211_SAR_ATTR_SPECS_POWER] || 16522 !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]) 16523 return -EINVAL; 16524 16525 range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]); 16526 16527 /* check if range_index exceeds num_freq_ranges */ 16528 if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges) 16529 return -EINVAL; 16530 16531 /* check if range_index duplicates */ 16532 for (i = 0; i < index; i++) { 16533 if (sar_specs->sub_specs[i].freq_range_index == range_index) 16534 return -EINVAL; 16535 } 16536 16537 sar_specs->sub_specs[index].power = 16538 nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]); 16539 16540 sar_specs->sub_specs[index].freq_range_index = range_index; 16541 16542 return 0; 16543 } 16544 16545 static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info) 16546 { 16547 struct cfg80211_registered_device *rdev = info->user_ptr[0]; 16548 struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1]; 16549 struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1]; 16550 struct cfg80211_sar_specs *sar_spec; 16551 enum nl80211_sar_type type; 16552 struct nlattr *spec_list; 16553 u32 specs; 16554 int rem, err; 16555 16556 if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs) 16557 return -EOPNOTSUPP; 16558 16559 if (!info->attrs[NL80211_ATTR_SAR_SPEC]) 16560 return -EINVAL; 16561 16562 nla_parse_nested(tb, NL80211_SAR_ATTR_MAX, 16563 info->attrs[NL80211_ATTR_SAR_SPEC], 16564 NULL, NULL); 16565 16566 if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS]) 16567 return -EINVAL; 16568 16569 type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]); 16570 if (type != rdev->wiphy.sar_capa->type) 16571 return -EINVAL; 16572 16573 specs = 0; 16574 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) 16575 specs++; 16576 16577 if (specs > rdev->wiphy.sar_capa->num_freq_ranges) 16578 return -EINVAL; 16579 16580 sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL); 16581 if (!sar_spec) 16582 return -ENOMEM; 16583 16584 sar_spec->type = type; 16585 specs = 0; 16586 nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) { 16587 nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX, 16588 spec_list, NULL, NULL); 16589 16590 switch (type) { 16591 case NL80211_SAR_TYPE_POWER: 16592 if (nl80211_set_sar_sub_specs(rdev, sar_spec, 16593 spec, specs)) { 16594 err = -EINVAL; 16595 goto error; 16596 } 16597 break; 16598 default: 16599 err = -EINVAL; 16600 goto error; 16601 } 16602 specs++; 16603 } 16604 16605 sar_spec->num_sub_specs = specs; 16606 16607 rdev->cur_cmd_info = info; 16608 err = rdev_set_sar_specs(rdev, sar_spec); 16609 rdev->cur_cmd_info = NULL; 16610 error: 16611 kfree(sar_spec); 16612 return err; 16613 } 16614 16615 #define SELECTOR(__sel, name, value) \ 16616 ((__sel) == (value)) ? NL80211_IFL_SEL_##name : 16617 int __missing_selector(void); 16618 #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector() 16619 16620 static const struct genl_ops nl80211_ops[] = { 16621 { 16622 .cmd = NL80211_CMD_GET_WIPHY, 16623 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16624 .doit = nl80211_get_wiphy, 16625 .dumpit = nl80211_dump_wiphy, 16626 .done = nl80211_dump_wiphy_done, 16627 /* can be retrieved by unprivileged users */ 16628 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 16629 }, 16630 }; 16631 16632 static const struct genl_small_ops nl80211_small_ops[] = { 16633 { 16634 .cmd = NL80211_CMD_SET_WIPHY, 16635 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16636 .doit = nl80211_set_wiphy, 16637 .flags = GENL_UNS_ADMIN_PERM, 16638 }, 16639 { 16640 .cmd = NL80211_CMD_GET_INTERFACE, 16641 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16642 .doit = nl80211_get_interface, 16643 .dumpit = nl80211_dump_interface, 16644 /* can be retrieved by unprivileged users */ 16645 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 16646 }, 16647 { 16648 .cmd = NL80211_CMD_SET_INTERFACE, 16649 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16650 .doit = nl80211_set_interface, 16651 .flags = GENL_UNS_ADMIN_PERM, 16652 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 16653 NL80211_FLAG_NEED_RTNL), 16654 }, 16655 { 16656 .cmd = NL80211_CMD_NEW_INTERFACE, 16657 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16658 .doit = nl80211_new_interface, 16659 .flags = GENL_UNS_ADMIN_PERM, 16660 .internal_flags = 16661 IFLAGS(NL80211_FLAG_NEED_WIPHY | 16662 NL80211_FLAG_NEED_RTNL | 16663 /* we take the wiphy mutex later ourselves */ 16664 NL80211_FLAG_NO_WIPHY_MTX), 16665 }, 16666 { 16667 .cmd = NL80211_CMD_DEL_INTERFACE, 16668 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16669 .doit = nl80211_del_interface, 16670 .flags = GENL_UNS_ADMIN_PERM, 16671 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 16672 NL80211_FLAG_NEED_RTNL), 16673 }, 16674 { 16675 .cmd = NL80211_CMD_GET_KEY, 16676 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16677 .doit = nl80211_get_key, 16678 .flags = GENL_UNS_ADMIN_PERM, 16679 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16680 }, 16681 { 16682 .cmd = NL80211_CMD_SET_KEY, 16683 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16684 .doit = nl80211_set_key, 16685 .flags = GENL_UNS_ADMIN_PERM, 16686 /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */ 16687 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16688 NL80211_FLAG_CLEAR_SKB), 16689 }, 16690 { 16691 .cmd = NL80211_CMD_NEW_KEY, 16692 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16693 .doit = nl80211_new_key, 16694 .flags = GENL_UNS_ADMIN_PERM, 16695 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16696 NL80211_FLAG_CLEAR_SKB), 16697 }, 16698 { 16699 .cmd = NL80211_CMD_DEL_KEY, 16700 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16701 .doit = nl80211_del_key, 16702 .flags = GENL_UNS_ADMIN_PERM, 16703 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16704 }, 16705 { 16706 .cmd = NL80211_CMD_SET_BEACON, 16707 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16708 .flags = GENL_UNS_ADMIN_PERM, 16709 .doit = nl80211_set_beacon, 16710 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16711 NL80211_FLAG_MLO_VALID_LINK_ID), 16712 }, 16713 { 16714 .cmd = NL80211_CMD_START_AP, 16715 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16716 .flags = GENL_UNS_ADMIN_PERM, 16717 .doit = nl80211_start_ap, 16718 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16719 NL80211_FLAG_MLO_VALID_LINK_ID), 16720 }, 16721 { 16722 .cmd = NL80211_CMD_STOP_AP, 16723 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16724 .flags = GENL_UNS_ADMIN_PERM, 16725 .doit = nl80211_stop_ap, 16726 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16727 NL80211_FLAG_MLO_VALID_LINK_ID), 16728 }, 16729 { 16730 .cmd = NL80211_CMD_GET_STATION, 16731 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16732 .doit = nl80211_get_station, 16733 .dumpit = nl80211_dump_station, 16734 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 16735 }, 16736 { 16737 .cmd = NL80211_CMD_SET_STATION, 16738 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16739 .doit = nl80211_set_station, 16740 .flags = GENL_UNS_ADMIN_PERM, 16741 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16742 }, 16743 { 16744 .cmd = NL80211_CMD_NEW_STATION, 16745 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16746 .doit = nl80211_new_station, 16747 .flags = GENL_UNS_ADMIN_PERM, 16748 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16749 }, 16750 { 16751 .cmd = NL80211_CMD_DEL_STATION, 16752 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16753 .doit = nl80211_del_station, 16754 .flags = GENL_UNS_ADMIN_PERM, 16755 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16756 }, 16757 { 16758 .cmd = NL80211_CMD_GET_MPATH, 16759 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16760 .doit = nl80211_get_mpath, 16761 .dumpit = nl80211_dump_mpath, 16762 .flags = GENL_UNS_ADMIN_PERM, 16763 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16764 }, 16765 { 16766 .cmd = NL80211_CMD_GET_MPP, 16767 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16768 .doit = nl80211_get_mpp, 16769 .dumpit = nl80211_dump_mpp, 16770 .flags = GENL_UNS_ADMIN_PERM, 16771 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16772 }, 16773 { 16774 .cmd = NL80211_CMD_SET_MPATH, 16775 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16776 .doit = nl80211_set_mpath, 16777 .flags = GENL_UNS_ADMIN_PERM, 16778 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16779 }, 16780 { 16781 .cmd = NL80211_CMD_NEW_MPATH, 16782 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16783 .doit = nl80211_new_mpath, 16784 .flags = GENL_UNS_ADMIN_PERM, 16785 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16786 }, 16787 { 16788 .cmd = NL80211_CMD_DEL_MPATH, 16789 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16790 .doit = nl80211_del_mpath, 16791 .flags = GENL_UNS_ADMIN_PERM, 16792 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16793 }, 16794 { 16795 .cmd = NL80211_CMD_SET_BSS, 16796 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16797 .doit = nl80211_set_bss, 16798 .flags = GENL_UNS_ADMIN_PERM, 16799 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16800 NL80211_FLAG_MLO_VALID_LINK_ID), 16801 }, 16802 { 16803 .cmd = NL80211_CMD_GET_REG, 16804 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16805 .doit = nl80211_get_reg_do, 16806 .dumpit = nl80211_get_reg_dump, 16807 /* can be retrieved by unprivileged users */ 16808 }, 16809 #ifdef CONFIG_CFG80211_CRDA_SUPPORT 16810 { 16811 .cmd = NL80211_CMD_SET_REG, 16812 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16813 .doit = nl80211_set_reg, 16814 .flags = GENL_ADMIN_PERM, 16815 }, 16816 #endif 16817 { 16818 .cmd = NL80211_CMD_REQ_SET_REG, 16819 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16820 .doit = nl80211_req_set_reg, 16821 .flags = GENL_ADMIN_PERM, 16822 }, 16823 { 16824 .cmd = NL80211_CMD_RELOAD_REGDB, 16825 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16826 .doit = nl80211_reload_regdb, 16827 .flags = GENL_ADMIN_PERM, 16828 }, 16829 { 16830 .cmd = NL80211_CMD_GET_MESH_CONFIG, 16831 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16832 .doit = nl80211_get_mesh_config, 16833 /* can be retrieved by unprivileged users */ 16834 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16835 }, 16836 { 16837 .cmd = NL80211_CMD_SET_MESH_CONFIG, 16838 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16839 .doit = nl80211_update_mesh_config, 16840 .flags = GENL_UNS_ADMIN_PERM, 16841 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16842 }, 16843 { 16844 .cmd = NL80211_CMD_TRIGGER_SCAN, 16845 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16846 .doit = nl80211_trigger_scan, 16847 .flags = GENL_UNS_ADMIN_PERM, 16848 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 16849 }, 16850 { 16851 .cmd = NL80211_CMD_ABORT_SCAN, 16852 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16853 .doit = nl80211_abort_scan, 16854 .flags = GENL_UNS_ADMIN_PERM, 16855 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 16856 }, 16857 { 16858 .cmd = NL80211_CMD_GET_SCAN, 16859 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16860 .dumpit = nl80211_dump_scan, 16861 }, 16862 { 16863 .cmd = NL80211_CMD_START_SCHED_SCAN, 16864 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16865 .doit = nl80211_start_sched_scan, 16866 .flags = GENL_UNS_ADMIN_PERM, 16867 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16868 }, 16869 { 16870 .cmd = NL80211_CMD_STOP_SCHED_SCAN, 16871 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16872 .doit = nl80211_stop_sched_scan, 16873 .flags = GENL_UNS_ADMIN_PERM, 16874 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16875 }, 16876 { 16877 .cmd = NL80211_CMD_AUTHENTICATE, 16878 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16879 .doit = nl80211_authenticate, 16880 .flags = GENL_UNS_ADMIN_PERM, 16881 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16882 NL80211_FLAG_CLEAR_SKB), 16883 }, 16884 { 16885 .cmd = NL80211_CMD_ASSOCIATE, 16886 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16887 .doit = nl80211_associate, 16888 .flags = GENL_UNS_ADMIN_PERM, 16889 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16890 NL80211_FLAG_CLEAR_SKB), 16891 }, 16892 { 16893 .cmd = NL80211_CMD_DEAUTHENTICATE, 16894 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16895 .doit = nl80211_deauthenticate, 16896 .flags = GENL_UNS_ADMIN_PERM, 16897 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16898 }, 16899 { 16900 .cmd = NL80211_CMD_DISASSOCIATE, 16901 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16902 .doit = nl80211_disassociate, 16903 .flags = GENL_UNS_ADMIN_PERM, 16904 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16905 }, 16906 { 16907 .cmd = NL80211_CMD_JOIN_IBSS, 16908 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16909 .doit = nl80211_join_ibss, 16910 .flags = GENL_UNS_ADMIN_PERM, 16911 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16912 }, 16913 { 16914 .cmd = NL80211_CMD_LEAVE_IBSS, 16915 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16916 .doit = nl80211_leave_ibss, 16917 .flags = GENL_UNS_ADMIN_PERM, 16918 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16919 }, 16920 #ifdef CONFIG_NL80211_TESTMODE 16921 { 16922 .cmd = NL80211_CMD_TESTMODE, 16923 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16924 .doit = nl80211_testmode_do, 16925 .dumpit = nl80211_testmode_dump, 16926 .flags = GENL_UNS_ADMIN_PERM, 16927 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 16928 }, 16929 #endif 16930 { 16931 .cmd = NL80211_CMD_CONNECT, 16932 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16933 .doit = nl80211_connect, 16934 .flags = GENL_UNS_ADMIN_PERM, 16935 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16936 NL80211_FLAG_CLEAR_SKB), 16937 }, 16938 { 16939 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS, 16940 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16941 .doit = nl80211_update_connect_params, 16942 .flags = GENL_ADMIN_PERM, 16943 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16944 NL80211_FLAG_CLEAR_SKB), 16945 }, 16946 { 16947 .cmd = NL80211_CMD_DISCONNECT, 16948 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16949 .doit = nl80211_disconnect, 16950 .flags = GENL_UNS_ADMIN_PERM, 16951 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16952 }, 16953 { 16954 .cmd = NL80211_CMD_SET_WIPHY_NETNS, 16955 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16956 .doit = nl80211_wiphy_netns, 16957 .flags = GENL_UNS_ADMIN_PERM, 16958 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 16959 NL80211_FLAG_NEED_RTNL | 16960 NL80211_FLAG_NO_WIPHY_MTX), 16961 }, 16962 { 16963 .cmd = NL80211_CMD_GET_SURVEY, 16964 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16965 .dumpit = nl80211_dump_survey, 16966 }, 16967 { 16968 .cmd = NL80211_CMD_SET_PMKSA, 16969 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16970 .doit = nl80211_setdel_pmksa, 16971 .flags = GENL_UNS_ADMIN_PERM, 16972 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 16973 NL80211_FLAG_CLEAR_SKB), 16974 }, 16975 { 16976 .cmd = NL80211_CMD_DEL_PMKSA, 16977 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16978 .doit = nl80211_setdel_pmksa, 16979 .flags = GENL_UNS_ADMIN_PERM, 16980 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16981 }, 16982 { 16983 .cmd = NL80211_CMD_FLUSH_PMKSA, 16984 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16985 .doit = nl80211_flush_pmksa, 16986 .flags = GENL_UNS_ADMIN_PERM, 16987 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 16988 }, 16989 { 16990 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL, 16991 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 16992 .doit = nl80211_remain_on_channel, 16993 .flags = GENL_UNS_ADMIN_PERM, 16994 /* FIXME: requiring a link ID here is probably not good */ 16995 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 16996 NL80211_FLAG_MLO_VALID_LINK_ID), 16997 }, 16998 { 16999 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 17000 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17001 .doit = nl80211_cancel_remain_on_channel, 17002 .flags = GENL_UNS_ADMIN_PERM, 17003 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17004 }, 17005 { 17006 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK, 17007 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17008 .doit = nl80211_set_tx_bitrate_mask, 17009 .flags = GENL_UNS_ADMIN_PERM, 17010 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17011 NL80211_FLAG_MLO_VALID_LINK_ID), 17012 }, 17013 { 17014 .cmd = NL80211_CMD_REGISTER_FRAME, 17015 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17016 .doit = nl80211_register_mgmt, 17017 .flags = GENL_UNS_ADMIN_PERM, 17018 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV), 17019 }, 17020 { 17021 .cmd = NL80211_CMD_FRAME, 17022 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17023 .doit = nl80211_tx_mgmt, 17024 .flags = GENL_UNS_ADMIN_PERM, 17025 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17026 }, 17027 { 17028 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL, 17029 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17030 .doit = nl80211_tx_mgmt_cancel_wait, 17031 .flags = GENL_UNS_ADMIN_PERM, 17032 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17033 }, 17034 { 17035 .cmd = NL80211_CMD_SET_POWER_SAVE, 17036 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17037 .doit = nl80211_set_power_save, 17038 .flags = GENL_UNS_ADMIN_PERM, 17039 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17040 }, 17041 { 17042 .cmd = NL80211_CMD_GET_POWER_SAVE, 17043 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17044 .doit = nl80211_get_power_save, 17045 /* can be retrieved by unprivileged users */ 17046 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17047 }, 17048 { 17049 .cmd = NL80211_CMD_SET_CQM, 17050 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17051 .doit = nl80211_set_cqm, 17052 .flags = GENL_UNS_ADMIN_PERM, 17053 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17054 }, 17055 { 17056 .cmd = NL80211_CMD_SET_CHANNEL, 17057 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17058 .doit = nl80211_set_channel, 17059 .flags = GENL_UNS_ADMIN_PERM, 17060 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17061 NL80211_FLAG_MLO_VALID_LINK_ID), 17062 }, 17063 { 17064 .cmd = NL80211_CMD_JOIN_MESH, 17065 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17066 .doit = nl80211_join_mesh, 17067 .flags = GENL_UNS_ADMIN_PERM, 17068 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17069 }, 17070 { 17071 .cmd = NL80211_CMD_LEAVE_MESH, 17072 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17073 .doit = nl80211_leave_mesh, 17074 .flags = GENL_UNS_ADMIN_PERM, 17075 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17076 }, 17077 { 17078 .cmd = NL80211_CMD_JOIN_OCB, 17079 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17080 .doit = nl80211_join_ocb, 17081 .flags = GENL_UNS_ADMIN_PERM, 17082 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17083 }, 17084 { 17085 .cmd = NL80211_CMD_LEAVE_OCB, 17086 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17087 .doit = nl80211_leave_ocb, 17088 .flags = GENL_UNS_ADMIN_PERM, 17089 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17090 }, 17091 #ifdef CONFIG_PM 17092 { 17093 .cmd = NL80211_CMD_GET_WOWLAN, 17094 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17095 .doit = nl80211_get_wowlan, 17096 /* can be retrieved by unprivileged users */ 17097 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17098 }, 17099 { 17100 .cmd = NL80211_CMD_SET_WOWLAN, 17101 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17102 .doit = nl80211_set_wowlan, 17103 .flags = GENL_UNS_ADMIN_PERM, 17104 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17105 }, 17106 #endif 17107 { 17108 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD, 17109 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17110 .doit = nl80211_set_rekey_data, 17111 .flags = GENL_UNS_ADMIN_PERM, 17112 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17113 NL80211_FLAG_CLEAR_SKB), 17114 }, 17115 { 17116 .cmd = NL80211_CMD_TDLS_MGMT, 17117 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17118 .doit = nl80211_tdls_mgmt, 17119 .flags = GENL_UNS_ADMIN_PERM, 17120 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17121 }, 17122 { 17123 .cmd = NL80211_CMD_TDLS_OPER, 17124 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17125 .doit = nl80211_tdls_oper, 17126 .flags = GENL_UNS_ADMIN_PERM, 17127 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17128 }, 17129 { 17130 .cmd = NL80211_CMD_UNEXPECTED_FRAME, 17131 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17132 .doit = nl80211_register_unexpected_frame, 17133 .flags = GENL_UNS_ADMIN_PERM, 17134 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17135 }, 17136 { 17137 .cmd = NL80211_CMD_PROBE_CLIENT, 17138 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17139 .doit = nl80211_probe_client, 17140 .flags = GENL_UNS_ADMIN_PERM, 17141 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17142 }, 17143 { 17144 .cmd = NL80211_CMD_REGISTER_BEACONS, 17145 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17146 .doit = nl80211_register_beacons, 17147 .flags = GENL_UNS_ADMIN_PERM, 17148 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17149 }, 17150 { 17151 .cmd = NL80211_CMD_SET_NOACK_MAP, 17152 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17153 .doit = nl80211_set_noack_map, 17154 .flags = GENL_UNS_ADMIN_PERM, 17155 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17156 }, 17157 { 17158 .cmd = NL80211_CMD_START_P2P_DEVICE, 17159 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17160 .doit = nl80211_start_p2p_device, 17161 .flags = GENL_UNS_ADMIN_PERM, 17162 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17163 NL80211_FLAG_NEED_RTNL), 17164 }, 17165 { 17166 .cmd = NL80211_CMD_STOP_P2P_DEVICE, 17167 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17168 .doit = nl80211_stop_p2p_device, 17169 .flags = GENL_UNS_ADMIN_PERM, 17170 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17171 NL80211_FLAG_NEED_RTNL), 17172 }, 17173 { 17174 .cmd = NL80211_CMD_START_NAN, 17175 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17176 .doit = nl80211_start_nan, 17177 .flags = GENL_ADMIN_PERM, 17178 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV | 17179 NL80211_FLAG_NEED_RTNL), 17180 }, 17181 { 17182 .cmd = NL80211_CMD_STOP_NAN, 17183 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17184 .doit = nl80211_stop_nan, 17185 .flags = GENL_ADMIN_PERM, 17186 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP | 17187 NL80211_FLAG_NEED_RTNL), 17188 }, 17189 { 17190 .cmd = NL80211_CMD_ADD_NAN_FUNCTION, 17191 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17192 .doit = nl80211_nan_add_func, 17193 .flags = GENL_ADMIN_PERM, 17194 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17195 }, 17196 { 17197 .cmd = NL80211_CMD_DEL_NAN_FUNCTION, 17198 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17199 .doit = nl80211_nan_del_func, 17200 .flags = GENL_ADMIN_PERM, 17201 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17202 }, 17203 { 17204 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG, 17205 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17206 .doit = nl80211_nan_change_config, 17207 .flags = GENL_ADMIN_PERM, 17208 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17209 }, 17210 { 17211 .cmd = NL80211_CMD_SET_MCAST_RATE, 17212 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17213 .doit = nl80211_set_mcast_rate, 17214 .flags = GENL_UNS_ADMIN_PERM, 17215 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17216 }, 17217 { 17218 .cmd = NL80211_CMD_SET_MAC_ACL, 17219 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17220 .doit = nl80211_set_mac_acl, 17221 .flags = GENL_UNS_ADMIN_PERM, 17222 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17223 NL80211_FLAG_MLO_UNSUPPORTED), 17224 }, 17225 { 17226 .cmd = NL80211_CMD_RADAR_DETECT, 17227 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17228 .doit = nl80211_start_radar_detection, 17229 .flags = GENL_UNS_ADMIN_PERM, 17230 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17231 NL80211_FLAG_NO_WIPHY_MTX | 17232 NL80211_FLAG_MLO_UNSUPPORTED), 17233 }, 17234 { 17235 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES, 17236 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17237 .doit = nl80211_get_protocol_features, 17238 }, 17239 { 17240 .cmd = NL80211_CMD_UPDATE_FT_IES, 17241 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17242 .doit = nl80211_update_ft_ies, 17243 .flags = GENL_UNS_ADMIN_PERM, 17244 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17245 }, 17246 { 17247 .cmd = NL80211_CMD_CRIT_PROTOCOL_START, 17248 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17249 .doit = nl80211_crit_protocol_start, 17250 .flags = GENL_UNS_ADMIN_PERM, 17251 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17252 }, 17253 { 17254 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP, 17255 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17256 .doit = nl80211_crit_protocol_stop, 17257 .flags = GENL_UNS_ADMIN_PERM, 17258 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17259 }, 17260 { 17261 .cmd = NL80211_CMD_GET_COALESCE, 17262 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17263 .doit = nl80211_get_coalesce, 17264 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17265 }, 17266 { 17267 .cmd = NL80211_CMD_SET_COALESCE, 17268 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17269 .doit = nl80211_set_coalesce, 17270 .flags = GENL_UNS_ADMIN_PERM, 17271 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY), 17272 }, 17273 { 17274 .cmd = NL80211_CMD_CHANNEL_SWITCH, 17275 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17276 .doit = nl80211_channel_switch, 17277 .flags = GENL_UNS_ADMIN_PERM, 17278 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17279 NL80211_FLAG_MLO_VALID_LINK_ID), 17280 }, 17281 { 17282 .cmd = NL80211_CMD_VENDOR, 17283 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17284 .doit = nl80211_vendor_cmd, 17285 .dumpit = nl80211_vendor_cmd_dump, 17286 .flags = GENL_UNS_ADMIN_PERM, 17287 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17288 NL80211_FLAG_CLEAR_SKB), 17289 }, 17290 { 17291 .cmd = NL80211_CMD_SET_QOS_MAP, 17292 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17293 .doit = nl80211_set_qos_map, 17294 .flags = GENL_UNS_ADMIN_PERM, 17295 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17296 }, 17297 { 17298 .cmd = NL80211_CMD_ADD_TX_TS, 17299 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17300 .doit = nl80211_add_tx_ts, 17301 .flags = GENL_UNS_ADMIN_PERM, 17302 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17303 NL80211_FLAG_MLO_UNSUPPORTED), 17304 }, 17305 { 17306 .cmd = NL80211_CMD_DEL_TX_TS, 17307 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17308 .doit = nl80211_del_tx_ts, 17309 .flags = GENL_UNS_ADMIN_PERM, 17310 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17311 }, 17312 { 17313 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH, 17314 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17315 .doit = nl80211_tdls_channel_switch, 17316 .flags = GENL_UNS_ADMIN_PERM, 17317 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17318 }, 17319 { 17320 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH, 17321 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17322 .doit = nl80211_tdls_cancel_channel_switch, 17323 .flags = GENL_UNS_ADMIN_PERM, 17324 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17325 }, 17326 { 17327 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST, 17328 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17329 .doit = nl80211_set_multicast_to_unicast, 17330 .flags = GENL_UNS_ADMIN_PERM, 17331 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV), 17332 }, 17333 { 17334 .cmd = NL80211_CMD_SET_PMK, 17335 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17336 .doit = nl80211_set_pmk, 17337 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17338 NL80211_FLAG_CLEAR_SKB), 17339 }, 17340 { 17341 .cmd = NL80211_CMD_DEL_PMK, 17342 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17343 .doit = nl80211_del_pmk, 17344 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17345 }, 17346 { 17347 .cmd = NL80211_CMD_EXTERNAL_AUTH, 17348 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17349 .doit = nl80211_external_auth, 17350 .flags = GENL_ADMIN_PERM, 17351 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17352 }, 17353 { 17354 .cmd = NL80211_CMD_CONTROL_PORT_FRAME, 17355 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17356 .doit = nl80211_tx_control_port, 17357 .flags = GENL_UNS_ADMIN_PERM, 17358 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17359 }, 17360 { 17361 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS, 17362 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17363 .doit = nl80211_get_ftm_responder_stats, 17364 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17365 NL80211_FLAG_MLO_VALID_LINK_ID), 17366 }, 17367 { 17368 .cmd = NL80211_CMD_PEER_MEASUREMENT_START, 17369 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17370 .doit = nl80211_pmsr_start, 17371 .flags = GENL_UNS_ADMIN_PERM, 17372 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP), 17373 }, 17374 { 17375 .cmd = NL80211_CMD_NOTIFY_RADAR, 17376 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17377 .doit = nl80211_notify_radar_detection, 17378 .flags = GENL_UNS_ADMIN_PERM, 17379 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17380 }, 17381 { 17382 .cmd = NL80211_CMD_UPDATE_OWE_INFO, 17383 .doit = nl80211_update_owe_info, 17384 .flags = GENL_ADMIN_PERM, 17385 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17386 }, 17387 { 17388 .cmd = NL80211_CMD_PROBE_MESH_LINK, 17389 .doit = nl80211_probe_mesh_link, 17390 .flags = GENL_UNS_ADMIN_PERM, 17391 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17392 }, 17393 { 17394 .cmd = NL80211_CMD_SET_TID_CONFIG, 17395 .doit = nl80211_set_tid_config, 17396 .flags = GENL_UNS_ADMIN_PERM, 17397 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV | 17398 NL80211_FLAG_MLO_VALID_LINK_ID), 17399 }, 17400 { 17401 .cmd = NL80211_CMD_SET_SAR_SPECS, 17402 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17403 .doit = nl80211_set_sar_specs, 17404 .flags = GENL_UNS_ADMIN_PERM, 17405 .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY | 17406 NL80211_FLAG_NEED_RTNL), 17407 }, 17408 { 17409 .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST, 17410 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17411 .doit = nl80211_color_change, 17412 .flags = GENL_UNS_ADMIN_PERM, 17413 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17414 }, 17415 { 17416 .cmd = NL80211_CMD_SET_FILS_AAD, 17417 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP, 17418 .doit = nl80211_set_fils_aad, 17419 .flags = GENL_UNS_ADMIN_PERM, 17420 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17421 }, 17422 { 17423 .cmd = NL80211_CMD_ADD_LINK, 17424 .doit = nl80211_add_link, 17425 .flags = GENL_UNS_ADMIN_PERM, 17426 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17427 }, 17428 { 17429 .cmd = NL80211_CMD_REMOVE_LINK, 17430 .doit = nl80211_remove_link, 17431 .flags = GENL_UNS_ADMIN_PERM, 17432 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17433 NL80211_FLAG_MLO_VALID_LINK_ID), 17434 }, 17435 { 17436 .cmd = NL80211_CMD_ADD_LINK_STA, 17437 .doit = nl80211_add_link_station, 17438 .flags = GENL_UNS_ADMIN_PERM, 17439 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17440 NL80211_FLAG_MLO_VALID_LINK_ID), 17441 }, 17442 { 17443 .cmd = NL80211_CMD_MODIFY_LINK_STA, 17444 .doit = nl80211_modify_link_station, 17445 .flags = GENL_UNS_ADMIN_PERM, 17446 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17447 NL80211_FLAG_MLO_VALID_LINK_ID), 17448 }, 17449 { 17450 .cmd = NL80211_CMD_REMOVE_LINK_STA, 17451 .doit = nl80211_remove_link_station, 17452 .flags = GENL_UNS_ADMIN_PERM, 17453 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP | 17454 NL80211_FLAG_MLO_VALID_LINK_ID), 17455 }, 17456 { 17457 .cmd = NL80211_CMD_SET_HW_TIMESTAMP, 17458 .doit = nl80211_set_hw_timestamp, 17459 .flags = GENL_UNS_ADMIN_PERM, 17460 .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP), 17461 }, 17462 }; 17463 17464 static struct genl_family nl80211_fam __ro_after_init = { 17465 .name = NL80211_GENL_NAME, /* have users key off the name instead */ 17466 .hdrsize = 0, /* no private header */ 17467 .version = 1, /* no particular meaning now */ 17468 .maxattr = NL80211_ATTR_MAX, 17469 .policy = nl80211_policy, 17470 .netnsok = true, 17471 .pre_doit = nl80211_pre_doit, 17472 .post_doit = nl80211_post_doit, 17473 .module = THIS_MODULE, 17474 .ops = nl80211_ops, 17475 .n_ops = ARRAY_SIZE(nl80211_ops), 17476 .small_ops = nl80211_small_ops, 17477 .n_small_ops = ARRAY_SIZE(nl80211_small_ops), 17478 .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1, 17479 .mcgrps = nl80211_mcgrps, 17480 .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps), 17481 .parallel_ops = true, 17482 }; 17483 17484 /* notification functions */ 17485 17486 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev, 17487 enum nl80211_commands cmd) 17488 { 17489 struct sk_buff *msg; 17490 struct nl80211_dump_wiphy_state state = {}; 17491 17492 WARN_ON(cmd != NL80211_CMD_NEW_WIPHY && 17493 cmd != NL80211_CMD_DEL_WIPHY); 17494 17495 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17496 if (!msg) 17497 return; 17498 17499 if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) { 17500 nlmsg_free(msg); 17501 return; 17502 } 17503 17504 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17505 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17506 } 17507 17508 void nl80211_notify_iface(struct cfg80211_registered_device *rdev, 17509 struct wireless_dev *wdev, 17510 enum nl80211_commands cmd) 17511 { 17512 struct sk_buff *msg; 17513 17514 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17515 if (!msg) 17516 return; 17517 17518 if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) { 17519 nlmsg_free(msg); 17520 return; 17521 } 17522 17523 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17524 NL80211_MCGRP_CONFIG, GFP_KERNEL); 17525 } 17526 17527 static int nl80211_add_scan_req(struct sk_buff *msg, 17528 struct cfg80211_registered_device *rdev) 17529 { 17530 struct cfg80211_scan_request *req = rdev->scan_req; 17531 struct nlattr *nest; 17532 int i; 17533 struct cfg80211_scan_info *info; 17534 17535 if (WARN_ON(!req)) 17536 return 0; 17537 17538 nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS); 17539 if (!nest) 17540 goto nla_put_failure; 17541 for (i = 0; i < req->n_ssids; i++) { 17542 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid)) 17543 goto nla_put_failure; 17544 } 17545 nla_nest_end(msg, nest); 17546 17547 if (req->flags & NL80211_SCAN_FLAG_FREQ_KHZ) { 17548 nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ); 17549 if (!nest) 17550 goto nla_put_failure; 17551 for (i = 0; i < req->n_channels; i++) { 17552 if (nla_put_u32(msg, i, 17553 ieee80211_channel_to_khz(req->channels[i]))) 17554 goto nla_put_failure; 17555 } 17556 nla_nest_end(msg, nest); 17557 } else { 17558 nest = nla_nest_start_noflag(msg, 17559 NL80211_ATTR_SCAN_FREQUENCIES); 17560 if (!nest) 17561 goto nla_put_failure; 17562 for (i = 0; i < req->n_channels; i++) { 17563 if (nla_put_u32(msg, i, req->channels[i]->center_freq)) 17564 goto nla_put_failure; 17565 } 17566 nla_nest_end(msg, nest); 17567 } 17568 17569 if (req->ie && 17570 nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie)) 17571 goto nla_put_failure; 17572 17573 if (req->flags && 17574 nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags)) 17575 goto nla_put_failure; 17576 17577 info = rdev->int_scan_req ? &rdev->int_scan_req->info : 17578 &rdev->scan_req->info; 17579 if (info->scan_start_tsf && 17580 (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF, 17581 info->scan_start_tsf, NL80211_BSS_PAD) || 17582 nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN, 17583 info->tsf_bssid))) 17584 goto nla_put_failure; 17585 17586 return 0; 17587 nla_put_failure: 17588 return -ENOBUFS; 17589 } 17590 17591 static int nl80211_prep_scan_msg(struct sk_buff *msg, 17592 struct cfg80211_registered_device *rdev, 17593 struct wireless_dev *wdev, 17594 u32 portid, u32 seq, int flags, 17595 u32 cmd) 17596 { 17597 void *hdr; 17598 17599 hdr = nl80211hdr_put(msg, portid, seq, flags, cmd); 17600 if (!hdr) 17601 return -1; 17602 17603 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17604 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 17605 wdev->netdev->ifindex)) || 17606 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 17607 NL80211_ATTR_PAD)) 17608 goto nla_put_failure; 17609 17610 /* ignore errors and send incomplete event anyway */ 17611 nl80211_add_scan_req(msg, rdev); 17612 17613 genlmsg_end(msg, hdr); 17614 return 0; 17615 17616 nla_put_failure: 17617 genlmsg_cancel(msg, hdr); 17618 return -EMSGSIZE; 17619 } 17620 17621 static int 17622 nl80211_prep_sched_scan_msg(struct sk_buff *msg, 17623 struct cfg80211_sched_scan_request *req, u32 cmd) 17624 { 17625 void *hdr; 17626 17627 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 17628 if (!hdr) 17629 return -1; 17630 17631 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, 17632 wiphy_to_rdev(req->wiphy)->wiphy_idx) || 17633 nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) || 17634 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid, 17635 NL80211_ATTR_PAD)) 17636 goto nla_put_failure; 17637 17638 genlmsg_end(msg, hdr); 17639 return 0; 17640 17641 nla_put_failure: 17642 genlmsg_cancel(msg, hdr); 17643 return -EMSGSIZE; 17644 } 17645 17646 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev, 17647 struct wireless_dev *wdev) 17648 { 17649 struct sk_buff *msg; 17650 17651 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17652 if (!msg) 17653 return; 17654 17655 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17656 NL80211_CMD_TRIGGER_SCAN) < 0) { 17657 nlmsg_free(msg); 17658 return; 17659 } 17660 17661 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17662 NL80211_MCGRP_SCAN, GFP_KERNEL); 17663 } 17664 17665 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev, 17666 struct wireless_dev *wdev, bool aborted) 17667 { 17668 struct sk_buff *msg; 17669 17670 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17671 if (!msg) 17672 return NULL; 17673 17674 if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0, 17675 aborted ? NL80211_CMD_SCAN_ABORTED : 17676 NL80211_CMD_NEW_SCAN_RESULTS) < 0) { 17677 nlmsg_free(msg); 17678 return NULL; 17679 } 17680 17681 return msg; 17682 } 17683 17684 /* send message created by nl80211_build_scan_msg() */ 17685 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev, 17686 struct sk_buff *msg) 17687 { 17688 if (!msg) 17689 return; 17690 17691 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17692 NL80211_MCGRP_SCAN, GFP_KERNEL); 17693 } 17694 17695 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd) 17696 { 17697 struct sk_buff *msg; 17698 17699 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17700 if (!msg) 17701 return; 17702 17703 if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) { 17704 nlmsg_free(msg); 17705 return; 17706 } 17707 17708 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0, 17709 NL80211_MCGRP_SCAN, GFP_KERNEL); 17710 } 17711 17712 static bool nl80211_reg_change_event_fill(struct sk_buff *msg, 17713 struct regulatory_request *request) 17714 { 17715 /* Userspace can always count this one always being set */ 17716 if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator)) 17717 goto nla_put_failure; 17718 17719 if (request->alpha2[0] == '0' && request->alpha2[1] == '0') { 17720 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17721 NL80211_REGDOM_TYPE_WORLD)) 17722 goto nla_put_failure; 17723 } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') { 17724 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17725 NL80211_REGDOM_TYPE_CUSTOM_WORLD)) 17726 goto nla_put_failure; 17727 } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') || 17728 request->intersect) { 17729 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17730 NL80211_REGDOM_TYPE_INTERSECTION)) 17731 goto nla_put_failure; 17732 } else { 17733 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE, 17734 NL80211_REGDOM_TYPE_COUNTRY) || 17735 nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, 17736 request->alpha2)) 17737 goto nla_put_failure; 17738 } 17739 17740 if (request->wiphy_idx != WIPHY_IDX_INVALID) { 17741 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx); 17742 17743 if (wiphy && 17744 nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx)) 17745 goto nla_put_failure; 17746 17747 if (wiphy && 17748 wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED && 17749 nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG)) 17750 goto nla_put_failure; 17751 } 17752 17753 return true; 17754 17755 nla_put_failure: 17756 return false; 17757 } 17758 17759 /* 17760 * This can happen on global regulatory changes or device specific settings 17761 * based on custom regulatory domains. 17762 */ 17763 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id, 17764 struct regulatory_request *request) 17765 { 17766 struct sk_buff *msg; 17767 void *hdr; 17768 17769 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 17770 if (!msg) 17771 return; 17772 17773 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id); 17774 if (!hdr) 17775 goto nla_put_failure; 17776 17777 if (!nl80211_reg_change_event_fill(msg, request)) 17778 goto nla_put_failure; 17779 17780 genlmsg_end(msg, hdr); 17781 17782 rcu_read_lock(); 17783 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 17784 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 17785 rcu_read_unlock(); 17786 17787 return; 17788 17789 nla_put_failure: 17790 nlmsg_free(msg); 17791 } 17792 17793 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev, 17794 struct net_device *netdev, 17795 const u8 *buf, size_t len, 17796 enum nl80211_commands cmd, gfp_t gfp, 17797 int uapsd_queues, const u8 *req_ies, 17798 size_t req_ies_len, bool reconnect) 17799 { 17800 struct sk_buff *msg; 17801 void *hdr; 17802 17803 msg = nlmsg_new(100 + len + req_ies_len, gfp); 17804 if (!msg) 17805 return; 17806 17807 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 17808 if (!hdr) { 17809 nlmsg_free(msg); 17810 return; 17811 } 17812 17813 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17814 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 17815 nla_put(msg, NL80211_ATTR_FRAME, len, buf) || 17816 (req_ies && 17817 nla_put(msg, NL80211_ATTR_REQ_IE, req_ies_len, req_ies))) 17818 goto nla_put_failure; 17819 17820 if (reconnect && nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED)) 17821 goto nla_put_failure; 17822 17823 if (uapsd_queues >= 0) { 17824 struct nlattr *nla_wmm = 17825 nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME); 17826 if (!nla_wmm) 17827 goto nla_put_failure; 17828 17829 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES, 17830 uapsd_queues)) 17831 goto nla_put_failure; 17832 17833 nla_nest_end(msg, nla_wmm); 17834 } 17835 17836 genlmsg_end(msg, hdr); 17837 17838 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17839 NL80211_MCGRP_MLME, gfp); 17840 return; 17841 17842 nla_put_failure: 17843 nlmsg_free(msg); 17844 } 17845 17846 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev, 17847 struct net_device *netdev, const u8 *buf, 17848 size_t len, gfp_t gfp) 17849 { 17850 nl80211_send_mlme_event(rdev, netdev, buf, len, 17851 NL80211_CMD_AUTHENTICATE, gfp, -1, NULL, 0, 17852 false); 17853 } 17854 17855 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev, 17856 struct net_device *netdev, 17857 struct cfg80211_rx_assoc_resp *data) 17858 { 17859 nl80211_send_mlme_event(rdev, netdev, data->buf, data->len, 17860 NL80211_CMD_ASSOCIATE, GFP_KERNEL, 17861 data->uapsd_queues, 17862 data->req_ies, data->req_ies_len, false); 17863 } 17864 17865 void nl80211_send_deauth(struct cfg80211_registered_device *rdev, 17866 struct net_device *netdev, const u8 *buf, 17867 size_t len, bool reconnect, gfp_t gfp) 17868 { 17869 nl80211_send_mlme_event(rdev, netdev, buf, len, 17870 NL80211_CMD_DEAUTHENTICATE, gfp, -1, NULL, 0, 17871 reconnect); 17872 } 17873 17874 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev, 17875 struct net_device *netdev, const u8 *buf, 17876 size_t len, bool reconnect, gfp_t gfp) 17877 { 17878 nl80211_send_mlme_event(rdev, netdev, buf, len, 17879 NL80211_CMD_DISASSOCIATE, gfp, -1, NULL, 0, 17880 reconnect); 17881 } 17882 17883 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf, 17884 size_t len) 17885 { 17886 struct wireless_dev *wdev = dev->ieee80211_ptr; 17887 struct wiphy *wiphy = wdev->wiphy; 17888 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 17889 const struct ieee80211_mgmt *mgmt = (void *)buf; 17890 u32 cmd; 17891 17892 if (WARN_ON(len < 2)) 17893 return; 17894 17895 if (ieee80211_is_deauth(mgmt->frame_control)) { 17896 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE; 17897 } else if (ieee80211_is_disassoc(mgmt->frame_control)) { 17898 cmd = NL80211_CMD_UNPROT_DISASSOCIATE; 17899 } else if (ieee80211_is_beacon(mgmt->frame_control)) { 17900 if (wdev->unprot_beacon_reported && 17901 elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000) 17902 return; 17903 cmd = NL80211_CMD_UNPROT_BEACON; 17904 wdev->unprot_beacon_reported = jiffies; 17905 } else { 17906 return; 17907 } 17908 17909 trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len); 17910 nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1, 17911 NULL, 0, false); 17912 } 17913 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt); 17914 17915 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev, 17916 struct net_device *netdev, int cmd, 17917 const u8 *addr, gfp_t gfp) 17918 { 17919 struct sk_buff *msg; 17920 void *hdr; 17921 17922 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 17923 if (!msg) 17924 return; 17925 17926 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 17927 if (!hdr) { 17928 nlmsg_free(msg); 17929 return; 17930 } 17931 17932 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 17933 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 17934 nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 17935 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 17936 goto nla_put_failure; 17937 17938 genlmsg_end(msg, hdr); 17939 17940 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 17941 NL80211_MCGRP_MLME, gfp); 17942 return; 17943 17944 nla_put_failure: 17945 nlmsg_free(msg); 17946 } 17947 17948 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev, 17949 struct net_device *netdev, const u8 *addr, 17950 gfp_t gfp) 17951 { 17952 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE, 17953 addr, gfp); 17954 } 17955 17956 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev, 17957 struct net_device *netdev, const u8 *addr, 17958 gfp_t gfp) 17959 { 17960 nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE, 17961 addr, gfp); 17962 } 17963 17964 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev, 17965 struct net_device *netdev, 17966 struct cfg80211_connect_resp_params *cr, 17967 gfp_t gfp) 17968 { 17969 struct sk_buff *msg; 17970 void *hdr; 17971 unsigned int link; 17972 size_t link_info_size = 0; 17973 const u8 *connected_addr = cr->valid_links ? 17974 cr->ap_mld_addr : cr->links[0].bssid; 17975 17976 if (cr->valid_links) { 17977 for_each_valid_link(cr, link) { 17978 /* Nested attribute header */ 17979 link_info_size += NLA_HDRLEN; 17980 /* Link ID */ 17981 link_info_size += nla_total_size(sizeof(u8)); 17982 link_info_size += cr->links[link].addr ? 17983 nla_total_size(ETH_ALEN) : 0; 17984 link_info_size += (cr->links[link].bssid || 17985 cr->links[link].bss) ? 17986 nla_total_size(ETH_ALEN) : 0; 17987 link_info_size += nla_total_size(sizeof(u16)); 17988 } 17989 } 17990 17991 msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len + 17992 cr->fils.kek_len + cr->fils.pmk_len + 17993 (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size, 17994 gfp); 17995 if (!msg) 17996 return; 17997 17998 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT); 17999 if (!hdr) { 18000 nlmsg_free(msg); 18001 return; 18002 } 18003 18004 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18005 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18006 (connected_addr && 18007 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) || 18008 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18009 cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE : 18010 cr->status) || 18011 (cr->status < 0 && 18012 (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) || 18013 nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON, 18014 cr->timeout_reason))) || 18015 (cr->req_ie && 18016 nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) || 18017 (cr->resp_ie && 18018 nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len, 18019 cr->resp_ie)) || 18020 (cr->fils.update_erp_next_seq_num && 18021 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18022 cr->fils.erp_next_seq_num)) || 18023 (cr->status == WLAN_STATUS_SUCCESS && 18024 ((cr->fils.kek && 18025 nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len, 18026 cr->fils.kek)) || 18027 (cr->fils.pmk && 18028 nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) || 18029 (cr->fils.pmkid && 18030 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid))))) 18031 goto nla_put_failure; 18032 18033 if (cr->valid_links) { 18034 int i = 1; 18035 struct nlattr *nested; 18036 18037 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18038 if (!nested) 18039 goto nla_put_failure; 18040 18041 for_each_valid_link(cr, link) { 18042 struct nlattr *nested_mlo_links; 18043 const u8 *bssid = cr->links[link].bss ? 18044 cr->links[link].bss->bssid : 18045 cr->links[link].bssid; 18046 18047 nested_mlo_links = nla_nest_start(msg, i); 18048 if (!nested_mlo_links) 18049 goto nla_put_failure; 18050 18051 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18052 (bssid && 18053 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18054 (cr->links[link].addr && 18055 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18056 cr->links[link].addr)) || 18057 nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, 18058 cr->links[link].status)) 18059 goto nla_put_failure; 18060 18061 nla_nest_end(msg, nested_mlo_links); 18062 i++; 18063 } 18064 nla_nest_end(msg, nested); 18065 } 18066 18067 genlmsg_end(msg, hdr); 18068 18069 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18070 NL80211_MCGRP_MLME, gfp); 18071 return; 18072 18073 nla_put_failure: 18074 nlmsg_free(msg); 18075 } 18076 18077 void nl80211_send_roamed(struct cfg80211_registered_device *rdev, 18078 struct net_device *netdev, 18079 struct cfg80211_roam_info *info, gfp_t gfp) 18080 { 18081 struct sk_buff *msg; 18082 void *hdr; 18083 size_t link_info_size = 0; 18084 unsigned int link; 18085 const u8 *connected_addr = info->ap_mld_addr ? 18086 info->ap_mld_addr : 18087 (info->links[0].bss ? 18088 info->links[0].bss->bssid : 18089 info->links[0].bssid); 18090 18091 if (info->valid_links) { 18092 for_each_valid_link(info, link) { 18093 /* Nested attribute header */ 18094 link_info_size += NLA_HDRLEN; 18095 /* Link ID */ 18096 link_info_size += nla_total_size(sizeof(u8)); 18097 link_info_size += info->links[link].addr ? 18098 nla_total_size(ETH_ALEN) : 0; 18099 link_info_size += (info->links[link].bssid || 18100 info->links[link].bss) ? 18101 nla_total_size(ETH_ALEN) : 0; 18102 } 18103 } 18104 18105 msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len + 18106 info->fils.kek_len + info->fils.pmk_len + 18107 (info->fils.pmkid ? WLAN_PMKID_LEN : 0) + 18108 link_info_size, gfp); 18109 if (!msg) 18110 return; 18111 18112 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM); 18113 if (!hdr) { 18114 nlmsg_free(msg); 18115 return; 18116 } 18117 18118 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18119 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18120 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) || 18121 (info->req_ie && 18122 nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len, 18123 info->req_ie)) || 18124 (info->resp_ie && 18125 nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len, 18126 info->resp_ie)) || 18127 (info->fils.update_erp_next_seq_num && 18128 nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM, 18129 info->fils.erp_next_seq_num)) || 18130 (info->fils.kek && 18131 nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len, 18132 info->fils.kek)) || 18133 (info->fils.pmk && 18134 nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) || 18135 (info->fils.pmkid && 18136 nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid))) 18137 goto nla_put_failure; 18138 18139 if (info->valid_links) { 18140 int i = 1; 18141 struct nlattr *nested; 18142 18143 nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS); 18144 if (!nested) 18145 goto nla_put_failure; 18146 18147 for_each_valid_link(info, link) { 18148 struct nlattr *nested_mlo_links; 18149 const u8 *bssid = info->links[link].bss ? 18150 info->links[link].bss->bssid : 18151 info->links[link].bssid; 18152 18153 nested_mlo_links = nla_nest_start(msg, i); 18154 if (!nested_mlo_links) 18155 goto nla_put_failure; 18156 18157 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) || 18158 (bssid && 18159 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) || 18160 (info->links[link].addr && 18161 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, 18162 info->links[link].addr))) 18163 goto nla_put_failure; 18164 18165 nla_nest_end(msg, nested_mlo_links); 18166 i++; 18167 } 18168 nla_nest_end(msg, nested); 18169 } 18170 18171 genlmsg_end(msg, hdr); 18172 18173 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18174 NL80211_MCGRP_MLME, gfp); 18175 return; 18176 18177 nla_put_failure: 18178 nlmsg_free(msg); 18179 } 18180 18181 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev, 18182 struct net_device *netdev, const u8 *bssid, 18183 const u8 *td_bitmap, u8 td_bitmap_len) 18184 { 18185 struct sk_buff *msg; 18186 void *hdr; 18187 18188 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18189 if (!msg) 18190 return; 18191 18192 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED); 18193 if (!hdr) { 18194 nlmsg_free(msg); 18195 return; 18196 } 18197 18198 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18199 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18200 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 18201 goto nla_put_failure; 18202 18203 if ((td_bitmap_len > 0) && td_bitmap) 18204 if (nla_put(msg, NL80211_ATTR_TD_BITMAP, 18205 td_bitmap_len, td_bitmap)) 18206 goto nla_put_failure; 18207 18208 genlmsg_end(msg, hdr); 18209 18210 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18211 NL80211_MCGRP_MLME, GFP_KERNEL); 18212 return; 18213 18214 nla_put_failure: 18215 nlmsg_free(msg); 18216 } 18217 18218 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev, 18219 struct net_device *netdev, u16 reason, 18220 const u8 *ie, size_t ie_len, bool from_ap) 18221 { 18222 struct sk_buff *msg; 18223 void *hdr; 18224 18225 msg = nlmsg_new(100 + ie_len, GFP_KERNEL); 18226 if (!msg) 18227 return; 18228 18229 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT); 18230 if (!hdr) { 18231 nlmsg_free(msg); 18232 return; 18233 } 18234 18235 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18236 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18237 (reason && 18238 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) || 18239 (from_ap && 18240 nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) || 18241 (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie))) 18242 goto nla_put_failure; 18243 18244 genlmsg_end(msg, hdr); 18245 18246 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18247 NL80211_MCGRP_MLME, GFP_KERNEL); 18248 return; 18249 18250 nla_put_failure: 18251 nlmsg_free(msg); 18252 } 18253 18254 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev, 18255 struct net_device *netdev, const u8 *bssid, 18256 gfp_t gfp) 18257 { 18258 struct sk_buff *msg; 18259 void *hdr; 18260 18261 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18262 if (!msg) 18263 return; 18264 18265 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS); 18266 if (!hdr) { 18267 nlmsg_free(msg); 18268 return; 18269 } 18270 18271 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18272 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18273 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 18274 goto nla_put_failure; 18275 18276 genlmsg_end(msg, hdr); 18277 18278 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18279 NL80211_MCGRP_MLME, gfp); 18280 return; 18281 18282 nla_put_failure: 18283 nlmsg_free(msg); 18284 } 18285 18286 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr, 18287 const u8 *ie, u8 ie_len, 18288 int sig_dbm, gfp_t gfp) 18289 { 18290 struct wireless_dev *wdev = dev->ieee80211_ptr; 18291 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18292 struct sk_buff *msg; 18293 void *hdr; 18294 18295 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT)) 18296 return; 18297 18298 trace_cfg80211_notify_new_peer_candidate(dev, addr); 18299 18300 msg = nlmsg_new(100 + ie_len, gfp); 18301 if (!msg) 18302 return; 18303 18304 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE); 18305 if (!hdr) { 18306 nlmsg_free(msg); 18307 return; 18308 } 18309 18310 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18311 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18312 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 18313 (ie_len && ie && 18314 nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) || 18315 (sig_dbm && 18316 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm))) 18317 goto nla_put_failure; 18318 18319 genlmsg_end(msg, hdr); 18320 18321 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18322 NL80211_MCGRP_MLME, gfp); 18323 return; 18324 18325 nla_put_failure: 18326 nlmsg_free(msg); 18327 } 18328 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate); 18329 18330 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev, 18331 struct net_device *netdev, const u8 *addr, 18332 enum nl80211_key_type key_type, int key_id, 18333 const u8 *tsc, gfp_t gfp) 18334 { 18335 struct sk_buff *msg; 18336 void *hdr; 18337 18338 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18339 if (!msg) 18340 return; 18341 18342 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE); 18343 if (!hdr) { 18344 nlmsg_free(msg); 18345 return; 18346 } 18347 18348 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18349 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18350 (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) || 18351 nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) || 18352 (key_id != -1 && 18353 nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) || 18354 (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc))) 18355 goto nla_put_failure; 18356 18357 genlmsg_end(msg, hdr); 18358 18359 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18360 NL80211_MCGRP_MLME, gfp); 18361 return; 18362 18363 nla_put_failure: 18364 nlmsg_free(msg); 18365 } 18366 18367 void nl80211_send_beacon_hint_event(struct wiphy *wiphy, 18368 struct ieee80211_channel *channel_before, 18369 struct ieee80211_channel *channel_after) 18370 { 18371 struct sk_buff *msg; 18372 void *hdr; 18373 struct nlattr *nl_freq; 18374 18375 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC); 18376 if (!msg) 18377 return; 18378 18379 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT); 18380 if (!hdr) { 18381 nlmsg_free(msg); 18382 return; 18383 } 18384 18385 /* 18386 * Since we are applying the beacon hint to a wiphy we know its 18387 * wiphy_idx is valid 18388 */ 18389 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy))) 18390 goto nla_put_failure; 18391 18392 /* Before */ 18393 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE); 18394 if (!nl_freq) 18395 goto nla_put_failure; 18396 18397 if (nl80211_msg_put_channel(msg, wiphy, channel_before, false)) 18398 goto nla_put_failure; 18399 nla_nest_end(msg, nl_freq); 18400 18401 /* After */ 18402 nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER); 18403 if (!nl_freq) 18404 goto nla_put_failure; 18405 18406 if (nl80211_msg_put_channel(msg, wiphy, channel_after, false)) 18407 goto nla_put_failure; 18408 nla_nest_end(msg, nl_freq); 18409 18410 genlmsg_end(msg, hdr); 18411 18412 rcu_read_lock(); 18413 genlmsg_multicast_allns(&nl80211_fam, msg, 0, 18414 NL80211_MCGRP_REGULATORY, GFP_ATOMIC); 18415 rcu_read_unlock(); 18416 18417 return; 18418 18419 nla_put_failure: 18420 nlmsg_free(msg); 18421 } 18422 18423 static void nl80211_send_remain_on_chan_event( 18424 int cmd, struct cfg80211_registered_device *rdev, 18425 struct wireless_dev *wdev, u64 cookie, 18426 struct ieee80211_channel *chan, 18427 unsigned int duration, gfp_t gfp) 18428 { 18429 struct sk_buff *msg; 18430 void *hdr; 18431 18432 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18433 if (!msg) 18434 return; 18435 18436 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18437 if (!hdr) { 18438 nlmsg_free(msg); 18439 return; 18440 } 18441 18442 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18443 (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18444 wdev->netdev->ifindex)) || 18445 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18446 NL80211_ATTR_PAD) || 18447 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) || 18448 nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, 18449 NL80211_CHAN_NO_HT) || 18450 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 18451 NL80211_ATTR_PAD)) 18452 goto nla_put_failure; 18453 18454 if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL && 18455 nla_put_u32(msg, NL80211_ATTR_DURATION, duration)) 18456 goto nla_put_failure; 18457 18458 genlmsg_end(msg, hdr); 18459 18460 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18461 NL80211_MCGRP_MLME, gfp); 18462 return; 18463 18464 nla_put_failure: 18465 nlmsg_free(msg); 18466 } 18467 18468 void cfg80211_assoc_comeback(struct net_device *netdev, 18469 const u8 *ap_addr, u32 timeout) 18470 { 18471 struct wireless_dev *wdev = netdev->ieee80211_ptr; 18472 struct wiphy *wiphy = wdev->wiphy; 18473 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18474 struct sk_buff *msg; 18475 void *hdr; 18476 18477 trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout); 18478 18479 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 18480 if (!msg) 18481 return; 18482 18483 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK); 18484 if (!hdr) { 18485 nlmsg_free(msg); 18486 return; 18487 } 18488 18489 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18490 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 18491 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) || 18492 nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout)) 18493 goto nla_put_failure; 18494 18495 genlmsg_end(msg, hdr); 18496 18497 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18498 NL80211_MCGRP_MLME, GFP_KERNEL); 18499 return; 18500 18501 nla_put_failure: 18502 nlmsg_free(msg); 18503 } 18504 EXPORT_SYMBOL(cfg80211_assoc_comeback); 18505 18506 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie, 18507 struct ieee80211_channel *chan, 18508 unsigned int duration, gfp_t gfp) 18509 { 18510 struct wiphy *wiphy = wdev->wiphy; 18511 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18512 18513 trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration); 18514 nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL, 18515 rdev, wdev, cookie, chan, 18516 duration, gfp); 18517 } 18518 EXPORT_SYMBOL(cfg80211_ready_on_channel); 18519 18520 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie, 18521 struct ieee80211_channel *chan, 18522 gfp_t gfp) 18523 { 18524 struct wiphy *wiphy = wdev->wiphy; 18525 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18526 18527 trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan); 18528 nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL, 18529 rdev, wdev, cookie, chan, 0, gfp); 18530 } 18531 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired); 18532 18533 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie, 18534 struct ieee80211_channel *chan, 18535 gfp_t gfp) 18536 { 18537 struct wiphy *wiphy = wdev->wiphy; 18538 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18539 18540 trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan); 18541 nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL, 18542 rdev, wdev, cookie, chan, 0, gfp); 18543 } 18544 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired); 18545 18546 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr, 18547 struct station_info *sinfo, gfp_t gfp) 18548 { 18549 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18550 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18551 struct sk_buff *msg; 18552 18553 trace_cfg80211_new_sta(dev, mac_addr, sinfo); 18554 18555 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18556 if (!msg) 18557 return; 18558 18559 if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0, 18560 rdev, dev, mac_addr, sinfo) < 0) { 18561 nlmsg_free(msg); 18562 return; 18563 } 18564 18565 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18566 NL80211_MCGRP_MLME, gfp); 18567 } 18568 EXPORT_SYMBOL(cfg80211_new_sta); 18569 18570 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr, 18571 struct station_info *sinfo, gfp_t gfp) 18572 { 18573 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18574 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18575 struct sk_buff *msg; 18576 struct station_info empty_sinfo = {}; 18577 18578 if (!sinfo) 18579 sinfo = &empty_sinfo; 18580 18581 trace_cfg80211_del_sta(dev, mac_addr); 18582 18583 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18584 if (!msg) { 18585 cfg80211_sinfo_release_content(sinfo); 18586 return; 18587 } 18588 18589 if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0, 18590 rdev, dev, mac_addr, sinfo) < 0) { 18591 nlmsg_free(msg); 18592 return; 18593 } 18594 18595 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18596 NL80211_MCGRP_MLME, gfp); 18597 } 18598 EXPORT_SYMBOL(cfg80211_del_sta_sinfo); 18599 18600 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr, 18601 enum nl80211_connect_failed_reason reason, 18602 gfp_t gfp) 18603 { 18604 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; 18605 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18606 struct sk_buff *msg; 18607 void *hdr; 18608 18609 msg = nlmsg_new(NLMSG_GOODSIZE, gfp); 18610 if (!msg) 18611 return; 18612 18613 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED); 18614 if (!hdr) { 18615 nlmsg_free(msg); 18616 return; 18617 } 18618 18619 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18620 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) || 18621 nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason)) 18622 goto nla_put_failure; 18623 18624 genlmsg_end(msg, hdr); 18625 18626 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18627 NL80211_MCGRP_MLME, gfp); 18628 return; 18629 18630 nla_put_failure: 18631 nlmsg_free(msg); 18632 } 18633 EXPORT_SYMBOL(cfg80211_conn_failed); 18634 18635 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd, 18636 const u8 *addr, gfp_t gfp) 18637 { 18638 struct wireless_dev *wdev = dev->ieee80211_ptr; 18639 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18640 struct sk_buff *msg; 18641 void *hdr; 18642 u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid); 18643 18644 if (!nlportid) 18645 return false; 18646 18647 msg = nlmsg_new(100, gfp); 18648 if (!msg) 18649 return true; 18650 18651 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 18652 if (!hdr) { 18653 nlmsg_free(msg); 18654 return true; 18655 } 18656 18657 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18658 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18659 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) 18660 goto nla_put_failure; 18661 18662 genlmsg_end(msg, hdr); 18663 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 18664 return true; 18665 18666 nla_put_failure: 18667 nlmsg_free(msg); 18668 return true; 18669 } 18670 18671 bool cfg80211_rx_spurious_frame(struct net_device *dev, 18672 const u8 *addr, gfp_t gfp) 18673 { 18674 struct wireless_dev *wdev = dev->ieee80211_ptr; 18675 bool ret; 18676 18677 trace_cfg80211_rx_spurious_frame(dev, addr); 18678 18679 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 18680 wdev->iftype != NL80211_IFTYPE_P2P_GO)) { 18681 trace_cfg80211_return_bool(false); 18682 return false; 18683 } 18684 ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME, 18685 addr, gfp); 18686 trace_cfg80211_return_bool(ret); 18687 return ret; 18688 } 18689 EXPORT_SYMBOL(cfg80211_rx_spurious_frame); 18690 18691 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev, 18692 const u8 *addr, gfp_t gfp) 18693 { 18694 struct wireless_dev *wdev = dev->ieee80211_ptr; 18695 bool ret; 18696 18697 trace_cfg80211_rx_unexpected_4addr_frame(dev, addr); 18698 18699 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP && 18700 wdev->iftype != NL80211_IFTYPE_P2P_GO && 18701 wdev->iftype != NL80211_IFTYPE_AP_VLAN)) { 18702 trace_cfg80211_return_bool(false); 18703 return false; 18704 } 18705 ret = __nl80211_unexpected_frame(dev, 18706 NL80211_CMD_UNEXPECTED_4ADDR_FRAME, 18707 addr, gfp); 18708 trace_cfg80211_return_bool(ret); 18709 return ret; 18710 } 18711 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame); 18712 18713 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev, 18714 struct wireless_dev *wdev, u32 nlportid, 18715 struct cfg80211_rx_info *info, gfp_t gfp) 18716 { 18717 struct net_device *netdev = wdev->netdev; 18718 struct sk_buff *msg; 18719 void *hdr; 18720 18721 msg = nlmsg_new(100 + info->len, gfp); 18722 if (!msg) 18723 return -ENOMEM; 18724 18725 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 18726 if (!hdr) { 18727 nlmsg_free(msg); 18728 return -ENOMEM; 18729 } 18730 18731 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18732 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18733 netdev->ifindex)) || 18734 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18735 NL80211_ATTR_PAD) || 18736 (info->have_link_id && 18737 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) || 18738 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) || 18739 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) || 18740 (info->sig_dbm && 18741 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) || 18742 nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) || 18743 (info->flags && 18744 nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) || 18745 (info->rx_tstamp && nla_put_u64_64bit(msg, 18746 NL80211_ATTR_RX_HW_TIMESTAMP, 18747 info->rx_tstamp, 18748 NL80211_ATTR_PAD)) || 18749 (info->ack_tstamp && nla_put_u64_64bit(msg, 18750 NL80211_ATTR_TX_HW_TIMESTAMP, 18751 info->ack_tstamp, 18752 NL80211_ATTR_PAD))) 18753 goto nla_put_failure; 18754 18755 genlmsg_end(msg, hdr); 18756 18757 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 18758 18759 nla_put_failure: 18760 nlmsg_free(msg); 18761 return -ENOBUFS; 18762 } 18763 18764 static void nl80211_frame_tx_status(struct wireless_dev *wdev, 18765 struct cfg80211_tx_status *status, 18766 gfp_t gfp, enum nl80211_commands command) 18767 { 18768 struct wiphy *wiphy = wdev->wiphy; 18769 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 18770 struct net_device *netdev = wdev->netdev; 18771 struct sk_buff *msg; 18772 void *hdr; 18773 18774 if (command == NL80211_CMD_FRAME_TX_STATUS) 18775 trace_cfg80211_mgmt_tx_status(wdev, status->cookie, 18776 status->ack); 18777 else 18778 trace_cfg80211_control_port_tx_status(wdev, status->cookie, 18779 status->ack); 18780 18781 msg = nlmsg_new(100 + status->len, gfp); 18782 if (!msg) 18783 return; 18784 18785 hdr = nl80211hdr_put(msg, 0, 0, 0, command); 18786 if (!hdr) { 18787 nlmsg_free(msg); 18788 return; 18789 } 18790 18791 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18792 (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 18793 netdev->ifindex)) || 18794 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18795 NL80211_ATTR_PAD) || 18796 nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) || 18797 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie, 18798 NL80211_ATTR_PAD) || 18799 (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) || 18800 (status->tx_tstamp && 18801 nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP, 18802 status->tx_tstamp, NL80211_ATTR_PAD)) || 18803 (status->ack_tstamp && 18804 nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP, 18805 status->ack_tstamp, NL80211_ATTR_PAD))) 18806 goto nla_put_failure; 18807 18808 genlmsg_end(msg, hdr); 18809 18810 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18811 NL80211_MCGRP_MLME, gfp); 18812 return; 18813 18814 nla_put_failure: 18815 nlmsg_free(msg); 18816 } 18817 18818 void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie, 18819 const u8 *buf, size_t len, bool ack, 18820 gfp_t gfp) 18821 { 18822 struct cfg80211_tx_status status = { 18823 .cookie = cookie, 18824 .buf = buf, 18825 .len = len, 18826 .ack = ack 18827 }; 18828 18829 nl80211_frame_tx_status(wdev, &status, gfp, 18830 NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS); 18831 } 18832 EXPORT_SYMBOL(cfg80211_control_port_tx_status); 18833 18834 void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev, 18835 struct cfg80211_tx_status *status, gfp_t gfp) 18836 { 18837 nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS); 18838 } 18839 EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext); 18840 18841 static int __nl80211_rx_control_port(struct net_device *dev, 18842 struct sk_buff *skb, 18843 bool unencrypted, 18844 int link_id, 18845 gfp_t gfp) 18846 { 18847 struct wireless_dev *wdev = dev->ieee80211_ptr; 18848 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18849 struct ethhdr *ehdr = eth_hdr(skb); 18850 const u8 *addr = ehdr->h_source; 18851 u16 proto = be16_to_cpu(skb->protocol); 18852 struct sk_buff *msg; 18853 void *hdr; 18854 struct nlattr *frame; 18855 18856 u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid); 18857 18858 if (!nlportid) 18859 return -ENOENT; 18860 18861 msg = nlmsg_new(100 + skb->len, gfp); 18862 if (!msg) 18863 return -ENOMEM; 18864 18865 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME); 18866 if (!hdr) { 18867 nlmsg_free(msg); 18868 return -ENOBUFS; 18869 } 18870 18871 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18872 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 18873 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 18874 NL80211_ATTR_PAD) || 18875 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 18876 nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) || 18877 (link_id >= 0 && 18878 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) || 18879 (unencrypted && nla_put_flag(msg, 18880 NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT))) 18881 goto nla_put_failure; 18882 18883 frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len); 18884 if (!frame) 18885 goto nla_put_failure; 18886 18887 skb_copy_bits(skb, 0, nla_data(frame), skb->len); 18888 genlmsg_end(msg, hdr); 18889 18890 return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 18891 18892 nla_put_failure: 18893 nlmsg_free(msg); 18894 return -ENOBUFS; 18895 } 18896 18897 bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb, 18898 bool unencrypted, int link_id) 18899 { 18900 int ret; 18901 18902 trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id); 18903 ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id, 18904 GFP_ATOMIC); 18905 trace_cfg80211_return_bool(ret == 0); 18906 return ret == 0; 18907 } 18908 EXPORT_SYMBOL(cfg80211_rx_control_port); 18909 18910 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev, 18911 const char *mac, gfp_t gfp) 18912 { 18913 struct wireless_dev *wdev = dev->ieee80211_ptr; 18914 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18915 struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 18916 void **cb; 18917 18918 if (!msg) 18919 return NULL; 18920 18921 cb = (void **)msg->cb; 18922 18923 cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM); 18924 if (!cb[0]) { 18925 nlmsg_free(msg); 18926 return NULL; 18927 } 18928 18929 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 18930 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 18931 goto nla_put_failure; 18932 18933 if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 18934 goto nla_put_failure; 18935 18936 cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM); 18937 if (!cb[1]) 18938 goto nla_put_failure; 18939 18940 cb[2] = rdev; 18941 18942 return msg; 18943 nla_put_failure: 18944 nlmsg_free(msg); 18945 return NULL; 18946 } 18947 18948 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp) 18949 { 18950 void **cb = (void **)msg->cb; 18951 struct cfg80211_registered_device *rdev = cb[2]; 18952 18953 nla_nest_end(msg, cb[1]); 18954 genlmsg_end(msg, cb[0]); 18955 18956 memset(msg->cb, 0, sizeof(msg->cb)); 18957 18958 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 18959 NL80211_MCGRP_MLME, gfp); 18960 } 18961 18962 void cfg80211_cqm_rssi_notify(struct net_device *dev, 18963 enum nl80211_cqm_rssi_threshold_event rssi_event, 18964 s32 rssi_level, gfp_t gfp) 18965 { 18966 struct sk_buff *msg; 18967 struct wireless_dev *wdev = dev->ieee80211_ptr; 18968 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 18969 18970 trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level); 18971 18972 if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW && 18973 rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH)) 18974 return; 18975 18976 if (wdev->cqm_config) { 18977 wdev->cqm_config->last_rssi_event_value = rssi_level; 18978 18979 cfg80211_cqm_rssi_update(rdev, dev); 18980 18981 if (rssi_level == 0) 18982 rssi_level = wdev->cqm_config->last_rssi_event_value; 18983 } 18984 18985 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 18986 if (!msg) 18987 return; 18988 18989 if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT, 18990 rssi_event)) 18991 goto nla_put_failure; 18992 18993 if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL, 18994 rssi_level)) 18995 goto nla_put_failure; 18996 18997 cfg80211_send_cqm(msg, gfp); 18998 18999 return; 19000 19001 nla_put_failure: 19002 nlmsg_free(msg); 19003 } 19004 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify); 19005 19006 void cfg80211_cqm_txe_notify(struct net_device *dev, 19007 const u8 *peer, u32 num_packets, 19008 u32 rate, u32 intvl, gfp_t gfp) 19009 { 19010 struct sk_buff *msg; 19011 19012 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19013 if (!msg) 19014 return; 19015 19016 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets)) 19017 goto nla_put_failure; 19018 19019 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate)) 19020 goto nla_put_failure; 19021 19022 if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl)) 19023 goto nla_put_failure; 19024 19025 cfg80211_send_cqm(msg, gfp); 19026 return; 19027 19028 nla_put_failure: 19029 nlmsg_free(msg); 19030 } 19031 EXPORT_SYMBOL(cfg80211_cqm_txe_notify); 19032 19033 void cfg80211_cqm_pktloss_notify(struct net_device *dev, 19034 const u8 *peer, u32 num_packets, gfp_t gfp) 19035 { 19036 struct sk_buff *msg; 19037 19038 trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets); 19039 19040 msg = cfg80211_prepare_cqm(dev, peer, gfp); 19041 if (!msg) 19042 return; 19043 19044 if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets)) 19045 goto nla_put_failure; 19046 19047 cfg80211_send_cqm(msg, gfp); 19048 return; 19049 19050 nla_put_failure: 19051 nlmsg_free(msg); 19052 } 19053 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify); 19054 19055 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp) 19056 { 19057 struct sk_buff *msg; 19058 19059 msg = cfg80211_prepare_cqm(dev, NULL, gfp); 19060 if (!msg) 19061 return; 19062 19063 if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT)) 19064 goto nla_put_failure; 19065 19066 cfg80211_send_cqm(msg, gfp); 19067 return; 19068 19069 nla_put_failure: 19070 nlmsg_free(msg); 19071 } 19072 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify); 19073 19074 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev, 19075 struct net_device *netdev, const u8 *bssid, 19076 const u8 *replay_ctr, gfp_t gfp) 19077 { 19078 struct sk_buff *msg; 19079 struct nlattr *rekey_attr; 19080 void *hdr; 19081 19082 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19083 if (!msg) 19084 return; 19085 19086 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD); 19087 if (!hdr) { 19088 nlmsg_free(msg); 19089 return; 19090 } 19091 19092 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19093 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19094 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) 19095 goto nla_put_failure; 19096 19097 rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA); 19098 if (!rekey_attr) 19099 goto nla_put_failure; 19100 19101 if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR, 19102 NL80211_REPLAY_CTR_LEN, replay_ctr)) 19103 goto nla_put_failure; 19104 19105 nla_nest_end(msg, rekey_attr); 19106 19107 genlmsg_end(msg, hdr); 19108 19109 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19110 NL80211_MCGRP_MLME, gfp); 19111 return; 19112 19113 nla_put_failure: 19114 nlmsg_free(msg); 19115 } 19116 19117 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid, 19118 const u8 *replay_ctr, gfp_t gfp) 19119 { 19120 struct wireless_dev *wdev = dev->ieee80211_ptr; 19121 struct wiphy *wiphy = wdev->wiphy; 19122 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19123 19124 trace_cfg80211_gtk_rekey_notify(dev, bssid); 19125 nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp); 19126 } 19127 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify); 19128 19129 static void 19130 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev, 19131 struct net_device *netdev, int index, 19132 const u8 *bssid, bool preauth, gfp_t gfp) 19133 { 19134 struct sk_buff *msg; 19135 struct nlattr *attr; 19136 void *hdr; 19137 19138 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19139 if (!msg) 19140 return; 19141 19142 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE); 19143 if (!hdr) { 19144 nlmsg_free(msg); 19145 return; 19146 } 19147 19148 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19149 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19150 goto nla_put_failure; 19151 19152 attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE); 19153 if (!attr) 19154 goto nla_put_failure; 19155 19156 if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) || 19157 nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) || 19158 (preauth && 19159 nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH))) 19160 goto nla_put_failure; 19161 19162 nla_nest_end(msg, attr); 19163 19164 genlmsg_end(msg, hdr); 19165 19166 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19167 NL80211_MCGRP_MLME, gfp); 19168 return; 19169 19170 nla_put_failure: 19171 nlmsg_free(msg); 19172 } 19173 19174 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index, 19175 const u8 *bssid, bool preauth, gfp_t gfp) 19176 { 19177 struct wireless_dev *wdev = dev->ieee80211_ptr; 19178 struct wiphy *wiphy = wdev->wiphy; 19179 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19180 19181 trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth); 19182 nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp); 19183 } 19184 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify); 19185 19186 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev, 19187 struct net_device *netdev, 19188 unsigned int link_id, 19189 struct cfg80211_chan_def *chandef, 19190 gfp_t gfp, 19191 enum nl80211_commands notif, 19192 u8 count, bool quiet, u16 punct_bitmap) 19193 { 19194 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19195 struct sk_buff *msg; 19196 void *hdr; 19197 19198 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19199 if (!msg) 19200 return; 19201 19202 hdr = nl80211hdr_put(msg, 0, 0, 0, notif); 19203 if (!hdr) { 19204 nlmsg_free(msg); 19205 return; 19206 } 19207 19208 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex)) 19209 goto nla_put_failure; 19210 19211 if (wdev->valid_links && 19212 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) 19213 goto nla_put_failure; 19214 19215 if (nl80211_send_chandef(msg, chandef)) 19216 goto nla_put_failure; 19217 19218 if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) { 19219 if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)) 19220 goto nla_put_failure; 19221 if (quiet && 19222 nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX)) 19223 goto nla_put_failure; 19224 } 19225 19226 if (nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, punct_bitmap)) 19227 goto nla_put_failure; 19228 19229 genlmsg_end(msg, hdr); 19230 19231 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19232 NL80211_MCGRP_MLME, gfp); 19233 return; 19234 19235 nla_put_failure: 19236 nlmsg_free(msg); 19237 } 19238 19239 void cfg80211_ch_switch_notify(struct net_device *dev, 19240 struct cfg80211_chan_def *chandef, 19241 unsigned int link_id, u16 punct_bitmap) 19242 { 19243 struct wireless_dev *wdev = dev->ieee80211_ptr; 19244 struct wiphy *wiphy = wdev->wiphy; 19245 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19246 19247 ASSERT_WDEV_LOCK(wdev); 19248 WARN_INVALID_LINK_ID(wdev, link_id); 19249 19250 trace_cfg80211_ch_switch_notify(dev, chandef, link_id, punct_bitmap); 19251 19252 switch (wdev->iftype) { 19253 case NL80211_IFTYPE_STATION: 19254 case NL80211_IFTYPE_P2P_CLIENT: 19255 if (!WARN_ON(!wdev->links[link_id].client.current_bss)) 19256 cfg80211_update_assoc_bss_entry(wdev, link_id, 19257 chandef->chan); 19258 break; 19259 case NL80211_IFTYPE_MESH_POINT: 19260 wdev->u.mesh.chandef = *chandef; 19261 wdev->u.mesh.preset_chandef = *chandef; 19262 break; 19263 case NL80211_IFTYPE_AP: 19264 case NL80211_IFTYPE_P2P_GO: 19265 wdev->links[link_id].ap.chandef = *chandef; 19266 break; 19267 case NL80211_IFTYPE_ADHOC: 19268 wdev->u.ibss.chandef = *chandef; 19269 break; 19270 default: 19271 WARN_ON(1); 19272 break; 19273 } 19274 19275 cfg80211_sched_dfs_chan_update(rdev); 19276 19277 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19278 NL80211_CMD_CH_SWITCH_NOTIFY, 0, false, 19279 punct_bitmap); 19280 } 19281 EXPORT_SYMBOL(cfg80211_ch_switch_notify); 19282 19283 void cfg80211_ch_switch_started_notify(struct net_device *dev, 19284 struct cfg80211_chan_def *chandef, 19285 unsigned int link_id, u8 count, 19286 bool quiet, u16 punct_bitmap) 19287 { 19288 struct wireless_dev *wdev = dev->ieee80211_ptr; 19289 struct wiphy *wiphy = wdev->wiphy; 19290 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19291 19292 ASSERT_WDEV_LOCK(wdev); 19293 WARN_INVALID_LINK_ID(wdev, link_id); 19294 19295 trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id, 19296 punct_bitmap); 19297 19298 19299 nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL, 19300 NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, 19301 count, quiet, punct_bitmap); 19302 } 19303 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify); 19304 19305 int cfg80211_bss_color_notify(struct net_device *dev, 19306 enum nl80211_commands cmd, u8 count, 19307 u64 color_bitmap) 19308 { 19309 struct wireless_dev *wdev = dev->ieee80211_ptr; 19310 struct wiphy *wiphy = wdev->wiphy; 19311 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19312 struct sk_buff *msg; 19313 void *hdr; 19314 19315 ASSERT_WDEV_LOCK(wdev); 19316 19317 trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap); 19318 19319 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19320 if (!msg) 19321 return -ENOMEM; 19322 19323 hdr = nl80211hdr_put(msg, 0, 0, 0, cmd); 19324 if (!hdr) 19325 goto nla_put_failure; 19326 19327 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19328 goto nla_put_failure; 19329 19330 if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED && 19331 nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count)) 19332 goto nla_put_failure; 19333 19334 if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION && 19335 nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP, 19336 color_bitmap, NL80211_ATTR_PAD)) 19337 goto nla_put_failure; 19338 19339 genlmsg_end(msg, hdr); 19340 19341 return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), 19342 msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL); 19343 19344 nla_put_failure: 19345 nlmsg_free(msg); 19346 return -EINVAL; 19347 } 19348 EXPORT_SYMBOL(cfg80211_bss_color_notify); 19349 19350 void 19351 nl80211_radar_notify(struct cfg80211_registered_device *rdev, 19352 const struct cfg80211_chan_def *chandef, 19353 enum nl80211_radar_event event, 19354 struct net_device *netdev, gfp_t gfp) 19355 { 19356 struct sk_buff *msg; 19357 void *hdr; 19358 19359 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19360 if (!msg) 19361 return; 19362 19363 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT); 19364 if (!hdr) { 19365 nlmsg_free(msg); 19366 return; 19367 } 19368 19369 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19370 goto nla_put_failure; 19371 19372 /* NOP and radar events don't need a netdev parameter */ 19373 if (netdev) { 19374 struct wireless_dev *wdev = netdev->ieee80211_ptr; 19375 19376 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19377 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19378 NL80211_ATTR_PAD)) 19379 goto nla_put_failure; 19380 } 19381 19382 if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event)) 19383 goto nla_put_failure; 19384 19385 if (nl80211_send_chandef(msg, chandef)) 19386 goto nla_put_failure; 19387 19388 genlmsg_end(msg, hdr); 19389 19390 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19391 NL80211_MCGRP_MLME, gfp); 19392 return; 19393 19394 nla_put_failure: 19395 nlmsg_free(msg); 19396 } 19397 19398 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac, 19399 struct sta_opmode_info *sta_opmode, 19400 gfp_t gfp) 19401 { 19402 struct sk_buff *msg; 19403 struct wireless_dev *wdev = dev->ieee80211_ptr; 19404 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19405 void *hdr; 19406 19407 if (WARN_ON(!mac)) 19408 return; 19409 19410 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19411 if (!msg) 19412 return; 19413 19414 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED); 19415 if (!hdr) { 19416 nlmsg_free(msg); 19417 return; 19418 } 19419 19420 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx)) 19421 goto nla_put_failure; 19422 19423 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex)) 19424 goto nla_put_failure; 19425 19426 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac)) 19427 goto nla_put_failure; 19428 19429 if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) && 19430 nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode)) 19431 goto nla_put_failure; 19432 19433 if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) && 19434 nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw)) 19435 goto nla_put_failure; 19436 19437 if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) && 19438 nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss)) 19439 goto nla_put_failure; 19440 19441 genlmsg_end(msg, hdr); 19442 19443 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19444 NL80211_MCGRP_MLME, gfp); 19445 19446 return; 19447 19448 nla_put_failure: 19449 nlmsg_free(msg); 19450 } 19451 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify); 19452 19453 void cfg80211_probe_status(struct net_device *dev, const u8 *addr, 19454 u64 cookie, bool acked, s32 ack_signal, 19455 bool is_valid_ack_signal, gfp_t gfp) 19456 { 19457 struct wireless_dev *wdev = dev->ieee80211_ptr; 19458 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19459 struct sk_buff *msg; 19460 void *hdr; 19461 19462 trace_cfg80211_probe_status(dev, addr, cookie, acked); 19463 19464 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19465 19466 if (!msg) 19467 return; 19468 19469 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT); 19470 if (!hdr) { 19471 nlmsg_free(msg); 19472 return; 19473 } 19474 19475 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19476 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19477 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) || 19478 nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie, 19479 NL80211_ATTR_PAD) || 19480 (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) || 19481 (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL, 19482 ack_signal))) 19483 goto nla_put_failure; 19484 19485 genlmsg_end(msg, hdr); 19486 19487 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19488 NL80211_MCGRP_MLME, gfp); 19489 return; 19490 19491 nla_put_failure: 19492 nlmsg_free(msg); 19493 } 19494 EXPORT_SYMBOL(cfg80211_probe_status); 19495 19496 void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame, 19497 size_t len, int freq, int sig_dbm) 19498 { 19499 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19500 struct sk_buff *msg; 19501 void *hdr; 19502 struct cfg80211_beacon_registration *reg; 19503 19504 trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm); 19505 19506 spin_lock_bh(&rdev->beacon_registrations_lock); 19507 list_for_each_entry(reg, &rdev->beacon_registrations, list) { 19508 msg = nlmsg_new(len + 100, GFP_ATOMIC); 19509 if (!msg) { 19510 spin_unlock_bh(&rdev->beacon_registrations_lock); 19511 return; 19512 } 19513 19514 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME); 19515 if (!hdr) 19516 goto nla_put_failure; 19517 19518 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19519 (freq && 19520 (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, 19521 KHZ_TO_MHZ(freq)) || 19522 nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, 19523 freq % 1000))) || 19524 (sig_dbm && 19525 nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) || 19526 nla_put(msg, NL80211_ATTR_FRAME, len, frame)) 19527 goto nla_put_failure; 19528 19529 genlmsg_end(msg, hdr); 19530 19531 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid); 19532 } 19533 spin_unlock_bh(&rdev->beacon_registrations_lock); 19534 return; 19535 19536 nla_put_failure: 19537 spin_unlock_bh(&rdev->beacon_registrations_lock); 19538 nlmsg_free(msg); 19539 } 19540 EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz); 19541 19542 #ifdef CONFIG_PM 19543 static int cfg80211_net_detect_results(struct sk_buff *msg, 19544 struct cfg80211_wowlan_wakeup *wakeup) 19545 { 19546 struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect; 19547 struct nlattr *nl_results, *nl_match, *nl_freqs; 19548 int i, j; 19549 19550 nl_results = nla_nest_start_noflag(msg, 19551 NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS); 19552 if (!nl_results) 19553 return -EMSGSIZE; 19554 19555 for (i = 0; i < nd->n_matches; i++) { 19556 struct cfg80211_wowlan_nd_match *match = nd->matches[i]; 19557 19558 nl_match = nla_nest_start_noflag(msg, i); 19559 if (!nl_match) 19560 break; 19561 19562 /* The SSID attribute is optional in nl80211, but for 19563 * simplicity reasons it's always present in the 19564 * cfg80211 structure. If a driver can't pass the 19565 * SSID, that needs to be changed. A zero length SSID 19566 * is still a valid SSID (wildcard), so it cannot be 19567 * used for this purpose. 19568 */ 19569 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len, 19570 match->ssid.ssid)) { 19571 nla_nest_cancel(msg, nl_match); 19572 goto out; 19573 } 19574 19575 if (match->n_channels) { 19576 nl_freqs = nla_nest_start_noflag(msg, 19577 NL80211_ATTR_SCAN_FREQUENCIES); 19578 if (!nl_freqs) { 19579 nla_nest_cancel(msg, nl_match); 19580 goto out; 19581 } 19582 19583 for (j = 0; j < match->n_channels; j++) { 19584 if (nla_put_u32(msg, j, match->channels[j])) { 19585 nla_nest_cancel(msg, nl_freqs); 19586 nla_nest_cancel(msg, nl_match); 19587 goto out; 19588 } 19589 } 19590 19591 nla_nest_end(msg, nl_freqs); 19592 } 19593 19594 nla_nest_end(msg, nl_match); 19595 } 19596 19597 out: 19598 nla_nest_end(msg, nl_results); 19599 return 0; 19600 } 19601 19602 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev, 19603 struct cfg80211_wowlan_wakeup *wakeup, 19604 gfp_t gfp) 19605 { 19606 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19607 struct sk_buff *msg; 19608 void *hdr; 19609 int size = 200; 19610 19611 trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup); 19612 19613 if (wakeup) 19614 size += wakeup->packet_present_len; 19615 19616 msg = nlmsg_new(size, gfp); 19617 if (!msg) 19618 return; 19619 19620 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN); 19621 if (!hdr) 19622 goto free_msg; 19623 19624 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19625 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19626 NL80211_ATTR_PAD)) 19627 goto free_msg; 19628 19629 if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX, 19630 wdev->netdev->ifindex)) 19631 goto free_msg; 19632 19633 if (wakeup) { 19634 struct nlattr *reasons; 19635 19636 reasons = nla_nest_start_noflag(msg, 19637 NL80211_ATTR_WOWLAN_TRIGGERS); 19638 if (!reasons) 19639 goto free_msg; 19640 19641 if (wakeup->disconnect && 19642 nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) 19643 goto free_msg; 19644 if (wakeup->magic_pkt && 19645 nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) 19646 goto free_msg; 19647 if (wakeup->gtk_rekey_failure && 19648 nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) 19649 goto free_msg; 19650 if (wakeup->eap_identity_req && 19651 nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) 19652 goto free_msg; 19653 if (wakeup->four_way_handshake && 19654 nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) 19655 goto free_msg; 19656 if (wakeup->rfkill_release && 19657 nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)) 19658 goto free_msg; 19659 19660 if (wakeup->pattern_idx >= 0 && 19661 nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN, 19662 wakeup->pattern_idx)) 19663 goto free_msg; 19664 19665 if (wakeup->tcp_match && 19666 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH)) 19667 goto free_msg; 19668 19669 if (wakeup->tcp_connlost && 19670 nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST)) 19671 goto free_msg; 19672 19673 if (wakeup->tcp_nomoretokens && 19674 nla_put_flag(msg, 19675 NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS)) 19676 goto free_msg; 19677 19678 if (wakeup->packet) { 19679 u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211; 19680 u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN; 19681 19682 if (!wakeup->packet_80211) { 19683 pkt_attr = 19684 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023; 19685 len_attr = 19686 NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN; 19687 } 19688 19689 if (wakeup->packet_len && 19690 nla_put_u32(msg, len_attr, wakeup->packet_len)) 19691 goto free_msg; 19692 19693 if (nla_put(msg, pkt_attr, wakeup->packet_present_len, 19694 wakeup->packet)) 19695 goto free_msg; 19696 } 19697 19698 if (wakeup->net_detect && 19699 cfg80211_net_detect_results(msg, wakeup)) 19700 goto free_msg; 19701 19702 nla_nest_end(msg, reasons); 19703 } 19704 19705 genlmsg_end(msg, hdr); 19706 19707 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19708 NL80211_MCGRP_MLME, gfp); 19709 return; 19710 19711 free_msg: 19712 nlmsg_free(msg); 19713 } 19714 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup); 19715 #endif 19716 19717 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer, 19718 enum nl80211_tdls_operation oper, 19719 u16 reason_code, gfp_t gfp) 19720 { 19721 struct wireless_dev *wdev = dev->ieee80211_ptr; 19722 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19723 struct sk_buff *msg; 19724 void *hdr; 19725 19726 trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper, 19727 reason_code); 19728 19729 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19730 if (!msg) 19731 return; 19732 19733 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER); 19734 if (!hdr) { 19735 nlmsg_free(msg); 19736 return; 19737 } 19738 19739 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19740 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19741 nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) || 19742 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) || 19743 (reason_code > 0 && 19744 nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code))) 19745 goto nla_put_failure; 19746 19747 genlmsg_end(msg, hdr); 19748 19749 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19750 NL80211_MCGRP_MLME, gfp); 19751 return; 19752 19753 nla_put_failure: 19754 nlmsg_free(msg); 19755 } 19756 EXPORT_SYMBOL(cfg80211_tdls_oper_request); 19757 19758 static int nl80211_netlink_notify(struct notifier_block * nb, 19759 unsigned long state, 19760 void *_notify) 19761 { 19762 struct netlink_notify *notify = _notify; 19763 struct cfg80211_registered_device *rdev; 19764 struct wireless_dev *wdev; 19765 struct cfg80211_beacon_registration *reg, *tmp; 19766 19767 if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC) 19768 return NOTIFY_DONE; 19769 19770 rcu_read_lock(); 19771 19772 list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) { 19773 struct cfg80211_sched_scan_request *sched_scan_req; 19774 19775 list_for_each_entry_rcu(sched_scan_req, 19776 &rdev->sched_scan_req_list, 19777 list) { 19778 if (sched_scan_req->owner_nlportid == notify->portid) { 19779 sched_scan_req->nl_owner_dead = true; 19780 wiphy_work_queue(&rdev->wiphy, 19781 &rdev->sched_scan_stop_wk); 19782 } 19783 } 19784 19785 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) { 19786 cfg80211_mlme_unregister_socket(wdev, notify->portid); 19787 19788 if (wdev->owner_nlportid == notify->portid) { 19789 wdev->nl_owner_dead = true; 19790 schedule_work(&rdev->destroy_work); 19791 } else if (wdev->conn_owner_nlportid == notify->portid) { 19792 schedule_work(&wdev->disconnect_wk); 19793 } 19794 19795 cfg80211_release_pmsr(wdev, notify->portid); 19796 } 19797 19798 spin_lock_bh(&rdev->beacon_registrations_lock); 19799 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations, 19800 list) { 19801 if (reg->nlportid == notify->portid) { 19802 list_del(®->list); 19803 kfree(reg); 19804 break; 19805 } 19806 } 19807 spin_unlock_bh(&rdev->beacon_registrations_lock); 19808 } 19809 19810 rcu_read_unlock(); 19811 19812 /* 19813 * It is possible that the user space process that is controlling the 19814 * indoor setting disappeared, so notify the regulatory core. 19815 */ 19816 regulatory_netlink_notify(notify->portid); 19817 return NOTIFY_OK; 19818 } 19819 19820 static struct notifier_block nl80211_netlink_notifier = { 19821 .notifier_call = nl80211_netlink_notify, 19822 }; 19823 19824 void cfg80211_ft_event(struct net_device *netdev, 19825 struct cfg80211_ft_event_params *ft_event) 19826 { 19827 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 19828 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19829 struct sk_buff *msg; 19830 void *hdr; 19831 19832 trace_cfg80211_ft_event(wiphy, netdev, ft_event); 19833 19834 if (!ft_event->target_ap) 19835 return; 19836 19837 msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len, 19838 GFP_KERNEL); 19839 if (!msg) 19840 return; 19841 19842 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT); 19843 if (!hdr) 19844 goto out; 19845 19846 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19847 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 19848 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap)) 19849 goto out; 19850 19851 if (ft_event->ies && 19852 nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies)) 19853 goto out; 19854 if (ft_event->ric_ies && 19855 nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len, 19856 ft_event->ric_ies)) 19857 goto out; 19858 19859 genlmsg_end(msg, hdr); 19860 19861 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 19862 NL80211_MCGRP_MLME, GFP_KERNEL); 19863 return; 19864 out: 19865 nlmsg_free(msg); 19866 } 19867 EXPORT_SYMBOL(cfg80211_ft_event); 19868 19869 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp) 19870 { 19871 struct cfg80211_registered_device *rdev; 19872 struct sk_buff *msg; 19873 void *hdr; 19874 u32 nlportid; 19875 19876 rdev = wiphy_to_rdev(wdev->wiphy); 19877 if (!rdev->crit_proto_nlportid) 19878 return; 19879 19880 nlportid = rdev->crit_proto_nlportid; 19881 rdev->crit_proto_nlportid = 0; 19882 19883 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19884 if (!msg) 19885 return; 19886 19887 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP); 19888 if (!hdr) 19889 goto nla_put_failure; 19890 19891 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19892 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19893 NL80211_ATTR_PAD)) 19894 goto nla_put_failure; 19895 19896 genlmsg_end(msg, hdr); 19897 19898 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid); 19899 return; 19900 19901 nla_put_failure: 19902 nlmsg_free(msg); 19903 } 19904 EXPORT_SYMBOL(cfg80211_crit_proto_stopped); 19905 19906 void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id) 19907 { 19908 struct wiphy *wiphy = wdev->wiphy; 19909 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19910 struct sk_buff *msg; 19911 void *hdr; 19912 19913 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL); 19914 if (!msg) 19915 return; 19916 19917 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP); 19918 if (!hdr) 19919 goto out; 19920 19921 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19922 nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) || 19923 nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev), 19924 NL80211_ATTR_PAD) || 19925 (wdev->valid_links && 19926 nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))) 19927 goto out; 19928 19929 genlmsg_end(msg, hdr); 19930 19931 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0, 19932 NL80211_MCGRP_MLME, GFP_KERNEL); 19933 return; 19934 out: 19935 nlmsg_free(msg); 19936 } 19937 19938 int cfg80211_external_auth_request(struct net_device *dev, 19939 struct cfg80211_external_auth_params *params, 19940 gfp_t gfp) 19941 { 19942 struct wireless_dev *wdev = dev->ieee80211_ptr; 19943 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy); 19944 struct sk_buff *msg; 19945 void *hdr; 19946 19947 if (!wdev->conn_owner_nlportid) 19948 return -EINVAL; 19949 19950 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19951 if (!msg) 19952 return -ENOMEM; 19953 19954 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH); 19955 if (!hdr) 19956 goto nla_put_failure; 19957 19958 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 19959 nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) || 19960 nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) || 19961 nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION, 19962 params->action) || 19963 nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) || 19964 nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len, 19965 params->ssid.ssid) || 19966 (!is_zero_ether_addr(params->mld_addr) && 19967 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr))) 19968 goto nla_put_failure; 19969 19970 genlmsg_end(msg, hdr); 19971 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, 19972 wdev->conn_owner_nlportid); 19973 return 0; 19974 19975 nla_put_failure: 19976 nlmsg_free(msg); 19977 return -ENOBUFS; 19978 } 19979 EXPORT_SYMBOL(cfg80211_external_auth_request); 19980 19981 void cfg80211_update_owe_info_event(struct net_device *netdev, 19982 struct cfg80211_update_owe_info *owe_info, 19983 gfp_t gfp) 19984 { 19985 struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy; 19986 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy); 19987 struct sk_buff *msg; 19988 void *hdr; 19989 19990 trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info); 19991 19992 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp); 19993 if (!msg) 19994 return; 19995 19996 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO); 19997 if (!hdr) 19998 goto nla_put_failure; 19999 20000 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) || 20001 nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) || 20002 nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer)) 20003 goto nla_put_failure; 20004 20005 if (!owe_info->ie_len || 20006 nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie)) 20007 goto nla_put_failure; 20008 20009 if (owe_info->assoc_link_id != -1) { 20010 if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, 20011 owe_info->assoc_link_id)) 20012 goto nla_put_failure; 20013 20014 if (!is_zero_ether_addr(owe_info->peer_mld_addr) && 20015 nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, 20016 owe_info->peer_mld_addr)) 20017 goto nla_put_failure; 20018 } 20019 20020 genlmsg_end(msg, hdr); 20021 20022 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0, 20023 NL80211_MCGRP_MLME, gfp); 20024 return; 20025 20026 nla_put_failure: 20027 genlmsg_cancel(msg, hdr); 20028 nlmsg_free(msg); 20029 } 20030 EXPORT_SYMBOL(cfg80211_update_owe_info_event); 20031 20032 /* initialisation/exit functions */ 20033 20034 int __init nl80211_init(void) 20035 { 20036 int err; 20037 20038 err = genl_register_family(&nl80211_fam); 20039 if (err) 20040 return err; 20041 20042 err = netlink_register_notifier(&nl80211_netlink_notifier); 20043 if (err) 20044 goto err_out; 20045 20046 return 0; 20047 err_out: 20048 genl_unregister_family(&nl80211_fam); 20049 return err; 20050 } 20051 20052 void nl80211_exit(void) 20053 { 20054 netlink_unregister_notifier(&nl80211_netlink_notifier); 20055 genl_unregister_family(&nl80211_fam); 20056 } 20057