net/wireless/nl80211.c

   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-2019 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 <net/net_namespace.h>
  24 #include <net/genetlink.h>
  25 #include <net/cfg80211.h>
  26 #include <net/sock.h>
  27 #include <net/inet_connection_sock.h>
  28 #include "core.h"
  29 #include "nl80211.h"
  30 #include "reg.h"
  31 #include "rdev-ops.h"
  32
  33 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  34                                    struct genl_info *info,
  35                                    struct cfg80211_crypto_settings *settings,
  36                                    int cipher_limit);
  37
  38 /* the netlink family */
  39 static struct genl_family nl80211_fam;
  40
  41 /* multicast groups */
  42 enum nl80211_multicast_groups {
  43         NL80211_MCGRP_CONFIG,
  44         NL80211_MCGRP_SCAN,
  45         NL80211_MCGRP_REGULATORY,
  46         NL80211_MCGRP_MLME,
  47         NL80211_MCGRP_VENDOR,
  48         NL80211_MCGRP_NAN,
  49         NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
  50 };
  51
  52 static const struct genl_multicast_group nl80211_mcgrps[] = {
  53         [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
  54         [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
  55         [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
  56         [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
  57         [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
  58         [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
  59 #ifdef CONFIG_NL80211_TESTMODE
  60         [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
  61 #endif
  62 };
  63
  64 /* returns ERR_PTR values */
  65 static struct wireless_dev *
  66 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
  67 {
  68         struct cfg80211_registered_device *rdev;
  69         struct wireless_dev *result = NULL;
  70         bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
  71         bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
  72         u64 wdev_id;
  73         int wiphy_idx = -1;
  74         int ifidx = -1;
  75
  76         ASSERT_RTNL();
  77
  78         if (!have_ifidx && !have_wdev_id)
  79                 return ERR_PTR(-EINVAL);
  80
  81         if (have_ifidx)
  82                 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  83         if (have_wdev_id) {
  84                 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  85                 wiphy_idx = wdev_id >> 32;
  86         }
  87
  88         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  89                 struct wireless_dev *wdev;
  90
  91                 if (wiphy_net(&rdev->wiphy) != netns)
  92                         continue;
  93
  94                 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
  95                         continue;
  96
  97                 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  98                         if (have_ifidx && wdev->netdev &&
  99                             wdev->netdev->ifindex == ifidx) {
 100                                 result = wdev;
 101                                 break;
 102                         }
 103                         if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
 104                                 result = wdev;
 105                                 break;
 106                         }
 107                 }
 108
 109                 if (result)
 110                         break;
 111         }
 112
 113         if (result)
 114                 return result;
 115         return ERR_PTR(-ENODEV);
 116 }
 117
 118 static struct cfg80211_registered_device *
 119 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
 120 {
 121         struct cfg80211_registered_device *rdev = NULL, *tmp;
 122         struct net_device *netdev;
 123
 124         ASSERT_RTNL();
 125
 126         if (!attrs[NL80211_ATTR_WIPHY] &&
 127             !attrs[NL80211_ATTR_IFINDEX] &&
 128             !attrs[NL80211_ATTR_WDEV])
 129                 return ERR_PTR(-EINVAL);
 130
 131         if (attrs[NL80211_ATTR_WIPHY])
 132                 rdev = cfg80211_rdev_by_wiphy_idx(
 133                                 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
 134
 135         if (attrs[NL80211_ATTR_WDEV]) {
 136                 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
 137                 struct wireless_dev *wdev;
 138                 bool found = false;
 139
 140                 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
 141                 if (tmp) {
 142                         /* make sure wdev exists */
 143                         list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
 144                                 if (wdev->identifier != (u32)wdev_id)
 145                                         continue;
 146                                 found = true;
 147                                 break;
 148                         }
 149
 150                         if (!found)
 151                                 tmp = NULL;
 152
 153                         if (rdev && tmp != rdev)
 154                                 return ERR_PTR(-EINVAL);
 155                         rdev = tmp;
 156                 }
 157         }
 158
 159         if (attrs[NL80211_ATTR_IFINDEX]) {
 160                 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
 161
 162                 netdev = __dev_get_by_index(netns, ifindex);
 163                 if (netdev) {
 164                         if (netdev->ieee80211_ptr)
 165                                 tmp = wiphy_to_rdev(
 166                                         netdev->ieee80211_ptr->wiphy);
 167                         else
 168                                 tmp = NULL;
 169
 170                         /* not wireless device -- return error */
 171                         if (!tmp)
 172                                 return ERR_PTR(-EINVAL);
 173
 174                         /* mismatch -- return error */
 175                         if (rdev && tmp != rdev)
 176                                 return ERR_PTR(-EINVAL);
 177
 178                         rdev = tmp;
 179                 }
 180         }
 181
 182         if (!rdev)
 183                 return ERR_PTR(-ENODEV);
 184
 185         if (netns != wiphy_net(&rdev->wiphy))
 186                 return ERR_PTR(-ENODEV);
 187
 188         return rdev;
 189 }
 190
 191 /*
 192  * This function returns a pointer to the driver
 193  * that the genl_info item that is passed refers to.
 194  *
 195  * The result of this can be a PTR_ERR and hence must
 196  * be checked with IS_ERR() for errors.
 197  */
 198 static struct cfg80211_registered_device *
 199 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
 200 {
 201         return __cfg80211_rdev_from_attrs(netns, info->attrs);
 202 }
 203
 204 static int validate_beacon_head(const struct nlattr *attr,
 205                                 struct netlink_ext_ack *extack)
 206 {
 207         const u8 *data = nla_data(attr);
 208         unsigned int len = nla_len(attr);
 209         const struct element *elem;
 210         const struct ieee80211_mgmt *mgmt = (void *)data;
 211         unsigned int fixedlen = offsetof(struct ieee80211_mgmt,
 212                                          u.beacon.variable);
 213
 214         if (len < fixedlen)
 215                 goto err;
 216
 217         if (ieee80211_hdrlen(mgmt->frame_control) !=
 218             offsetof(struct ieee80211_mgmt, u.beacon))
 219                 goto err;
 220
 221         data += fixedlen;
 222         len -= fixedlen;
 223
 224         for_each_element(elem, data, len) {
 225                 /* nothing */
 226         }
 227
 228         if (for_each_element_completed(elem, data, len))
 229                 return 0;
 230
 231 err:
 232         NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head");
 233         return -EINVAL;
 234 }
 235
 236 static int validate_ie_attr(const struct nlattr *attr,
 237                             struct netlink_ext_ack *extack)
 238 {
 239         const u8 *data = nla_data(attr);
 240         unsigned int len = nla_len(attr);
 241         const struct element *elem;
 242
 243         for_each_element(elem, data, len) {
 244                 /* nothing */
 245         }
 246
 247         if (for_each_element_completed(elem, data, len))
 248                 return 0;
 249
 250         NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements");
 251         return -EINVAL;
 252 }
 253
 254 /* policy for the attributes */
 255 static const struct nla_policy
 256 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = {
 257         [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, },
 258         [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY,
 259                                         .len = U8_MAX },
 260         [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY,
 261                                              .len = U8_MAX },
 262 };
 263
 264 static const struct nla_policy
 265 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = {
 266         [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG },
 267         [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 },
 268         [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] =
 269                 NLA_POLICY_MAX(NLA_U8, 15),
 270         [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 },
 271         [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] =
 272                 NLA_POLICY_MAX(NLA_U8, 15),
 273         [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] =
 274                 NLA_POLICY_MAX(NLA_U8, 31),
 275         [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 },
 276         [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG },
 277         [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG },
 278 };
 279
 280 static const struct nla_policy
 281 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = {
 282         [NL80211_PMSR_TYPE_FTM] =
 283                 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy),
 284 };
 285
 286 static const struct nla_policy
 287 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = {
 288         [NL80211_PMSR_REQ_ATTR_DATA] =
 289                 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy),
 290         [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG },
 291 };
 292
 293 static const struct nla_policy
 294 nl80211_psmr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = {
 295         [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR,
 296         /*
 297          * we could specify this again to be the top-level policy,
 298          * but that would open us up to recursion problems ...
 299          */
 300         [NL80211_PMSR_PEER_ATTR_CHAN] = { .type = NLA_NESTED },
 301         [NL80211_PMSR_PEER_ATTR_REQ] =
 302                 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy),
 303         [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT },
 304 };
 305
 306 static const struct nla_policy
 307 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = {
 308         [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT },
 309         [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT },
 310         [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT },
 311         [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT },
 312         [NL80211_PMSR_ATTR_PEERS] =
 313                 NLA_POLICY_NESTED_ARRAY(nl80211_psmr_peer_attr_policy),
 314 };
 315
 316 static const struct nla_policy
 317 he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = {
 318         [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] =
 319                 NLA_POLICY_RANGE(NLA_U8, 1, 20),
 320         [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] =
 321                 NLA_POLICY_RANGE(NLA_U8, 1, 20),
 322 };
 323
 324 const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
 325         [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD },
 326         [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
 327         [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
 328                                       .len = 20-1 },
 329         [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
 330
 331         [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
 332         [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
 333         [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8,
 334                                                 NL80211_EDMG_CHANNELS_MIN,
 335                                                 NL80211_EDMG_CHANNELS_MAX),
 336         [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8,
 337                                                 NL80211_EDMG_BW_CONFIG_MIN,
 338                                                 NL80211_EDMG_BW_CONFIG_MAX),
 339
 340         [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
 341         [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
 342         [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
 343
 344         [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
 345         [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
 346         [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
 347         [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
 348         [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
 349         [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
 350
 351         [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX),
 352         [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
 353         [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
 354
 355         [NL80211_ATTR_MAC] = { .type = NLA_EXACT_LEN_WARN, .len = ETH_ALEN },
 356         [NL80211_ATTR_PREV_BSSID] = {
 357                 .type = NLA_EXACT_LEN_WARN,
 358                 .len = ETH_ALEN
 359         },
 360
 361         [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
 362         [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
 363                                     .len = WLAN_MAX_KEY_LEN },
 364         [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 5),
 365         [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
 366         [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
 367         [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
 368         [NL80211_ATTR_KEY_TYPE] =
 369                 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES),
 370
 371         [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
 372         [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
 373         [NL80211_ATTR_BEACON_HEAD] =
 374                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head,
 375                                        IEEE80211_MAX_DATA_LEN),
 376         [NL80211_ATTR_BEACON_TAIL] =
 377                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
 378                                        IEEE80211_MAX_DATA_LEN),
 379         [NL80211_ATTR_STA_AID] =
 380                 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
 381         [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
 382         [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
 383         [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
 384                                                .len = NL80211_MAX_SUPP_RATES },
 385         [NL80211_ATTR_STA_PLINK_ACTION] =
 386                 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1),
 387         [NL80211_ATTR_STA_TX_POWER_SETTING] =
 388                 NLA_POLICY_RANGE(NLA_U8,
 389                                  NL80211_TX_POWER_AUTOMATIC,
 390                                  NL80211_TX_POWER_FIXED),
 391         [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 },
 392         [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
 393         [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
 394         [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
 395                                    .len = IEEE80211_MAX_MESH_ID_LEN },
 396         [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT,
 397
 398         [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
 399         [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
 400
 401         [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
 402         [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
 403         [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
 404         [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
 405                                            .len = NL80211_MAX_SUPP_RATES },
 406         [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
 407
 408         [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
 409         [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
 410
 411         [NL80211_ATTR_HT_CAPABILITY] = {
 412                 .type = NLA_EXACT_LEN_WARN,
 413                 .len = NL80211_HT_CAPABILITY_LEN
 414         },
 415
 416         [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
 417         [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
 418                                                    validate_ie_attr,
 419                                                    IEEE80211_MAX_DATA_LEN),
 420         [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
 421         [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
 422
 423         [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
 424                                 .len = IEEE80211_MAX_SSID_LEN },
 425         [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
 426         [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
 427         [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
 428         [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
 429         [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32,
 430                                                   NL80211_MFP_NO,
 431                                                   NL80211_MFP_OPTIONAL),
 432         [NL80211_ATTR_STA_FLAGS2] = {
 433                 .len = sizeof(struct nl80211_sta_flag_update),
 434         },
 435         [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
 436         [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
 437         [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
 438         [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
 439         [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
 440         [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 },
 441         [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
 442         [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
 443         [NL80211_ATTR_PID] = { .type = NLA_U32 },
 444         [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
 445         [NL80211_ATTR_PMKID] = {
 446                 .type = NLA_EXACT_LEN_WARN,
 447                 .len = WLAN_PMKID_LEN
 448         },
 449         [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
 450         [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
 451         [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
 452         [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
 453                                  .len = IEEE80211_MAX_DATA_LEN },
 454         [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
 455         [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32,
 456                                                    NL80211_PS_DISABLED,
 457                                                    NL80211_PS_ENABLED),
 458         [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
 459         [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
 460         [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
 461         [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
 462         [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
 463         [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
 464         [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
 465         [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
 466         [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
 467         [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
 468         [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
 469         [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
 470         [NL80211_ATTR_STA_PLINK_STATE] =
 471                 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1),
 472         [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 },
 473         [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG },
 474         [NL80211_ATTR_MESH_PEER_AID] =
 475                 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
 476         [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
 477         [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
 478         [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
 479         [NL80211_ATTR_HIDDEN_SSID] =
 480                 NLA_POLICY_RANGE(NLA_U32,
 481                                  NL80211_HIDDEN_SSID_NOT_IN_USE,
 482                                  NL80211_HIDDEN_SSID_ZERO_CONTENTS),
 483         [NL80211_ATTR_IE_PROBE_RESP] =
 484                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
 485                                        IEEE80211_MAX_DATA_LEN),
 486         [NL80211_ATTR_IE_ASSOC_RESP] =
 487                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
 488                                        IEEE80211_MAX_DATA_LEN),
 489         [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
 490         [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
 491         [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
 492         [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
 493         [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
 494         [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
 495         [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
 496         [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
 497         [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
 498         [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
 499         [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
 500                                       .len = IEEE80211_MAX_DATA_LEN },
 501         [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
 502         [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
 503         [NL80211_ATTR_HT_CAPABILITY_MASK] = {
 504                 .len = NL80211_HT_CAPABILITY_LEN
 505         },
 506         [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
 507         [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
 508         [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
 509         [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
 510         [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
 511         [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
 512         [NL80211_ATTR_VHT_CAPABILITY] = {
 513                 .type = NLA_EXACT_LEN_WARN,
 514                 .len = NL80211_VHT_CAPABILITY_LEN
 515         },
 516         [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
 517         [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127),
 518         [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1),
 519         [NL80211_ATTR_LOCAL_MESH_POWER_MODE] =
 520                 NLA_POLICY_RANGE(NLA_U32,
 521                                  NL80211_MESH_POWER_UNKNOWN + 1,
 522                                  NL80211_MESH_POWER_MAX),
 523         [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
 524         [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
 525         [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
 526         [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
 527         [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
 528         [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
 529         [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
 530                 .len = NL80211_VHT_CAPABILITY_LEN,
 531         },
 532         [NL80211_ATTR_MDID] = { .type = NLA_U16 },
 533         [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
 534                                   .len = IEEE80211_MAX_DATA_LEN },
 535         [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 },
 536         [NL80211_ATTR_MAX_CRIT_PROT_DURATION] = { .type = NLA_U16 },
 537         [NL80211_ATTR_PEER_AID] =
 538                 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
 539         [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
 540         [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
 541         [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
 542         [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
 543         [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
 544         [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
 545         [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
 546         [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
 547         [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
 548         [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
 549         [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
 550         [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
 551         [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
 552                                    .len = IEEE80211_QOS_MAP_LEN_MAX },
 553         [NL80211_ATTR_MAC_HINT] = {
 554                 .type = NLA_EXACT_LEN_WARN,
 555                 .len = ETH_ALEN
 556         },
 557         [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
 558         [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
 559         [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
 560         [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
 561         [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
 562         [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1),
 563         [NL80211_ATTR_USER_PRIO] =
 564                 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1),
 565         [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
 566         [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
 567         [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 },
 568         [NL80211_ATTR_MAC_MASK] = {
 569                 .type = NLA_EXACT_LEN_WARN,
 570                 .len = ETH_ALEN
 571         },
 572         [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
 573         [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
 574         [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
 575         [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
 576         [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
 577         [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
 578         [NL80211_ATTR_STA_SUPPORT_P2P_PS] =
 579                 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1),
 580         [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
 581                 .len = VHT_MUMIMO_GROUPS_DATA_LEN
 582         },
 583         [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = {
 584                 .type = NLA_EXACT_LEN_WARN,
 585                 .len = ETH_ALEN
 586         },
 587         [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1),
 588         [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
 589         [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
 590         [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
 591                                     .len = FILS_MAX_KEK_LEN },
 592         [NL80211_ATTR_FILS_NONCES] = {
 593                 .type = NLA_EXACT_LEN_WARN,
 594                 .len = 2 * FILS_NONCE_LEN
 595         },
 596         [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
 597         [NL80211_ATTR_BSSID] = { .type = NLA_EXACT_LEN_WARN, .len = ETH_ALEN },
 598         [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
 599         [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
 600                 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
 601         },
 602         [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
 603         [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
 604                                              .len = FILS_ERP_MAX_USERNAME_LEN },
 605         [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
 606                                           .len = FILS_ERP_MAX_REALM_LEN },
 607         [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
 608         [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
 609                                         .len = FILS_ERP_MAX_RRK_LEN },
 610         [NL80211_ATTR_FILS_CACHE_ID] = { .type = NLA_EXACT_LEN_WARN, .len = 2 },
 611         [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
 612         [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
 613         [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
 614
 615         [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
 616         [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
 617         [NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 },
 618         [NL80211_ATTR_HE_CAPABILITY] = { .type = NLA_BINARY,
 619                                          .len = NL80211_HE_MAX_CAPABILITY_LEN },
 620
 621         [NL80211_ATTR_FTM_RESPONDER] =
 622                 NLA_POLICY_NESTED(nl80211_ftm_responder_policy),
 623         [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1),
 624         [NL80211_ATTR_PEER_MEASUREMENTS] =
 625                 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy),
 626         [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1),
 627         [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY,
 628                                         .len = SAE_PASSWORD_MAX_LEN },
 629         [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG },
 630         [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy),
 631 };
 632
 633 /* policy for the key attributes */
 634 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
 635         [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
 636         [NL80211_KEY_IDX] = { .type = NLA_U8 },
 637         [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
 638         [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
 639         [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
 640         [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
 641         [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1),
 642         [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
 643         [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX),
 644 };
 645
 646 /* policy for the key default flags */
 647 static const struct nla_policy
 648 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
 649         [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
 650         [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
 651 };
 652
 653 #ifdef CONFIG_PM
 654 /* policy for WoWLAN attributes */
 655 static const struct nla_policy
 656 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
 657         [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
 658         [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
 659         [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
 660         [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
 661         [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
 662         [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
 663         [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
 664         [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
 665         [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
 666         [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
 667 };
 668
 669 static const struct nla_policy
 670 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
 671         [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
 672         [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
 673         [NL80211_WOWLAN_TCP_DST_MAC] = {
 674                 .type = NLA_EXACT_LEN_WARN,
 675                 .len = ETH_ALEN
 676         },
 677         [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
 678         [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
 679         [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .type = NLA_MIN_LEN, .len = 1 },
 680         [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
 681                 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
 682         },
 683         [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
 684                 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
 685         },
 686         [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
 687         [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .type = NLA_MIN_LEN, .len = 1 },
 688         [NL80211_WOWLAN_TCP_WAKE_MASK] = { .type = NLA_MIN_LEN, .len = 1 },
 689 };
 690 #endif /* CONFIG_PM */
 691
 692 /* policy for coalesce rule attributes */
 693 static const struct nla_policy
 694 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
 695         [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
 696         [NL80211_ATTR_COALESCE_RULE_CONDITION] =
 697                 NLA_POLICY_RANGE(NLA_U32,
 698                                  NL80211_COALESCE_CONDITION_MATCH,
 699                                  NL80211_COALESCE_CONDITION_NO_MATCH),
 700         [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
 701 };
 702
 703 /* policy for GTK rekey offload attributes */
 704 static const struct nla_policy
 705 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
 706         [NL80211_REKEY_DATA_KEK] = {
 707                 .type = NLA_EXACT_LEN_WARN,
 708                 .len = NL80211_KEK_LEN,
 709         },
 710         [NL80211_REKEY_DATA_KCK] = {
 711                 .type = NLA_EXACT_LEN_WARN,
 712                 .len = NL80211_KCK_LEN,
 713         },
 714         [NL80211_REKEY_DATA_REPLAY_CTR] = {
 715                 .type = NLA_EXACT_LEN_WARN,
 716                 .len = NL80211_REPLAY_CTR_LEN
 717         },
 718 };
 719
 720 static const struct nla_policy
 721 nl80211_match_band_rssi_policy[NUM_NL80211_BANDS] = {
 722         [NL80211_BAND_2GHZ] = { .type = NLA_S32 },
 723         [NL80211_BAND_5GHZ] = { .type = NLA_S32 },
 724         [NL80211_BAND_6GHZ] = { .type = NLA_S32 },
 725         [NL80211_BAND_60GHZ] = { .type = NLA_S32 },
 726 };
 727
 728 static const struct nla_policy
 729 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
 730         [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
 731                                                  .len = IEEE80211_MAX_SSID_LEN },
 732         [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = {
 733                 .type = NLA_EXACT_LEN_WARN,
 734                 .len = ETH_ALEN
 735         },
 736         [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
 737         [NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI] =
 738                 NLA_POLICY_NESTED(nl80211_match_band_rssi_policy),
 739 };
 740
 741 static const struct nla_policy
 742 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
 743         [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
 744         [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
 745 };
 746
 747 static const struct nla_policy
 748 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
 749         [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
 750         [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
 751         [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
 752                 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
 753         },
 754 };
 755
 756 /* policy for NAN function attributes */
 757 static const struct nla_policy
 758 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
 759         [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
 760         [NL80211_NAN_FUNC_SERVICE_ID] = {
 761                                     .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
 762         [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
 763         [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
 764         [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
 765         [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
 766         [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
 767         [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = {
 768                 .type = NLA_EXACT_LEN_WARN,
 769                 .len = ETH_ALEN
 770         },
 771         [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
 772         [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
 773         [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
 774                         .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
 775         [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
 776         [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
 777         [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
 778         [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
 779         [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
 780 };
 781
 782 /* policy for Service Response Filter attributes */
 783 static const struct nla_policy
 784 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
 785         [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
 786         [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
 787                                  .len =  NL80211_NAN_FUNC_SRF_MAX_LEN },
 788         [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
 789         [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
 790 };
 791
 792 /* policy for packet pattern attributes */
 793 static const struct nla_policy
 794 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
 795         [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
 796         [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
 797         [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
 798 };
 799
 800 int nl80211_prepare_wdev_dump(struct netlink_callback *cb,
 801                               struct cfg80211_registered_device **rdev,
 802                               struct wireless_dev **wdev)
 803 {
 804         int err;
 805
 806         if (!cb->args[0]) {
 807                 struct nlattr **attrbuf;
 808
 809                 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
 810                                   GFP_KERNEL);
 811                 if (!attrbuf)
 812                         return -ENOMEM;
 813
 814                 err = nlmsg_parse_deprecated(cb->nlh,
 815                                              GENL_HDRLEN + nl80211_fam.hdrsize,
 816                                              attrbuf, nl80211_fam.maxattr,
 817                                              nl80211_policy, NULL);
 818                 if (err) {
 819                         kfree(attrbuf);
 820                         return err;
 821                 }
 822
 823                 *wdev = __cfg80211_wdev_from_attrs(sock_net(cb->skb->sk),
 824                                                    attrbuf);
 825                 kfree(attrbuf);
 826                 if (IS_ERR(*wdev))
 827                         return PTR_ERR(*wdev);
 828                 *rdev = wiphy_to_rdev((*wdev)->wiphy);
 829                 /* 0 is the first index - add 1 to parse only once */
 830                 cb->args[0] = (*rdev)->wiphy_idx + 1;
 831                 cb->args[1] = (*wdev)->identifier;
 832         } else {
 833                 /* subtract the 1 again here */
 834                 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
 835                 struct wireless_dev *tmp;
 836
 837                 if (!wiphy)
 838                         return -ENODEV;
 839                 *rdev = wiphy_to_rdev(wiphy);
 840                 *wdev = NULL;
 841
 842                 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
 843                         if (tmp->identifier == cb->args[1]) {
 844                                 *wdev = tmp;
 845                                 break;
 846                         }
 847                 }
 848
 849                 if (!*wdev)
 850                         return -ENODEV;
 851         }
 852
 853         return 0;
 854 }
 855
 856 /* message building helper */
 857 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
 858                      int flags, u8 cmd)
 859 {
 860         /* since there is no private header just add the generic one */
 861         return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
 862 }
 863
 864 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
 865                                      const struct ieee80211_reg_rule *rule)
 866 {
 867         int j;
 868         struct nlattr *nl_wmm_rules =
 869                 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM);
 870
 871         if (!nl_wmm_rules)
 872                 goto nla_put_failure;
 873
 874         for (j = 0; j < IEEE80211_NUM_ACS; j++) {
 875                 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j);
 876
 877                 if (!nl_wmm_rule)
 878                         goto nla_put_failure;
 879
 880                 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
 881                                 rule->wmm_rule.client[j].cw_min) ||
 882                     nla_put_u16(msg, NL80211_WMMR_CW_MAX,
 883                                 rule->wmm_rule.client[j].cw_max) ||
 884                     nla_put_u8(msg, NL80211_WMMR_AIFSN,
 885                                rule->wmm_rule.client[j].aifsn) ||
 886                     nla_put_u16(msg, NL80211_WMMR_TXOP,
 887                                 rule->wmm_rule.client[j].cot))
 888                         goto nla_put_failure;
 889
 890                 nla_nest_end(msg, nl_wmm_rule);
 891         }
 892         nla_nest_end(msg, nl_wmm_rules);
 893
 894         return 0;
 895
 896 nla_put_failure:
 897         return -ENOBUFS;
 898 }
 899
 900 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
 901                                    struct ieee80211_channel *chan,
 902                                    bool large)
 903 {
 904         /* Some channels must be completely excluded from the
 905          * list to protect old user-space tools from breaking
 906          */
 907         if (!large && chan->flags &
 908             (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
 909                 return 0;
 910
 911         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
 912                         chan->center_freq))
 913                 goto nla_put_failure;
 914
 915         if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
 916             nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
 917                 goto nla_put_failure;
 918         if (chan->flags & IEEE80211_CHAN_NO_IR) {
 919                 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
 920                         goto nla_put_failure;
 921                 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
 922                         goto nla_put_failure;
 923         }
 924         if (chan->flags & IEEE80211_CHAN_RADAR) {
 925                 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
 926                         goto nla_put_failure;
 927                 if (large) {
 928                         u32 time;
 929
 930                         time = elapsed_jiffies_msecs(chan->dfs_state_entered);
 931
 932                         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
 933                                         chan->dfs_state))
 934                                 goto nla_put_failure;
 935                         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
 936                                         time))
 937                                 goto nla_put_failure;
 938                         if (nla_put_u32(msg,
 939                                         NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
 940                                         chan->dfs_cac_ms))
 941                                 goto nla_put_failure;
 942                 }
 943         }
 944
 945         if (large) {
 946                 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
 947                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
 948                         goto nla_put_failure;
 949                 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
 950                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
 951                         goto nla_put_failure;
 952                 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
 953                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
 954                         goto nla_put_failure;
 955                 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
 956                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
 957                         goto nla_put_failure;
 958                 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
 959                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
 960                         goto nla_put_failure;
 961                 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
 962                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
 963                         goto nla_put_failure;
 964                 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
 965                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
 966                         goto nla_put_failure;
 967                 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
 968                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
 969                         goto nla_put_failure;
 970         }
 971
 972         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
 973                         DBM_TO_MBM(chan->max_power)))
 974                 goto nla_put_failure;
 975
 976         if (large) {
 977                 const struct ieee80211_reg_rule *rule =
 978                         freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq));
 979
 980                 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) {
 981                         if (nl80211_msg_put_wmm_rules(msg, rule))
 982                                 goto nla_put_failure;
 983                 }
 984         }
 985
 986         return 0;
 987
 988  nla_put_failure:
 989         return -ENOBUFS;
 990 }
 991
 992 static bool nl80211_put_txq_stats(struct sk_buff *msg,
 993                                   struct cfg80211_txq_stats *txqstats,
 994                                   int attrtype)
 995 {
 996         struct nlattr *txqattr;
 997
 998 #define PUT_TXQVAL_U32(attr, memb) do {                                   \
 999         if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) &&         \
1000             nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
1001                 return false;                                             \
1002         } while (0)
1003
1004         txqattr = nla_nest_start_noflag(msg, attrtype);
1005         if (!txqattr)
1006                 return false;
1007
1008         PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
1009         PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
1010         PUT_TXQVAL_U32(FLOWS, flows);
1011         PUT_TXQVAL_U32(DROPS, drops);
1012         PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
1013         PUT_TXQVAL_U32(OVERLIMIT, overlimit);
1014         PUT_TXQVAL_U32(OVERMEMORY, overmemory);
1015         PUT_TXQVAL_U32(COLLISIONS, collisions);
1016         PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
1017         PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
1018         PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
1019         nla_nest_end(msg, txqattr);
1020
1021 #undef PUT_TXQVAL_U32
1022         return true;
1023 }
1024
1025 /* netlink command implementations */
1026
1027 struct key_parse {
1028         struct key_params p;
1029         int idx;
1030         int type;
1031         bool def, defmgmt;
1032         bool def_uni, def_multi;
1033 };
1034
1035 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
1036                                  struct key_parse *k)
1037 {
1038         struct nlattr *tb[NL80211_KEY_MAX + 1];
1039         int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key,
1040                                               nl80211_key_policy,
1041                                               info->extack);
1042         if (err)
1043                 return err;
1044
1045         k->def = !!tb[NL80211_KEY_DEFAULT];
1046         k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
1047
1048         if (k->def) {
1049                 k->def_uni = true;
1050                 k->def_multi = true;
1051         }
1052         if (k->defmgmt)
1053                 k->def_multi = true;
1054
1055         if (tb[NL80211_KEY_IDX])
1056                 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
1057
1058         if (tb[NL80211_KEY_DATA]) {
1059                 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
1060                 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
1061         }
1062
1063         if (tb[NL80211_KEY_SEQ]) {
1064                 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
1065                 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
1066         }
1067
1068         if (tb[NL80211_KEY_CIPHER])
1069                 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
1070
1071         if (tb[NL80211_KEY_TYPE])
1072                 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
1073
1074         if (tb[NL80211_KEY_DEFAULT_TYPES]) {
1075                 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
1076
1077                 err = nla_parse_nested_deprecated(kdt,
1078                                                   NUM_NL80211_KEY_DEFAULT_TYPES - 1,
1079                                                   tb[NL80211_KEY_DEFAULT_TYPES],
1080                                                   nl80211_key_default_policy,
1081                                                   info->extack);
1082                 if (err)
1083                         return err;
1084
1085                 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
1086                 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
1087         }
1088
1089         if (tb[NL80211_KEY_MODE])
1090                 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]);
1091
1092         return 0;
1093 }
1094
1095 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
1096 {
1097         if (info->attrs[NL80211_ATTR_KEY_DATA]) {
1098                 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
1099                 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
1100         }
1101
1102         if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
1103                 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
1104                 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
1105         }
1106
1107         if (info->attrs[NL80211_ATTR_KEY_IDX])
1108                 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
1109
1110         if (info->attrs[NL80211_ATTR_KEY_CIPHER])
1111                 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
1112
1113         k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
1114         k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
1115
1116         if (k->def) {
1117                 k->def_uni = true;
1118                 k->def_multi = true;
1119         }
1120         if (k->defmgmt)
1121                 k->def_multi = true;
1122
1123         if (info->attrs[NL80211_ATTR_KEY_TYPE])
1124                 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
1125
1126         if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
1127                 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
1128                 int err = nla_parse_nested_deprecated(kdt,
1129                                                       NUM_NL80211_KEY_DEFAULT_TYPES - 1,
1130                                                       info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
1131                                                       nl80211_key_default_policy,
1132                                                       info->extack);
1133                 if (err)
1134                         return err;
1135
1136                 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
1137                 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
1138         }
1139
1140         return 0;
1141 }
1142
1143 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
1144 {
1145         int err;
1146
1147         memset(k, 0, sizeof(*k));
1148         k->idx = -1;
1149         k->type = -1;
1150
1151         if (info->attrs[NL80211_ATTR_KEY])
1152                 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
1153         else
1154                 err = nl80211_parse_key_old(info, k);
1155
1156         if (err)
1157                 return err;
1158
1159         if (k->def && k->defmgmt) {
1160                 GENL_SET_ERR_MSG(info, "key with def && defmgmt is invalid");
1161                 return -EINVAL;
1162         }
1163
1164         if (k->defmgmt) {
1165                 if (k->def_uni || !k->def_multi) {
1166                         GENL_SET_ERR_MSG(info, "defmgmt key must be mcast");
1167                         return -EINVAL;
1168                 }
1169         }
1170
1171         if (k->idx != -1) {
1172                 if (k->defmgmt) {
1173                         if (k->idx < 4 || k->idx > 5) {
1174                                 GENL_SET_ERR_MSG(info,
1175                                                  "defmgmt key idx not 4 or 5");
1176                                 return -EINVAL;
1177                         }
1178                 } else if (k->def) {
1179                         if (k->idx < 0 || k->idx > 3) {
1180                                 GENL_SET_ERR_MSG(info, "def key idx not 0-3");
1181                                 return -EINVAL;
1182                         }
1183                 } else {
1184                         if (k->idx < 0 || k->idx > 5) {
1185                                 GENL_SET_ERR_MSG(info, "key idx not 0-5");
1186                                 return -EINVAL;
1187                         }
1188                 }
1189         }
1190
1191         return 0;
1192 }
1193
1194 static struct cfg80211_cached_keys *
1195 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
1196                        struct genl_info *info, bool *no_ht)
1197 {
1198         struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
1199         struct key_parse parse;
1200         struct nlattr *key;
1201         struct cfg80211_cached_keys *result;
1202         int rem, err, def = 0;
1203         bool have_key = false;
1204
1205         nla_for_each_nested(key, keys, rem) {
1206                 have_key = true;
1207                 break;
1208         }
1209
1210         if (!have_key)
1211                 return NULL;
1212
1213         result = kzalloc(sizeof(*result), GFP_KERNEL);
1214         if (!result)
1215                 return ERR_PTR(-ENOMEM);
1216
1217         result->def = -1;
1218
1219         nla_for_each_nested(key, keys, rem) {
1220                 memset(&parse, 0, sizeof(parse));
1221                 parse.idx = -1;
1222
1223                 err = nl80211_parse_key_new(info, key, &parse);
1224                 if (err)
1225                         goto error;
1226                 err = -EINVAL;
1227                 if (!parse.p.key)
1228                         goto error;
1229                 if (parse.idx < 0 || parse.idx > 3) {
1230                         GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
1231                         goto error;
1232                 }
1233                 if (parse.def) {
1234                         if (def) {
1235                                 GENL_SET_ERR_MSG(info,
1236                                                  "only one key can be default");
1237                                 goto error;
1238                         }
1239                         def = 1;
1240                         result->def = parse.idx;
1241                         if (!parse.def_uni || !parse.def_multi)
1242                                 goto error;
1243                 } else if (parse.defmgmt)
1244                         goto error;
1245                 err = cfg80211_validate_key_settings(rdev, &parse.p,
1246                                                      parse.idx, false, NULL);
1247                 if (err)
1248                         goto error;
1249                 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
1250                     parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
1251                         GENL_SET_ERR_MSG(info, "connect key must be WEP");
1252                         err = -EINVAL;
1253                         goto error;
1254                 }
1255                 result->params[parse.idx].cipher = parse.p.cipher;
1256                 result->params[parse.idx].key_len = parse.p.key_len;
1257                 result->params[parse.idx].key = result->data[parse.idx];
1258                 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
1259
1260                 /* must be WEP key if we got here */
1261                 if (no_ht)
1262                         *no_ht = true;
1263         }
1264
1265         if (result->def < 0) {
1266                 err = -EINVAL;
1267                 GENL_SET_ERR_MSG(info, "need a default/TX key");
1268                 goto error;
1269         }
1270
1271         return result;
1272  error:
1273         kfree(result);
1274         return ERR_PTR(err);
1275 }
1276
1277 static int nl80211_key_allowed(struct wireless_dev *wdev)
1278 {
1279         ASSERT_WDEV_LOCK(wdev);
1280
1281         switch (wdev->iftype) {
1282         case NL80211_IFTYPE_AP:
1283         case NL80211_IFTYPE_AP_VLAN:
1284         case NL80211_IFTYPE_P2P_GO:
1285         case NL80211_IFTYPE_MESH_POINT:
1286                 break;
1287         case NL80211_IFTYPE_ADHOC:
1288         case NL80211_IFTYPE_STATION:
1289         case NL80211_IFTYPE_P2P_CLIENT:
1290                 if (!wdev->current_bss)
1291                         return -ENOLINK;
1292                 break;
1293         case NL80211_IFTYPE_UNSPECIFIED:
1294         case NL80211_IFTYPE_OCB:
1295         case NL80211_IFTYPE_MONITOR:
1296         case NL80211_IFTYPE_NAN:
1297         case NL80211_IFTYPE_P2P_DEVICE:
1298         case NL80211_IFTYPE_WDS:
1299         case NUM_NL80211_IFTYPES:
1300                 return -EINVAL;
1301         }
1302
1303         return 0;
1304 }
1305
1306 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
1307                                                         struct nlattr *tb)
1308 {
1309         struct ieee80211_channel *chan;
1310
1311         if (tb == NULL)
1312                 return NULL;
1313         chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
1314         if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
1315                 return NULL;
1316         return chan;
1317 }
1318
1319 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
1320 {
1321         struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr);
1322         int i;
1323
1324         if (!nl_modes)
1325                 goto nla_put_failure;
1326
1327         i = 0;
1328         while (ifmodes) {
1329                 if ((ifmodes & 1) && nla_put_flag(msg, i))
1330                         goto nla_put_failure;
1331                 ifmodes >>= 1;
1332                 i++;
1333         }
1334
1335         nla_nest_end(msg, nl_modes);
1336         return 0;
1337
1338 nla_put_failure:
1339         return -ENOBUFS;
1340 }
1341
1342 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1343                                           struct sk_buff *msg,
1344                                           bool large)
1345 {
1346         struct nlattr *nl_combis;
1347         int i, j;
1348
1349         nl_combis = nla_nest_start_noflag(msg,
1350                                           NL80211_ATTR_INTERFACE_COMBINATIONS);
1351         if (!nl_combis)
1352                 goto nla_put_failure;
1353
1354         for (i = 0; i < wiphy->n_iface_combinations; i++) {
1355                 const struct ieee80211_iface_combination *c;
1356                 struct nlattr *nl_combi, *nl_limits;
1357
1358                 c = &wiphy->iface_combinations[i];
1359
1360                 nl_combi = nla_nest_start_noflag(msg, i + 1);
1361                 if (!nl_combi)
1362                         goto nla_put_failure;
1363
1364                 nl_limits = nla_nest_start_noflag(msg,
1365                                                   NL80211_IFACE_COMB_LIMITS);
1366                 if (!nl_limits)
1367                         goto nla_put_failure;
1368
1369                 for (j = 0; j < c->n_limits; j++) {
1370                         struct nlattr *nl_limit;
1371
1372                         nl_limit = nla_nest_start_noflag(msg, j + 1);
1373                         if (!nl_limit)
1374                                 goto nla_put_failure;
1375                         if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1376                                         c->limits[j].max))
1377                                 goto nla_put_failure;
1378                         if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1379                                                 c->limits[j].types))
1380                                 goto nla_put_failure;
1381                         nla_nest_end(msg, nl_limit);
1382                 }
1383
1384                 nla_nest_end(msg, nl_limits);
1385
1386                 if (c->beacon_int_infra_match &&
1387                     nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1388                         goto nla_put_failure;
1389                 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1390                                 c->num_different_channels) ||
1391                     nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1392                                 c->max_interfaces))
1393                         goto nla_put_failure;
1394                 if (large &&
1395                     (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1396                                 c->radar_detect_widths) ||
1397                      nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1398                                 c->radar_detect_regions)))
1399                         goto nla_put_failure;
1400                 if (c->beacon_int_min_gcd &&
1401                     nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1402                                 c->beacon_int_min_gcd))
1403                         goto nla_put_failure;
1404
1405                 nla_nest_end(msg, nl_combi);
1406         }
1407
1408         nla_nest_end(msg, nl_combis);
1409
1410         return 0;
1411 nla_put_failure:
1412         return -ENOBUFS;
1413 }
1414
1415 #ifdef CONFIG_PM
1416 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1417                                         struct sk_buff *msg)
1418 {
1419         const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1420         struct nlattr *nl_tcp;
1421
1422         if (!tcp)
1423                 return 0;
1424
1425         nl_tcp = nla_nest_start_noflag(msg,
1426                                        NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1427         if (!nl_tcp)
1428                 return -ENOBUFS;
1429
1430         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1431                         tcp->data_payload_max))
1432                 return -ENOBUFS;
1433
1434         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1435                         tcp->data_payload_max))
1436                 return -ENOBUFS;
1437
1438         if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1439                 return -ENOBUFS;
1440
1441         if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1442                                 sizeof(*tcp->tok), tcp->tok))
1443                 return -ENOBUFS;
1444
1445         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1446                         tcp->data_interval_max))
1447                 return -ENOBUFS;
1448
1449         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1450                         tcp->wake_payload_max))
1451                 return -ENOBUFS;
1452
1453         nla_nest_end(msg, nl_tcp);
1454         return 0;
1455 }
1456
1457 static int nl80211_send_wowlan(struct sk_buff *msg,
1458                                struct cfg80211_registered_device *rdev,
1459                                bool large)
1460 {
1461         struct nlattr *nl_wowlan;
1462
1463         if (!rdev->wiphy.wowlan)
1464                 return 0;
1465
1466         nl_wowlan = nla_nest_start_noflag(msg,
1467                                           NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1468         if (!nl_wowlan)
1469                 return -ENOBUFS;
1470
1471         if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1472              nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1473             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1474              nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1475             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1476              nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1477             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1478              nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1479             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1480              nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1481             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1482              nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1483             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1484              nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1485             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1486              nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1487                 return -ENOBUFS;
1488
1489         if (rdev->wiphy.wowlan->n_patterns) {
1490                 struct nl80211_pattern_support pat = {
1491                         .max_patterns = rdev->wiphy.wowlan->n_patterns,
1492                         .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1493                         .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1494                         .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1495                 };
1496
1497                 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1498                             sizeof(pat), &pat))
1499                         return -ENOBUFS;
1500         }
1501
1502         if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1503             nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1504                         rdev->wiphy.wowlan->max_nd_match_sets))
1505                 return -ENOBUFS;
1506
1507         if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1508                 return -ENOBUFS;
1509
1510         nla_nest_end(msg, nl_wowlan);
1511
1512         return 0;
1513 }
1514 #endif
1515
1516 static int nl80211_send_coalesce(struct sk_buff *msg,
1517                                  struct cfg80211_registered_device *rdev)
1518 {
1519         struct nl80211_coalesce_rule_support rule;
1520
1521         if (!rdev->wiphy.coalesce)
1522                 return 0;
1523
1524         rule.max_rules = rdev->wiphy.coalesce->n_rules;
1525         rule.max_delay = rdev->wiphy.coalesce->max_delay;
1526         rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1527         rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1528         rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1529         rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1530
1531         if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1532                 return -ENOBUFS;
1533
1534         return 0;
1535 }
1536
1537 static int
1538 nl80211_send_iftype_data(struct sk_buff *msg,
1539                          const struct ieee80211_sband_iftype_data *iftdata)
1540 {
1541         const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap;
1542
1543         if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES,
1544                                 iftdata->types_mask))
1545                 return -ENOBUFS;
1546
1547         if (he_cap->has_he) {
1548                 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC,
1549                             sizeof(he_cap->he_cap_elem.mac_cap_info),
1550                             he_cap->he_cap_elem.mac_cap_info) ||
1551                     nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY,
1552                             sizeof(he_cap->he_cap_elem.phy_cap_info),
1553                             he_cap->he_cap_elem.phy_cap_info) ||
1554                     nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET,
1555                             sizeof(he_cap->he_mcs_nss_supp),
1556                             &he_cap->he_mcs_nss_supp) ||
1557                     nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE,
1558                             sizeof(he_cap->ppe_thres), he_cap->ppe_thres))
1559                         return -ENOBUFS;
1560         }
1561
1562         return 0;
1563 }
1564
1565 static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1566                                       struct ieee80211_supported_band *sband)
1567 {
1568         struct nlattr *nl_rates, *nl_rate;
1569         struct ieee80211_rate *rate;
1570         int i;
1571
1572         /* add HT info */
1573         if (sband->ht_cap.ht_supported &&
1574             (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1575                      sizeof(sband->ht_cap.mcs),
1576                      &sband->ht_cap.mcs) ||
1577              nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1578                          sband->ht_cap.cap) ||
1579              nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1580                         sband->ht_cap.ampdu_factor) ||
1581              nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1582                         sband->ht_cap.ampdu_density)))
1583                 return -ENOBUFS;
1584
1585         /* add VHT info */
1586         if (sband->vht_cap.vht_supported &&
1587             (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1588                      sizeof(sband->vht_cap.vht_mcs),
1589                      &sband->vht_cap.vht_mcs) ||
1590              nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1591                          sband->vht_cap.cap)))
1592                 return -ENOBUFS;
1593
1594         if (sband->n_iftype_data) {
1595                 struct nlattr *nl_iftype_data =
1596                         nla_nest_start_noflag(msg,
1597                                               NL80211_BAND_ATTR_IFTYPE_DATA);
1598                 int err;
1599
1600                 if (!nl_iftype_data)
1601                         return -ENOBUFS;
1602
1603                 for (i = 0; i < sband->n_iftype_data; i++) {
1604                         struct nlattr *iftdata;
1605
1606                         iftdata = nla_nest_start_noflag(msg, i + 1);
1607                         if (!iftdata)
1608                                 return -ENOBUFS;
1609
1610                         err = nl80211_send_iftype_data(msg,
1611                                                        &sband->iftype_data[i]);
1612                         if (err)
1613                                 return err;
1614
1615                         nla_nest_end(msg, iftdata);
1616                 }
1617
1618                 nla_nest_end(msg, nl_iftype_data);
1619         }
1620
1621         /* add EDMG info */
1622         if (sband->edmg_cap.channels &&
1623             (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS,
1624                        sband->edmg_cap.channels) ||
1625             nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG,
1626                        sband->edmg_cap.bw_config)))
1627
1628                 return -ENOBUFS;
1629
1630         /* add bitrates */
1631         nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES);
1632         if (!nl_rates)
1633                 return -ENOBUFS;
1634
1635         for (i = 0; i < sband->n_bitrates; i++) {
1636                 nl_rate = nla_nest_start_noflag(msg, i);
1637                 if (!nl_rate)
1638                         return -ENOBUFS;
1639
1640                 rate = &sband->bitrates[i];
1641                 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1642                                 rate->bitrate))
1643                         return -ENOBUFS;
1644                 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1645                     nla_put_flag(msg,
1646                                  NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1647                         return -ENOBUFS;
1648
1649                 nla_nest_end(msg, nl_rate);
1650         }
1651
1652         nla_nest_end(msg, nl_rates);
1653
1654         return 0;
1655 }
1656
1657 static int
1658 nl80211_send_mgmt_stypes(struct sk_buff *msg,
1659                          const struct ieee80211_txrx_stypes *mgmt_stypes)
1660 {
1661         u16 stypes;
1662         struct nlattr *nl_ftypes, *nl_ifs;
1663         enum nl80211_iftype ift;
1664         int i;
1665
1666         if (!mgmt_stypes)
1667                 return 0;
1668
1669         nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES);
1670         if (!nl_ifs)
1671                 return -ENOBUFS;
1672
1673         for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1674                 nl_ftypes = nla_nest_start_noflag(msg, ift);
1675                 if (!nl_ftypes)
1676                         return -ENOBUFS;
1677                 i = 0;
1678                 stypes = mgmt_stypes[ift].tx;
1679                 while (stypes) {
1680                         if ((stypes & 1) &&
1681                             nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1682                                         (i << 4) | IEEE80211_FTYPE_MGMT))
1683                                 return -ENOBUFS;
1684                         stypes >>= 1;
1685                         i++;
1686                 }
1687                 nla_nest_end(msg, nl_ftypes);
1688         }
1689
1690         nla_nest_end(msg, nl_ifs);
1691
1692         nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES);
1693         if (!nl_ifs)
1694                 return -ENOBUFS;
1695
1696         for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1697                 nl_ftypes = nla_nest_start_noflag(msg, ift);
1698                 if (!nl_ftypes)
1699                         return -ENOBUFS;
1700                 i = 0;
1701                 stypes = mgmt_stypes[ift].rx;
1702                 while (stypes) {
1703                         if ((stypes & 1) &&
1704                             nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1705                                         (i << 4) | IEEE80211_FTYPE_MGMT))
1706                                 return -ENOBUFS;
1707                         stypes >>= 1;
1708                         i++;
1709                 }
1710                 nla_nest_end(msg, nl_ftypes);
1711         }
1712         nla_nest_end(msg, nl_ifs);
1713
1714         return 0;
1715 }
1716
1717 #define CMD(op, n)                                                      \
1718          do {                                                           \
1719                 if (rdev->ops->op) {                                    \
1720                         i++;                                            \
1721                         if (nla_put_u32(msg, i, NL80211_CMD_ ## n))     \
1722                                 goto nla_put_failure;                   \
1723                 }                                                       \
1724         } while (0)
1725
1726 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
1727                                         struct sk_buff *msg)
1728 {
1729         int i = 0;
1730
1731         /*
1732          * do *NOT* add anything into this function, new things need to be
1733          * advertised only to new versions of userspace that can deal with
1734          * the split (and they can't possibly care about new features...
1735          */
1736         CMD(add_virtual_intf, NEW_INTERFACE);
1737         CMD(change_virtual_intf, SET_INTERFACE);
1738         CMD(add_key, NEW_KEY);
1739         CMD(start_ap, START_AP);
1740         CMD(add_station, NEW_STATION);
1741         CMD(add_mpath, NEW_MPATH);
1742         CMD(update_mesh_config, SET_MESH_CONFIG);
1743         CMD(change_bss, SET_BSS);
1744         CMD(auth, AUTHENTICATE);
1745         CMD(assoc, ASSOCIATE);
1746         CMD(deauth, DEAUTHENTICATE);
1747         CMD(disassoc, DISASSOCIATE);
1748         CMD(join_ibss, JOIN_IBSS);
1749         CMD(join_mesh, JOIN_MESH);
1750         CMD(set_pmksa, SET_PMKSA);
1751         CMD(del_pmksa, DEL_PMKSA);
1752         CMD(flush_pmksa, FLUSH_PMKSA);
1753         if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1754                 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1755         CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1756         CMD(mgmt_tx, FRAME);
1757         CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1758         if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1759                 i++;
1760                 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1761                         goto nla_put_failure;
1762         }
1763         if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1764             rdev->ops->join_mesh) {
1765                 i++;
1766                 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1767                         goto nla_put_failure;
1768         }
1769         CMD(set_wds_peer, SET_WDS_PEER);
1770         if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1771                 CMD(tdls_mgmt, TDLS_MGMT);
1772                 CMD(tdls_oper, TDLS_OPER);
1773         }
1774         if (rdev->wiphy.max_sched_scan_reqs)
1775                 CMD(sched_scan_start, START_SCHED_SCAN);
1776         CMD(probe_client, PROBE_CLIENT);
1777         CMD(set_noack_map, SET_NOACK_MAP);
1778         if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1779                 i++;
1780                 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1781                         goto nla_put_failure;
1782         }
1783         CMD(start_p2p_device, START_P2P_DEVICE);
1784         CMD(set_mcast_rate, SET_MCAST_RATE);
1785 #ifdef CONFIG_NL80211_TESTMODE
1786         CMD(testmode_cmd, TESTMODE);
1787 #endif
1788
1789         if (rdev->ops->connect || rdev->ops->auth) {
1790                 i++;
1791                 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1792                         goto nla_put_failure;
1793         }
1794
1795         if (rdev->ops->disconnect || rdev->ops->deauth) {
1796                 i++;
1797                 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1798                         goto nla_put_failure;
1799         }
1800
1801         return i;
1802  nla_put_failure:
1803         return -ENOBUFS;
1804 }
1805
1806 static int
1807 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap,
1808                            struct sk_buff *msg)
1809 {
1810         struct nlattr *ftm;
1811
1812         if (!cap->ftm.supported)
1813                 return 0;
1814
1815         ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM);
1816         if (!ftm)
1817                 return -ENOBUFS;
1818
1819         if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP))
1820                 return -ENOBUFS;
1821         if (cap->ftm.non_asap &&
1822             nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP))
1823                 return -ENOBUFS;
1824         if (cap->ftm.request_lci &&
1825             nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI))
1826                 return -ENOBUFS;
1827         if (cap->ftm.request_civicloc &&
1828             nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC))
1829                 return -ENOBUFS;
1830         if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES,
1831                         cap->ftm.preambles))
1832                 return -ENOBUFS;
1833         if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS,
1834                         cap->ftm.bandwidths))
1835                 return -ENOBUFS;
1836         if (cap->ftm.max_bursts_exponent >= 0 &&
1837             nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT,
1838                         cap->ftm.max_bursts_exponent))
1839                 return -ENOBUFS;
1840         if (cap->ftm.max_ftms_per_burst &&
1841             nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST,
1842                         cap->ftm.max_ftms_per_burst))
1843                 return -ENOBUFS;
1844
1845         nla_nest_end(msg, ftm);
1846         return 0;
1847 }
1848
1849 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev,
1850                                   struct sk_buff *msg)
1851 {
1852         const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa;
1853         struct nlattr *pmsr, *caps;
1854
1855         if (!cap)
1856                 return 0;
1857
1858         /*
1859          * we don't need to clean up anything here since the caller
1860          * will genlmsg_cancel() if we fail
1861          */
1862
1863         pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS);
1864         if (!pmsr)
1865                 return -ENOBUFS;
1866
1867         if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers))
1868                 return -ENOBUFS;
1869
1870         if (cap->report_ap_tsf &&
1871             nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF))
1872                 return -ENOBUFS;
1873
1874         if (cap->randomize_mac_addr &&
1875             nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR))
1876                 return -ENOBUFS;
1877
1878         caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA);
1879         if (!caps)
1880                 return -ENOBUFS;
1881
1882         if (nl80211_send_pmsr_ftm_capa(cap, msg))
1883                 return -ENOBUFS;
1884
1885         nla_nest_end(msg, caps);
1886         nla_nest_end(msg, pmsr);
1887
1888         return 0;
1889 }
1890
1891 struct nl80211_dump_wiphy_state {
1892         s64 filter_wiphy;
1893         long start;
1894         long split_start, band_start, chan_start, capa_start;
1895         bool split;
1896 };
1897
1898 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
1899                               enum nl80211_commands cmd,
1900                               struct sk_buff *msg, u32 portid, u32 seq,
1901                               int flags, struct nl80211_dump_wiphy_state *state)
1902 {
1903         void *hdr;
1904         struct nlattr *nl_bands, *nl_band;
1905         struct nlattr *nl_freqs, *nl_freq;
1906         struct nlattr *nl_cmds;
1907         enum nl80211_band band;
1908         struct ieee80211_channel *chan;
1909         int i;
1910         const struct ieee80211_txrx_stypes *mgmt_stypes =
1911                                 rdev->wiphy.mgmt_stypes;
1912         u32 features;
1913
1914         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
1915         if (!hdr)
1916                 return -ENOBUFS;
1917
1918         if (WARN_ON(!state))
1919                 return -EINVAL;
1920
1921         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1922             nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1923                            wiphy_name(&rdev->wiphy)) ||
1924             nla_put_u32(msg, NL80211_ATTR_GENERATION,
1925                         cfg80211_rdev_list_generation))
1926                 goto nla_put_failure;
1927
1928         if (cmd != NL80211_CMD_NEW_WIPHY)
1929                 goto finish;
1930
1931         switch (state->split_start) {
1932         case 0:
1933                 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1934                                rdev->wiphy.retry_short) ||
1935                     nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1936                                rdev->wiphy.retry_long) ||
1937                     nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1938                                 rdev->wiphy.frag_threshold) ||
1939                     nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1940                                 rdev->wiphy.rts_threshold) ||
1941                     nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1942                                rdev->wiphy.coverage_class) ||
1943                     nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1944                                rdev->wiphy.max_scan_ssids) ||
1945                     nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1946                                rdev->wiphy.max_sched_scan_ssids) ||
1947                     nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1948                                 rdev->wiphy.max_scan_ie_len) ||
1949                     nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
1950                                 rdev->wiphy.max_sched_scan_ie_len) ||
1951                     nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
1952                                rdev->wiphy.max_match_sets) ||
1953                     nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1954                                 rdev->wiphy.max_sched_scan_plans) ||
1955                     nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1956                                 rdev->wiphy.max_sched_scan_plan_interval) ||
1957                     nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1958                                 rdev->wiphy.max_sched_scan_plan_iterations))
1959                         goto nla_put_failure;
1960
1961                 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
1962                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1963                         goto nla_put_failure;
1964                 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
1965                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1966                         goto nla_put_failure;
1967                 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
1968                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1969                         goto nla_put_failure;
1970                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
1971                     nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1972                         goto nla_put_failure;
1973                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
1974                     nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1975                         goto nla_put_failure;
1976                 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
1977                     nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
1978                         goto nla_put_failure;
1979                 state->split_start++;
1980                 if (state->split)
1981                         break;
1982                 /* fall through */
1983         case 1:
1984                 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
1985                             sizeof(u32) * rdev->wiphy.n_cipher_suites,
1986                             rdev->wiphy.cipher_suites))
1987                         goto nla_put_failure;
1988
1989                 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
1990                                rdev->wiphy.max_num_pmkids))
1991                         goto nla_put_failure;
1992
1993                 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
1994                     nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1995                         goto nla_put_failure;
1996
1997                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
1998                                 rdev->wiphy.available_antennas_tx) ||
1999                     nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
2000                                 rdev->wiphy.available_antennas_rx))
2001                         goto nla_put_failure;
2002
2003                 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
2004                     nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
2005                                 rdev->wiphy.probe_resp_offload))
2006                         goto nla_put_failure;
2007
2008                 if ((rdev->wiphy.available_antennas_tx ||
2009                      rdev->wiphy.available_antennas_rx) &&
2010                     rdev->ops->get_antenna) {
2011                         u32 tx_ant = 0, rx_ant = 0;
2012                         int res;
2013
2014                         res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
2015                         if (!res) {
2016                                 if (nla_put_u32(msg,
2017                                                 NL80211_ATTR_WIPHY_ANTENNA_TX,
2018                                                 tx_ant) ||
2019                                     nla_put_u32(msg,
2020                                                 NL80211_ATTR_WIPHY_ANTENNA_RX,
2021                                                 rx_ant))
2022                                         goto nla_put_failure;
2023                         }
2024                 }
2025
2026                 state->split_start++;
2027                 if (state->split)
2028                         break;
2029                 /* fall through */
2030         case 2:
2031                 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
2032                                         rdev->wiphy.interface_modes))
2033                                 goto nla_put_failure;
2034                 state->split_start++;
2035                 if (state->split)
2036                         break;
2037                 /* fall through */
2038         case 3:
2039                 nl_bands = nla_nest_start_noflag(msg,
2040                                                  NL80211_ATTR_WIPHY_BANDS);
2041                 if (!nl_bands)
2042                         goto nla_put_failure;
2043
2044                 for (band = state->band_start;
2045                      band < NUM_NL80211_BANDS; band++) {
2046                         struct ieee80211_supported_band *sband;
2047
2048                         sband = rdev->wiphy.bands[band];
2049
2050                         if (!sband)
2051                                 continue;
2052
2053                         nl_band = nla_nest_start_noflag(msg, band);
2054                         if (!nl_band)
2055                                 goto nla_put_failure;
2056
2057                         switch (state->chan_start) {
2058                         case 0:
2059                                 if (nl80211_send_band_rateinfo(msg, sband))
2060                                         goto nla_put_failure;
2061                                 state->chan_start++;
2062                                 if (state->split)
2063                                         break;
2064                                 /* fall through */
2065                         default:
2066                                 /* add frequencies */
2067                                 nl_freqs = nla_nest_start_noflag(msg,
2068                                                                  NL80211_BAND_ATTR_FREQS);
2069                                 if (!nl_freqs)
2070                                         goto nla_put_failure;
2071
2072                                 for (i = state->chan_start - 1;
2073                                      i < sband->n_channels;
2074                                      i++) {
2075                                         nl_freq = nla_nest_start_noflag(msg,
2076                                                                         i);
2077                                         if (!nl_freq)
2078                                                 goto nla_put_failure;
2079
2080                                         chan = &sband->channels[i];
2081
2082                                         if (nl80211_msg_put_channel(
2083                                                         msg, &rdev->wiphy, chan,
2084                                                         state->split))
2085                                                 goto nla_put_failure;
2086
2087                                         nla_nest_end(msg, nl_freq);
2088                                         if (state->split)
2089                                                 break;
2090                                 }
2091                                 if (i < sband->n_channels)
2092                                         state->chan_start = i + 2;
2093                                 else
2094                                         state->chan_start = 0;
2095                                 nla_nest_end(msg, nl_freqs);
2096                         }
2097
2098                         nla_nest_end(msg, nl_band);
2099
2100                         if (state->split) {
2101                                 /* start again here */
2102                                 if (state->chan_start)
2103                                         band--;
2104                                 break;
2105                         }
2106                 }
2107                 nla_nest_end(msg, nl_bands);
2108
2109                 if (band < NUM_NL80211_BANDS)
2110                         state->band_start = band + 1;
2111                 else
2112                         state->band_start = 0;
2113
2114                 /* if bands & channels are done, continue outside */
2115                 if (state->band_start == 0 && state->chan_start == 0)
2116                         state->split_start++;
2117                 if (state->split)
2118                         break;
2119                 /* fall through */
2120         case 4:
2121                 nl_cmds = nla_nest_start_noflag(msg,
2122                                                 NL80211_ATTR_SUPPORTED_COMMANDS);
2123                 if (!nl_cmds)
2124                         goto nla_put_failure;
2125
2126                 i = nl80211_add_commands_unsplit(rdev, msg);
2127                 if (i < 0)
2128                         goto nla_put_failure;
2129                 if (state->split) {
2130                         CMD(crit_proto_start, CRIT_PROTOCOL_START);
2131                         CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
2132                         if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
2133                                 CMD(channel_switch, CHANNEL_SWITCH);
2134                         CMD(set_qos_map, SET_QOS_MAP);
2135                         if (rdev->wiphy.features &
2136                                         NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
2137                                 CMD(add_tx_ts, ADD_TX_TS);
2138                         CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
2139                         CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
2140                         CMD(update_ft_ies, UPDATE_FT_IES);
2141                 }
2142 #undef CMD
2143
2144                 nla_nest_end(msg, nl_cmds);
2145                 state->split_start++;
2146                 if (state->split)
2147                         break;
2148                 /* fall through */
2149         case 5:
2150                 if (rdev->ops->remain_on_channel &&
2151                     (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
2152                     nla_put_u32(msg,
2153                                 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
2154                                 rdev->wiphy.max_remain_on_channel_duration))
2155                         goto nla_put_failure;
2156
2157                 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
2158                     nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
2159                         goto nla_put_failure;
2160
2161                 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
2162                         goto nla_put_failure;
2163                 state->split_start++;
2164                 if (state->split)
2165                         break;
2166                 /* fall through */
2167         case 6:
2168 #ifdef CONFIG_PM
2169                 if (nl80211_send_wowlan(msg, rdev, state->split))
2170                         goto nla_put_failure;
2171                 state->split_start++;
2172                 if (state->split)
2173                         break;
2174 #else
2175                 state->split_start++;
2176 #endif
2177                 /* fall through */
2178         case 7:
2179                 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
2180                                         rdev->wiphy.software_iftypes))
2181                         goto nla_put_failure;
2182
2183                 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
2184                                                    state->split))
2185                         goto nla_put_failure;
2186
2187                 state->split_start++;
2188                 if (state->split)
2189                         break;
2190                 /* fall through */
2191         case 8:
2192                 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
2193                     nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
2194                                 rdev->wiphy.ap_sme_capa))
2195                         goto nla_put_failure;
2196
2197                 features = rdev->wiphy.features;
2198                 /*
2199                  * We can only add the per-channel limit information if the
2200                  * dump is split, otherwise it makes it too big. Therefore
2201                  * only advertise it in that case.
2202                  */
2203                 if (state->split)
2204                         features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
2205                 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
2206                         goto nla_put_failure;
2207
2208                 if (rdev->wiphy.ht_capa_mod_mask &&
2209                     nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
2210                             sizeof(*rdev->wiphy.ht_capa_mod_mask),
2211                             rdev->wiphy.ht_capa_mod_mask))
2212                         goto nla_put_failure;
2213
2214                 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
2215                     rdev->wiphy.max_acl_mac_addrs &&
2216                     nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
2217                                 rdev->wiphy.max_acl_mac_addrs))
2218                         goto nla_put_failure;
2219
2220                 /*
2221                  * Any information below this point is only available to
2222                  * applications that can deal with it being split. This
2223                  * helps ensure that newly added capabilities don't break
2224                  * older tools by overrunning their buffers.
2225                  *
2226                  * We still increment split_start so that in the split
2227                  * case we'll continue with more data in the next round,
2228                  * but break unconditionally so unsplit data stops here.
2229                  */
2230                 if (state->split)
2231                         state->split_start++;
2232                 else
2233                         state->split_start = 0;
2234                 break;
2235         case 9:
2236                 if (rdev->wiphy.extended_capabilities &&
2237                     (nla_put(msg, NL80211_ATTR_EXT_CAPA,
2238                              rdev->wiphy.extended_capabilities_len,
2239                              rdev->wiphy.extended_capabilities) ||
2240                      nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
2241                              rdev->wiphy.extended_capabilities_len,
2242                              rdev->wiphy.extended_capabilities_mask)))
2243                         goto nla_put_failure;
2244
2245                 if (rdev->wiphy.vht_capa_mod_mask &&
2246                     nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
2247                             sizeof(*rdev->wiphy.vht_capa_mod_mask),
2248                             rdev->wiphy.vht_capa_mod_mask))
2249                         goto nla_put_failure;
2250
2251                 if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
2252                             rdev->wiphy.perm_addr))
2253                         goto nla_put_failure;
2254
2255                 if (!is_zero_ether_addr(rdev->wiphy.addr_mask) &&
2256                     nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN,
2257                             rdev->wiphy.addr_mask))
2258                         goto nla_put_failure;
2259
2260                 if (rdev->wiphy.n_addresses > 1) {
2261                         void *attr;
2262
2263                         attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS);
2264                         if (!attr)
2265                                 goto nla_put_failure;
2266
2267                         for (i = 0; i < rdev->wiphy.n_addresses; i++)
2268                                 if (nla_put(msg, i + 1, ETH_ALEN,
2269                                             rdev->wiphy.addresses[i].addr))
2270                                         goto nla_put_failure;
2271
2272                         nla_nest_end(msg, attr);
2273                 }
2274
2275                 state->split_start++;
2276                 break;
2277         case 10:
2278                 if (nl80211_send_coalesce(msg, rdev))
2279                         goto nla_put_failure;
2280
2281                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
2282                     (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
2283                      nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
2284                         goto nla_put_failure;
2285
2286                 if (rdev->wiphy.max_ap_assoc_sta &&
2287                     nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
2288                                 rdev->wiphy.max_ap_assoc_sta))
2289                         goto nla_put_failure;
2290
2291                 state->split_start++;
2292                 break;
2293         case 11:
2294                 if (rdev->wiphy.n_vendor_commands) {
2295                         const struct nl80211_vendor_cmd_info *info;
2296                         struct nlattr *nested;
2297
2298                         nested = nla_nest_start_noflag(msg,
2299                                                        NL80211_ATTR_VENDOR_DATA);
2300                         if (!nested)
2301                                 goto nla_put_failure;
2302
2303                         for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
2304                                 info = &rdev->wiphy.vendor_commands[i].info;
2305                                 if (nla_put(msg, i + 1, sizeof(*info), info))
2306                                         goto nla_put_failure;
2307                         }
2308                         nla_nest_end(msg, nested);
2309                 }
2310
2311                 if (rdev->wiphy.n_vendor_events) {
2312                         const struct nl80211_vendor_cmd_info *info;
2313                         struct nlattr *nested;
2314
2315                         nested = nla_nest_start_noflag(msg,
2316                                                        NL80211_ATTR_VENDOR_EVENTS);
2317                         if (!nested)
2318                                 goto nla_put_failure;
2319
2320                         for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
2321                                 info = &rdev->wiphy.vendor_events[i];
2322                                 if (nla_put(msg, i + 1, sizeof(*info), info))
2323                                         goto nla_put_failure;
2324                         }
2325                         nla_nest_end(msg, nested);
2326                 }
2327                 state->split_start++;
2328                 break;
2329         case 12:
2330                 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
2331                     nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
2332                                rdev->wiphy.max_num_csa_counters))
2333                         goto nla_put_failure;
2334
2335                 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
2336                     nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
2337                         goto nla_put_failure;
2338
2339                 if (rdev->wiphy.max_sched_scan_reqs &&
2340                     nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
2341                                 rdev->wiphy.max_sched_scan_reqs))
2342                         goto nla_put_failure;
2343
2344                 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
2345                             sizeof(rdev->wiphy.ext_features),
2346                             rdev->wiphy.ext_features))
2347                         goto nla_put_failure;
2348
2349                 if (rdev->wiphy.bss_select_support) {
2350                         struct nlattr *nested;
2351                         u32 bss_select_support = rdev->wiphy.bss_select_support;
2352
2353                         nested = nla_nest_start_noflag(msg,
2354                                                        NL80211_ATTR_BSS_SELECT);
2355                         if (!nested)
2356                                 goto nla_put_failure;
2357
2358                         i = 0;
2359                         while (bss_select_support) {
2360                                 if ((bss_select_support & 1) &&
2361                                     nla_put_flag(msg, i))
2362                                         goto nla_put_failure;
2363                                 i++;
2364                                 bss_select_support >>= 1;
2365                         }
2366                         nla_nest_end(msg, nested);
2367                 }
2368
2369                 state->split_start++;
2370                 break;
2371         case 13:
2372                 if (rdev->wiphy.num_iftype_ext_capab &&
2373                     rdev->wiphy.iftype_ext_capab) {
2374                         struct nlattr *nested_ext_capab, *nested;
2375
2376                         nested = nla_nest_start_noflag(msg,
2377                                                        NL80211_ATTR_IFTYPE_EXT_CAPA);
2378                         if (!nested)
2379                                 goto nla_put_failure;
2380
2381                         for (i = state->capa_start;
2382                              i < rdev->wiphy.num_iftype_ext_capab; i++) {
2383                                 const struct wiphy_iftype_ext_capab *capab;
2384
2385                                 capab = &rdev->wiphy.iftype_ext_capab[i];
2386
2387                                 nested_ext_capab = nla_nest_start_noflag(msg,
2388                                                                          i);
2389                                 if (!nested_ext_capab ||
2390                                     nla_put_u32(msg, NL80211_ATTR_IFTYPE,
2391                                                 capab->iftype) ||
2392                                     nla_put(msg, NL80211_ATTR_EXT_CAPA,
2393                                             capab->extended_capabilities_len,
2394                                             capab->extended_capabilities) ||
2395                                     nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
2396                                             capab->extended_capabilities_len,
2397                                             capab->extended_capabilities_mask))
2398                                         goto nla_put_failure;
2399
2400                                 nla_nest_end(msg, nested_ext_capab);
2401                                 if (state->split)
2402                                         break;
2403                         }
2404                         nla_nest_end(msg, nested);
2405                         if (i < rdev->wiphy.num_iftype_ext_capab) {
2406                                 state->capa_start = i + 1;
2407                                 break;
2408                         }
2409                 }
2410
2411                 if (nla_put_u32(msg, NL80211_ATTR_BANDS,
2412                                 rdev->wiphy.nan_supported_bands))
2413                         goto nla_put_failure;
2414
2415                 if (wiphy_ext_feature_isset(&rdev->wiphy,
2416                                             NL80211_EXT_FEATURE_TXQS)) {
2417                         struct cfg80211_txq_stats txqstats = {};
2418                         int res;
2419
2420                         res = rdev_get_txq_stats(rdev, NULL, &txqstats);
2421                         if (!res &&
2422                             !nl80211_put_txq_stats(msg, &txqstats,
2423                                                    NL80211_ATTR_TXQ_STATS))
2424                                 goto nla_put_failure;
2425
2426                         if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
2427                                         rdev->wiphy.txq_limit))
2428                                 goto nla_put_failure;
2429                         if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
2430                                         rdev->wiphy.txq_memory_limit))
2431                                 goto nla_put_failure;
2432                         if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
2433                                         rdev->wiphy.txq_quantum))
2434                                 goto nla_put_failure;
2435                 }
2436
2437                 state->split_start++;
2438                 break;
2439         case 14:
2440                 if (nl80211_send_pmsr_capa(rdev, msg))
2441                         goto nla_put_failure;
2442
2443                 state->split_start++;
2444                 break;
2445         case 15:
2446                 if (rdev->wiphy.akm_suites &&
2447                     nla_put(msg, NL80211_ATTR_AKM_SUITES,
2448                             sizeof(u32) * rdev->wiphy.n_akm_suites,
2449                             rdev->wiphy.akm_suites))
2450                         goto nla_put_failure;
2451
2452                 /* done */
2453                 state->split_start = 0;
2454                 break;
2455         }
2456  finish:
2457         genlmsg_end(msg, hdr);
2458         return 0;
2459
2460  nla_put_failure:
2461         genlmsg_cancel(msg, hdr);
2462         return -EMSGSIZE;
2463 }
2464
2465 static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
2466                                     struct netlink_callback *cb,
2467                                     struct nl80211_dump_wiphy_state *state)
2468 {
2469         struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
2470         int ret;
2471
2472         if (!tb)
2473                 return -ENOMEM;
2474
2475         ret = nlmsg_parse_deprecated(cb->nlh,
2476                                      GENL_HDRLEN + nl80211_fam.hdrsize,
2477                                      tb, nl80211_fam.maxattr,
2478                                      nl80211_policy, NULL);
2479         /* ignore parse errors for backward compatibility */
2480         if (ret) {
2481                 ret = 0;
2482                 goto out;
2483         }
2484
2485         state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
2486         if (tb[NL80211_ATTR_WIPHY])
2487                 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
2488         if (tb[NL80211_ATTR_WDEV])
2489                 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
2490         if (tb[NL80211_ATTR_IFINDEX]) {
2491                 struct net_device *netdev;
2492                 struct cfg80211_registered_device *rdev;
2493                 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
2494
2495                 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
2496                 if (!netdev) {
2497                         ret = -ENODEV;
2498                         goto out;
2499                 }
2500                 if (netdev->ieee80211_ptr) {
2501                         rdev = wiphy_to_rdev(
2502                                 netdev->ieee80211_ptr->wiphy);
2503                         state->filter_wiphy = rdev->wiphy_idx;
2504                 }
2505         }
2506
2507         ret = 0;
2508 out:
2509         kfree(tb);
2510         return ret;
2511 }
2512
2513 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
2514 {
2515         int idx = 0, ret;
2516         struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
2517         struct cfg80211_registered_device *rdev;
2518
2519         rtnl_lock();
2520         if (!state) {
2521                 state = kzalloc(sizeof(*state), GFP_KERNEL);
2522                 if (!state) {
2523                         rtnl_unlock();
2524                         return -ENOMEM;
2525                 }
2526                 state->filter_wiphy = -1;
2527                 ret = nl80211_dump_wiphy_parse(skb, cb, state);
2528                 if (ret) {
2529                         kfree(state);
2530                         rtnl_unlock();
2531                         return ret;
2532                 }
2533                 cb->args[0] = (long)state;
2534         }
2535
2536         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2537                 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2538                         continue;
2539                 if (++idx <= state->start)
2540                         continue;
2541                 if (state->filter_wiphy != -1 &&
2542                     state->filter_wiphy != rdev->wiphy_idx)
2543                         continue;
2544                 /* attempt to fit multiple wiphy data chunks into the skb */
2545                 do {
2546                         ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
2547                                                  skb,
2548                                                  NETLINK_CB(cb->skb).portid,
2549                                                  cb->nlh->nlmsg_seq,
2550                                                  NLM_F_MULTI, state);
2551                         if (ret < 0) {
2552                                 /*
2553                                  * If sending the wiphy data didn't fit (ENOBUFS
2554                                  * or EMSGSIZE returned), this SKB is still
2555                                  * empty (so it's not too big because another
2556                                  * wiphy dataset is already in the skb) and
2557                                  * we've not tried to adjust the dump allocation
2558                                  * yet ... then adjust the alloc size to be
2559                                  * bigger, and return 1 but with the empty skb.
2560                                  * This results in an empty message being RX'ed
2561                                  * in userspace, but that is ignored.
2562                                  *
2563                                  * We can then retry with the larger buffer.
2564                                  */
2565                                 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
2566                                     !skb->len && !state->split &&
2567                                     cb->min_dump_alloc < 4096) {
2568                                         cb->min_dump_alloc = 4096;
2569                                         state->split_start = 0;
2570                                         rtnl_unlock();
2571                                         return 1;
2572                                 }
2573                                 idx--;
2574                                 break;
2575                         }
2576                 } while (state->split_start > 0);
2577                 break;
2578         }
2579         rtnl_unlock();
2580
2581         state->start = idx;
2582
2583         return skb->len;
2584 }
2585
2586 static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
2587 {
2588         kfree((void *)cb->args[0]);
2589         return 0;
2590 }
2591
2592 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
2593 {
2594         struct sk_buff *msg;
2595         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2596         struct nl80211_dump_wiphy_state state = {};
2597
2598         msg = nlmsg_new(4096, GFP_KERNEL);
2599         if (!msg)
2600                 return -ENOMEM;
2601
2602         if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2603                                info->snd_portid, info->snd_seq, 0,
2604                                &state) < 0) {
2605                 nlmsg_free(msg);
2606                 return -ENOBUFS;
2607         }
2608
2609         return genlmsg_reply(msg, info);
2610 }
2611
2612 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2613         [NL80211_TXQ_ATTR_QUEUE]                = { .type = NLA_U8 },
2614         [NL80211_TXQ_ATTR_TXOP]                 = { .type = NLA_U16 },
2615         [NL80211_TXQ_ATTR_CWMIN]                = { .type = NLA_U16 },
2616         [NL80211_TXQ_ATTR_CWMAX]                = { .type = NLA_U16 },
2617         [NL80211_TXQ_ATTR_AIFS]                 = { .type = NLA_U8 },
2618 };
2619
2620 static int parse_txq_params(struct nlattr *tb[],
2621                             struct ieee80211_txq_params *txq_params)
2622 {
2623         u8 ac;
2624
2625         if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
2626             !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2627             !tb[NL80211_TXQ_ATTR_AIFS])
2628                 return -EINVAL;
2629
2630         ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
2631         txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2632         txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2633         txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2634         txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2635
2636         if (ac >= NL80211_NUM_ACS)
2637                 return -EINVAL;
2638         txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
2639         return 0;
2640 }
2641
2642 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2643 {
2644         /*
2645          * You can only set the channel explicitly for WDS interfaces,
2646          * all others have their channel managed via their respective
2647          * "establish a connection" command (connect, join, ...)
2648          *
2649          * For AP/GO and mesh mode, the channel can be set with the
2650          * channel userspace API, but is only stored and passed to the
2651          * low-level driver when the AP starts or the mesh is joined.
2652          * This is for backward compatibility, userspace can also give
2653          * the channel in the start-ap or join-mesh commands instead.
2654          *
2655          * Monitors are special as they are normally slaved to
2656          * whatever else is going on, so they have their own special
2657          * operation to set the monitor channel if possible.
2658          */
2659         return !wdev ||
2660                 wdev->iftype == NL80211_IFTYPE_AP ||
2661                 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
2662                 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2663                 wdev->iftype == NL80211_IFTYPE_P2P_GO;
2664 }
2665
2666 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2667                           struct genl_info *info,
2668                           struct cfg80211_chan_def *chandef)
2669 {
2670         struct netlink_ext_ack *extack = info->extack;
2671         struct nlattr **attrs = info->attrs;
2672         u32 control_freq;
2673
2674         if (!attrs[NL80211_ATTR_WIPHY_FREQ])
2675                 return -EINVAL;
2676
2677         control_freq = nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ]);
2678
2679         memset(chandef, 0, sizeof(*chandef));
2680
2681         chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
2682         chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2683         chandef->center_freq1 = control_freq;
2684         chandef->center_freq2 = 0;
2685
2686         /* Primary channel not allowed */
2687         if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED) {
2688                 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
2689                                     "Channel is disabled");
2690                 return -EINVAL;
2691         }
2692
2693         if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2694                 enum nl80211_channel_type chantype;
2695
2696                 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2697
2698                 switch (chantype) {
2699                 case NL80211_CHAN_NO_HT:
2700                 case NL80211_CHAN_HT20:
2701                 case NL80211_CHAN_HT40PLUS:
2702                 case NL80211_CHAN_HT40MINUS:
2703                         cfg80211_chandef_create(chandef, chandef->chan,
2704                                                 chantype);
2705                         /* user input for center_freq is incorrect */
2706                         if (attrs[NL80211_ATTR_CENTER_FREQ1] &&
2707                             chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) {
2708                                 NL_SET_ERR_MSG_ATTR(extack,
2709                                                     attrs[NL80211_ATTR_CENTER_FREQ1],
2710                                                     "bad center frequency 1");
2711                                 return -EINVAL;
2712                         }
2713                         /* center_freq2 must be zero */
2714                         if (attrs[NL80211_ATTR_CENTER_FREQ2] &&
2715                             nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) {
2716                                 NL_SET_ERR_MSG_ATTR(extack,
2717                                                     attrs[NL80211_ATTR_CENTER_FREQ2],
2718                                                     "center frequency 2 can't be used");
2719                                 return -EINVAL;
2720                         }
2721                         break;
2722                 default:
2723                         NL_SET_ERR_MSG_ATTR(extack,
2724                                             attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
2725                                             "invalid channel type");
2726                         return -EINVAL;
2727                 }
2728         } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2729                 chandef->width =
2730                         nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2731                 if (attrs[NL80211_ATTR_CENTER_FREQ1])
2732                         chandef->center_freq1 =
2733                                 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]);
2734                 if (attrs[NL80211_ATTR_CENTER_FREQ2])
2735                         chandef->center_freq2 =
2736                                 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]);
2737         }
2738
2739         if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
2740                 chandef->edmg.channels =
2741                       nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
2742
2743                 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
2744                         chandef->edmg.bw_config =
2745                      nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
2746         } else {
2747                 chandef->edmg.bw_config = 0;
2748                 chandef->edmg.channels = 0;
2749         }
2750
2751         if (!cfg80211_chandef_valid(chandef)) {
2752                 NL_SET_ERR_MSG(extack, "invalid channel definition");
2753                 return -EINVAL;
2754         }
2755
2756         if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2757                                      IEEE80211_CHAN_DISABLED)) {
2758                 NL_SET_ERR_MSG(extack, "(extension) channel is disabled");
2759                 return -EINVAL;
2760         }
2761
2762         if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2763              chandef->width == NL80211_CHAN_WIDTH_10) &&
2764             !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) {
2765                 NL_SET_ERR_MSG(extack, "5/10 MHz not supported");
2766                 return -EINVAL;
2767         }
2768
2769         return 0;
2770 }
2771
2772 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
2773                                  struct net_device *dev,
2774                                  struct genl_info *info)
2775 {
2776         struct cfg80211_chan_def chandef;
2777         int result;
2778         enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
2779         struct wireless_dev *wdev = NULL;
2780
2781         if (dev)
2782                 wdev = dev->ieee80211_ptr;
2783         if (!nl80211_can_set_dev_channel(wdev))
2784                 return -EOPNOTSUPP;
2785         if (wdev)
2786                 iftype = wdev->iftype;
2787
2788         result = nl80211_parse_chandef(rdev, info, &chandef);
2789         if (result)
2790                 return result;
2791
2792         switch (iftype) {
2793         case NL80211_IFTYPE_AP:
2794         case NL80211_IFTYPE_P2P_GO:
2795                 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2796                                                    iftype)) {
2797                         result = -EINVAL;
2798                         break;
2799                 }
2800                 if (wdev->beacon_interval) {
2801                         if (!dev || !rdev->ops->set_ap_chanwidth ||
2802                             !(rdev->wiphy.features &
2803                               NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2804                                 result = -EBUSY;
2805                                 break;
2806                         }
2807
2808                         /* Only allow dynamic channel width changes */
2809                         if (chandef.chan != wdev->preset_chandef.chan) {
2810                                 result = -EBUSY;
2811                                 break;
2812                         }
2813                         result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2814                         if (result)
2815                                 break;
2816                 }
2817                 wdev->preset_chandef = chandef;
2818                 result = 0;
2819                 break;
2820         case NL80211_IFTYPE_MESH_POINT:
2821                 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
2822                 break;
2823         case NL80211_IFTYPE_MONITOR:
2824                 result = cfg80211_set_monitor_channel(rdev, &chandef);
2825                 break;
2826         default:
2827                 result = -EINVAL;
2828         }
2829
2830         return result;
2831 }
2832
2833 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2834 {
2835         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2836         struct net_device *netdev = info->user_ptr[1];
2837
2838         return __nl80211_set_channel(rdev, netdev, info);
2839 }
2840
2841 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2842 {
2843         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2844         struct net_device *dev = info->user_ptr[1];
2845         struct wireless_dev *wdev = dev->ieee80211_ptr;
2846         const u8 *bssid;
2847
2848         if (!info->attrs[NL80211_ATTR_MAC])
2849                 return -EINVAL;
2850
2851         if (netif_running(dev))
2852                 return -EBUSY;
2853
2854         if (!rdev->ops->set_wds_peer)
2855                 return -EOPNOTSUPP;
2856
2857         if (wdev->iftype != NL80211_IFTYPE_WDS)
2858                 return -EOPNOTSUPP;
2859
2860         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
2861         return rdev_set_wds_peer(rdev, dev, bssid);
2862 }
2863
2864 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2865 {
2866         struct cfg80211_registered_device *rdev;
2867         struct net_device *netdev = NULL;
2868         struct wireless_dev *wdev;
2869         int result = 0, rem_txq_params = 0;
2870         struct nlattr *nl_txq_params;
2871         u32 changed;
2872         u8 retry_short = 0, retry_long = 0;
2873         u32 frag_threshold = 0, rts_threshold = 0;
2874         u8 coverage_class = 0;
2875         u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
2876
2877         ASSERT_RTNL();
2878
2879         /*
2880          * Try to find the wiphy and netdev. Normally this
2881          * function shouldn't need the netdev, but this is
2882          * done for backward compatibility -- previously
2883          * setting the channel was done per wiphy, but now
2884          * it is per netdev. Previous userland like hostapd
2885          * also passed a netdev to set_wiphy, so that it is
2886          * possible to let that go to the right netdev!
2887          */
2888
2889         if (info->attrs[NL80211_ATTR_IFINDEX]) {
2890                 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2891
2892                 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
2893                 if (netdev && netdev->ieee80211_ptr)
2894                         rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
2895                 else
2896                         netdev = NULL;
2897         }
2898
2899         if (!netdev) {
2900                 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2901                                                   info->attrs);
2902                 if (IS_ERR(rdev))
2903                         return PTR_ERR(rdev);
2904                 wdev = NULL;
2905                 netdev = NULL;
2906                 result = 0;
2907         } else
2908                 wdev = netdev->ieee80211_ptr;
2909
2910         /*
2911          * end workaround code, by now the rdev is available
2912          * and locked, and wdev may or may not be NULL.
2913          */
2914
2915         if (info->attrs[NL80211_ATTR_WIPHY_NAME])
2916                 result = cfg80211_dev_rename(
2917                         rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
2918
2919         if (result)
2920                 return result;
2921
2922         if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2923                 struct ieee80211_txq_params txq_params;
2924                 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2925
2926                 if (!rdev->ops->set_txq_params)
2927                         return -EOPNOTSUPP;
2928
2929                 if (!netdev)
2930                         return -EINVAL;
2931
2932                 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2933                     netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2934                         return -EINVAL;
2935
2936                 if (!netif_running(netdev))
2937                         return -ENETDOWN;
2938
2939                 nla_for_each_nested(nl_txq_params,
2940                                     info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2941                                     rem_txq_params) {
2942                         result = nla_parse_nested_deprecated(tb,
2943                                                              NL80211_TXQ_ATTR_MAX,
2944                                                              nl_txq_params,
2945                                                              txq_params_policy,
2946                                                              info->extack);
2947                         if (result)
2948                                 return result;
2949                         result = parse_txq_params(tb, &txq_params);
2950                         if (result)
2951                                 return result;
2952
2953                         result = rdev_set_txq_params(rdev, netdev,
2954                                                      &txq_params);
2955                         if (result)
2956                                 return result;
2957                 }
2958         }
2959
2960         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
2961                 result = __nl80211_set_channel(
2962                         rdev,
2963                         nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2964                         info);
2965                 if (result)
2966                         return result;
2967         }
2968
2969         if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
2970                 struct wireless_dev *txp_wdev = wdev;
2971                 enum nl80211_tx_power_setting type;
2972                 int idx, mbm = 0;
2973
2974                 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2975                         txp_wdev = NULL;
2976
2977                 if (!rdev->ops->set_tx_power)
2978                         return -EOPNOTSUPP;
2979
2980                 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2981                 type = nla_get_u32(info->attrs[idx]);
2982
2983                 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
2984                     (type != NL80211_TX_POWER_AUTOMATIC))
2985                         return -EINVAL;
2986
2987                 if (type != NL80211_TX_POWER_AUTOMATIC) {
2988                         idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2989                         mbm = nla_get_u32(info->attrs[idx]);
2990                 }
2991
2992                 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
2993                 if (result)
2994                         return result;
2995         }
2996
2997         if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2998             info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2999                 u32 tx_ant, rx_ant;
3000
3001                 if ((!rdev->wiphy.available_antennas_tx &&
3002                      !rdev->wiphy.available_antennas_rx) ||
3003                     !rdev->ops->set_antenna)
3004                         return -EOPNOTSUPP;
3005
3006                 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
3007                 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
3008
3009                 /* reject antenna configurations which don't match the
3010                  * available antenna masks, except for the "all" mask */
3011                 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
3012                     (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
3013                         return -EINVAL;
3014
3015                 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
3016                 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
3017
3018                 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
3019                 if (result)
3020                         return result;
3021         }
3022
3023         changed = 0;
3024
3025         if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
3026                 retry_short = nla_get_u8(
3027                         info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
3028
3029                 changed |= WIPHY_PARAM_RETRY_SHORT;
3030         }
3031
3032         if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
3033                 retry_long = nla_get_u8(
3034                         info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
3035
3036                 changed |= WIPHY_PARAM_RETRY_LONG;
3037         }
3038
3039         if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
3040                 frag_threshold = nla_get_u32(
3041                         info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
3042                 if (frag_threshold < 256)
3043                         return -EINVAL;
3044
3045                 if (frag_threshold != (u32) -1) {
3046                         /*
3047                          * Fragments (apart from the last one) are required to
3048                          * have even length. Make the fragmentation code
3049                          * simpler by stripping LSB should someone try to use
3050                          * odd threshold value.
3051                          */
3052                         frag_threshold &= ~0x1;
3053                 }
3054                 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
3055         }
3056
3057         if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
3058                 rts_threshold = nla_get_u32(
3059                         info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
3060                 changed |= WIPHY_PARAM_RTS_THRESHOLD;
3061         }
3062
3063         if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
3064                 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
3065                         return -EINVAL;
3066
3067                 coverage_class = nla_get_u8(
3068                         info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
3069                 changed |= WIPHY_PARAM_COVERAGE_CLASS;
3070         }
3071
3072         if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
3073                 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
3074                         return -EOPNOTSUPP;
3075
3076                 changed |= WIPHY_PARAM_DYN_ACK;
3077         }
3078
3079         if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
3080                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
3081                                              NL80211_EXT_FEATURE_TXQS))
3082                         return -EOPNOTSUPP;
3083                 txq_limit = nla_get_u32(
3084                         info->attrs[NL80211_ATTR_TXQ_LIMIT]);
3085                 changed |= WIPHY_PARAM_TXQ_LIMIT;
3086         }
3087
3088         if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
3089                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
3090                                              NL80211_EXT_FEATURE_TXQS))
3091                         return -EOPNOTSUPP;
3092                 txq_memory_limit = nla_get_u32(
3093                         info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
3094                 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
3095         }
3096
3097         if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
3098                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
3099                                              NL80211_EXT_FEATURE_TXQS))
3100                         return -EOPNOTSUPP;
3101                 txq_quantum = nla_get_u32(
3102                         info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
3103                 changed |= WIPHY_PARAM_TXQ_QUANTUM;
3104         }
3105
3106         if (changed) {
3107                 u8 old_retry_short, old_retry_long;
3108                 u32 old_frag_threshold, old_rts_threshold;
3109                 u8 old_coverage_class;
3110                 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
3111
3112                 if (!rdev->ops->set_wiphy_params)
3113                         return -EOPNOTSUPP;
3114
3115                 old_retry_short = rdev->wiphy.retry_short;
3116                 old_retry_long = rdev->wiphy.retry_long;
3117                 old_frag_threshold = rdev->wiphy.frag_threshold;
3118                 old_rts_threshold = rdev->wiphy.rts_threshold;
3119                 old_coverage_class = rdev->wiphy.coverage_class;
3120                 old_txq_limit = rdev->wiphy.txq_limit;
3121                 old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
3122                 old_txq_quantum = rdev->wiphy.txq_quantum;
3123
3124                 if (changed & WIPHY_PARAM_RETRY_SHORT)
3125                         rdev->wiphy.retry_short = retry_short;
3126                 if (changed & WIPHY_PARAM_RETRY_LONG)
3127                         rdev->wiphy.retry_long = retry_long;
3128                 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
3129                         rdev->wiphy.frag_threshold = frag_threshold;
3130                 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
3131                         rdev->wiphy.rts_threshold = rts_threshold;
3132                 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
3133                         rdev->wiphy.coverage_class = coverage_class;
3134                 if (changed & WIPHY_PARAM_TXQ_LIMIT)
3135                         rdev->wiphy.txq_limit = txq_limit;
3136                 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
3137                         rdev->wiphy.txq_memory_limit = txq_memory_limit;
3138                 if (changed & WIPHY_PARAM_TXQ_QUANTUM)
3139                         rdev->wiphy.txq_quantum = txq_quantum;
3140
3141                 result = rdev_set_wiphy_params(rdev, changed);
3142                 if (result) {
3143                         rdev->wiphy.retry_short = old_retry_short;
3144                         rdev->wiphy.retry_long = old_retry_long;
3145                         rdev->wiphy.frag_threshold = old_frag_threshold;
3146                         rdev->wiphy.rts_threshold = old_rts_threshold;
3147                         rdev->wiphy.coverage_class = old_coverage_class;
3148                         rdev->wiphy.txq_limit = old_txq_limit;
3149                         rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
3150                         rdev->wiphy.txq_quantum = old_txq_quantum;
3151                         return result;
3152                 }
3153         }
3154         return 0;
3155 }
3156
3157 static int nl80211_send_chandef(struct sk_buff *msg,
3158                                 const struct cfg80211_chan_def *chandef)
3159 {
3160         if (WARN_ON(!cfg80211_chandef_valid(chandef)))
3161                 return -EINVAL;
3162
3163         if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
3164                         chandef->chan->center_freq))
3165                 return -ENOBUFS;
3166         switch (chandef->width) {
3167         case NL80211_CHAN_WIDTH_20_NOHT:
3168         case NL80211_CHAN_WIDTH_20:
3169         case NL80211_CHAN_WIDTH_40:
3170                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
3171                                 cfg80211_get_chandef_type(chandef)))
3172                         return -ENOBUFS;
3173                 break;
3174         default:
3175                 break;
3176         }
3177         if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
3178                 return -ENOBUFS;
3179         if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
3180                 return -ENOBUFS;
3181         if (chandef->center_freq2 &&
3182             nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
3183                 return -ENOBUFS;
3184         return 0;
3185 }
3186
3187 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
3188                               struct cfg80211_registered_device *rdev,
3189                               struct wireless_dev *wdev,
3190                               enum nl80211_commands cmd)
3191 {
3192         struct net_device *dev = wdev->netdev;
3193         void *hdr;
3194
3195         WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
3196                 cmd != NL80211_CMD_DEL_INTERFACE &&
3197                 cmd != NL80211_CMD_SET_INTERFACE);
3198
3199         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
3200         if (!hdr)
3201                 return -1;
3202
3203         if (dev &&
3204             (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3205              nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
3206                 goto nla_put_failure;
3207
3208         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
3209             nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
3210             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
3211                               NL80211_ATTR_PAD) ||
3212             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
3213             nla_put_u32(msg, NL80211_ATTR_GENERATION,
3214                         rdev->devlist_generation ^
3215                         (cfg80211_rdev_list_generation << 2)) ||
3216             nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr))
3217                 goto nla_put_failure;
3218
3219         if (rdev->ops->get_channel) {
3220                 int ret;
3221                 struct cfg80211_chan_def chandef = {};
3222
3223                 ret = rdev_get_channel(rdev, wdev, &chandef);
3224                 if (ret == 0) {
3225                         if (nl80211_send_chandef(msg, &chandef))
3226                                 goto nla_put_failure;
3227                 }
3228         }
3229
3230         if (rdev->ops->get_tx_power) {
3231                 int dbm, ret;
3232
3233                 ret = rdev_get_tx_power(rdev, wdev, &dbm);
3234                 if (ret == 0 &&
3235                     nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
3236                                 DBM_TO_MBM(dbm)))
3237                         goto nla_put_failure;
3238         }
3239
3240         wdev_lock(wdev);
3241         switch (wdev->iftype) {
3242         case NL80211_IFTYPE_AP:
3243         case NL80211_IFTYPE_P2P_GO:
3244                 if (wdev->ssid_len &&
3245                     nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
3246                         goto nla_put_failure_locked;
3247                 break;
3248         case NL80211_IFTYPE_STATION:
3249         case NL80211_IFTYPE_P2P_CLIENT:
3250         case NL80211_IFTYPE_ADHOC: {
3251                 const u8 *ssid_ie;
3252                 if (!wdev->current_bss)
3253                         break;
3254                 rcu_read_lock();
3255                 ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub,
3256                                                WLAN_EID_SSID);
3257                 if (ssid_ie &&
3258                     nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2))
3259                         goto nla_put_failure_rcu_locked;
3260                 rcu_read_unlock();
3261                 break;
3262                 }
3263         default:
3264                 /* nothing */
3265                 break;
3266         }
3267         wdev_unlock(wdev);
3268
3269         if (rdev->ops->get_txq_stats) {
3270                 struct cfg80211_txq_stats txqstats = {};
3271                 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);
3272
3273                 if (ret == 0 &&
3274                     !nl80211_put_txq_stats(msg, &txqstats,
3275                                            NL80211_ATTR_TXQ_STATS))
3276                         goto nla_put_failure;
3277         }
3278
3279         genlmsg_end(msg, hdr);
3280         return 0;
3281
3282  nla_put_failure_rcu_locked:
3283         rcu_read_unlock();
3284  nla_put_failure_locked:
3285         wdev_unlock(wdev);
3286  nla_put_failure:
3287         genlmsg_cancel(msg, hdr);
3288         return -EMSGSIZE;
3289 }
3290
3291 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
3292 {
3293         int wp_idx = 0;
3294         int if_idx = 0;
3295         int wp_start = cb->args[0];
3296         int if_start = cb->args[1];
3297         int filter_wiphy = -1;
3298         struct cfg80211_registered_device *rdev;
3299         struct wireless_dev *wdev;
3300         int ret;
3301
3302         rtnl_lock();
3303         if (!cb->args[2]) {
3304                 struct nl80211_dump_wiphy_state state = {
3305                         .filter_wiphy = -1,
3306                 };
3307
3308                 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
3309                 if (ret)
3310                         goto out_unlock;
3311
3312                 filter_wiphy = state.filter_wiphy;
3313
3314                 /*
3315                  * if filtering, set cb->args[2] to +1 since 0 is the default
3316                  * value needed to determine that parsing is necessary.
3317                  */
3318                 if (filter_wiphy >= 0)
3319                         cb->args[2] = filter_wiphy + 1;
3320                 else
3321                         cb->args[2] = -1;
3322         } else if (cb->args[2] > 0) {
3323                 filter_wiphy = cb->args[2] - 1;
3324         }
3325
3326         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
3327                 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
3328                         continue;
3329                 if (wp_idx < wp_start) {
3330                         wp_idx++;
3331                         continue;
3332                 }
3333
3334                 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
3335                         continue;
3336
3337                 if_idx = 0;
3338
3339                 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
3340                         if (if_idx < if_start) {
3341                                 if_idx++;
3342                                 continue;
3343                         }
3344                         if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
3345                                                cb->nlh->nlmsg_seq, NLM_F_MULTI,
3346                                                rdev, wdev,
3347                                                NL80211_CMD_NEW_INTERFACE) < 0) {
3348                                 goto out;
3349                         }
3350                         if_idx++;
3351                 }
3352
3353                 wp_idx++;
3354         }
3355  out:
3356         cb->args[0] = wp_idx;
3357         cb->args[1] = if_idx;
3358
3359         ret = skb->len;
3360  out_unlock:
3361         rtnl_unlock();
3362
3363         return ret;
3364 }
3365
3366 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
3367 {
3368         struct sk_buff *msg;
3369         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3370         struct wireless_dev *wdev = info->user_ptr[1];
3371
3372         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3373         if (!msg)
3374                 return -ENOMEM;
3375
3376         if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3377                                rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
3378                 nlmsg_free(msg);
3379                 return -ENOBUFS;
3380         }
3381
3382         return genlmsg_reply(msg, info);
3383 }
3384
3385 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
3386         [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
3387         [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
3388         [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
3389         [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
3390         [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
3391         [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
3392 };
3393
3394 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
3395 {
3396         struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
3397         int flag;
3398
3399         *mntrflags = 0;
3400
3401         if (!nla)
3402                 return -EINVAL;
3403
3404         if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL))
3405                 return -EINVAL;
3406
3407         for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
3408                 if (flags[flag])
3409                         *mntrflags |= (1<<flag);
3410
3411         *mntrflags |= MONITOR_FLAG_CHANGED;
3412
3413         return 0;
3414 }
3415
3416 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
3417                                      enum nl80211_iftype type,
3418                                      struct genl_info *info,
3419                                      struct vif_params *params)
3420 {
3421         bool change = false;
3422         int err;
3423
3424         if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
3425                 if (type != NL80211_IFTYPE_MONITOR)
3426                         return -EINVAL;
3427
3428                 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
3429                                           &params->flags);
3430                 if (err)
3431                         return err;
3432
3433                 change = true;
3434         }
3435
3436         if (params->flags & MONITOR_FLAG_ACTIVE &&
3437             !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
3438                 return -EOPNOTSUPP;
3439
3440         if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
3441                 const u8 *mumimo_groups;
3442                 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
3443
3444                 if (type != NL80211_IFTYPE_MONITOR)
3445                         return -EINVAL;
3446
3447                 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
3448                         return -EOPNOTSUPP;
3449
3450                 mumimo_groups =
3451                         nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
3452
3453                 /* bits 0 and 63 are reserved and must be zero */
3454                 if ((mumimo_groups[0] & BIT(0)) ||
3455                     (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
3456                         return -EINVAL;
3457
3458                 params->vht_mumimo_groups = mumimo_groups;
3459                 change = true;
3460         }
3461
3462         if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
3463                 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
3464
3465                 if (type != NL80211_IFTYPE_MONITOR)
3466                         return -EINVAL;
3467
3468                 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
3469                         return -EOPNOTSUPP;
3470
3471                 params->vht_mumimo_follow_addr =
3472                         nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
3473                 change = true;
3474         }
3475
3476         return change ? 1 : 0;
3477 }
3478
3479 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
3480                                struct net_device *netdev, u8 use_4addr,
3481                                enum nl80211_iftype iftype)
3482 {
3483         if (!use_4addr) {
3484                 if (netdev && netif_is_bridge_port(netdev))
3485                         return -EBUSY;
3486                 return 0;
3487         }
3488
3489         switch (iftype) {
3490         case NL80211_IFTYPE_AP_VLAN:
3491                 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
3492                         return 0;
3493                 break;
3494         case NL80211_IFTYPE_STATION:
3495                 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
3496                         return 0;
3497                 break;
3498         default:
3499                 break;
3500         }
3501
3502         return -EOPNOTSUPP;
3503 }
3504
3505 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
3506 {
3507         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3508         struct vif_params params;
3509         int err;
3510         enum nl80211_iftype otype, ntype;
3511         struct net_device *dev = info->user_ptr[1];
3512         bool change = false;
3513
3514         memset(&params, 0, sizeof(params));
3515
3516         otype = ntype = dev->ieee80211_ptr->iftype;
3517
3518         if (info->attrs[NL80211_ATTR_IFTYPE]) {
3519                 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
3520                 if (otype != ntype)
3521                         change = true;
3522         }
3523
3524         if (info->attrs[NL80211_ATTR_MESH_ID]) {
3525                 struct wireless_dev *wdev = dev->ieee80211_ptr;
3526
3527                 if (ntype != NL80211_IFTYPE_MESH_POINT)
3528                         return -EINVAL;
3529                 if (netif_running(dev))
3530                         return -EBUSY;
3531
3532                 wdev_lock(wdev);
3533                 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3534                              IEEE80211_MAX_MESH_ID_LEN);
3535                 wdev->mesh_id_up_len =
3536                         nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3537                 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3538                        wdev->mesh_id_up_len);
3539                 wdev_unlock(wdev);
3540         }
3541
3542         if (info->attrs[NL80211_ATTR_4ADDR]) {
3543                 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3544                 change = true;
3545                 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
3546                 if (err)
3547                         return err;
3548         } else {
3549                 params.use_4addr = -1;
3550         }
3551
3552         err = nl80211_parse_mon_options(rdev, ntype, info, &params);
3553         if (err < 0)
3554                 return err;
3555         if (err > 0)
3556                 change = true;
3557
3558         if (change)
3559                 err = cfg80211_change_iface(rdev, dev, ntype, &params);
3560         else
3561                 err = 0;
3562
3563         if (!err && params.use_4addr != -1)
3564                 dev->ieee80211_ptr->use_4addr = params.use_4addr;
3565
3566         if (change && !err) {
3567                 struct wireless_dev *wdev = dev->ieee80211_ptr;
3568
3569                 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE);
3570         }
3571
3572         return err;
3573 }
3574
3575 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
3576 {
3577         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3578         struct vif_params params;
3579         struct wireless_dev *wdev;
3580         struct sk_buff *msg;
3581         int err;
3582         enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
3583
3584         /* to avoid failing a new interface creation due to pending removal */
3585         cfg80211_destroy_ifaces(rdev);
3586
3587         memset(&params, 0, sizeof(params));
3588
3589         if (!info->attrs[NL80211_ATTR_IFNAME])
3590                 return -EINVAL;
3591
3592         if (info->attrs[NL80211_ATTR_IFTYPE])
3593                 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
3594
3595         if (!rdev->ops->add_virtual_intf)
3596                 return -EOPNOTSUPP;
3597
3598         if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
3599              rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
3600             info->attrs[NL80211_ATTR_MAC]) {
3601                 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
3602                            ETH_ALEN);
3603                 if (!is_valid_ether_addr(params.macaddr))
3604                         return -EADDRNOTAVAIL;
3605         }
3606
3607         if (info->attrs[NL80211_ATTR_4ADDR]) {
3608                 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3609                 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
3610                 if (err)
3611                         return err;
3612         }
3613
3614         if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0))
3615                 return -EOPNOTSUPP;
3616
3617         err = nl80211_parse_mon_options(rdev, type, info, &params);
3618         if (err < 0)
3619                 return err;
3620
3621         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3622         if (!msg)
3623                 return -ENOMEM;
3624
3625         wdev = rdev_add_virtual_intf(rdev,
3626                                 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
3627                                 NET_NAME_USER, type, &params);
3628         if (WARN_ON(!wdev)) {
3629                 nlmsg_free(msg);
3630                 return -EPROTO;
3631         } else if (IS_ERR(wdev)) {
3632                 nlmsg_free(msg);
3633                 return PTR_ERR(wdev);
3634         }
3635
3636         if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
3637                 wdev->owner_nlportid = info->snd_portid;
3638
3639         switch (type) {
3640         case NL80211_IFTYPE_MESH_POINT:
3641                 if (!info->attrs[NL80211_ATTR_MESH_ID])
3642                         break;
3643                 wdev_lock(wdev);
3644                 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3645                              IEEE80211_MAX_MESH_ID_LEN);
3646                 wdev->mesh_id_up_len =
3647                         nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3648                 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3649                        wdev->mesh_id_up_len);
3650                 wdev_unlock(wdev);
3651                 break;
3652         case NL80211_IFTYPE_NAN:
3653         case NL80211_IFTYPE_P2P_DEVICE:
3654                 /*
3655                  * P2P Device and NAN do not have a netdev, so don't go
3656                  * through the netdev notifier and must be added here
3657                  */
3658                 cfg80211_init_wdev(wdev);
3659                 cfg80211_register_wdev(rdev, wdev);
3660                 break;
3661         default:
3662                 break;
3663         }
3664
3665         if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3666                                rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
3667                 nlmsg_free(msg);
3668                 return -ENOBUFS;
3669         }
3670
3671         return genlmsg_reply(msg, info);
3672 }
3673
3674 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
3675 {
3676         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3677         struct wireless_dev *wdev = info->user_ptr[1];
3678
3679         if (!rdev->ops->del_virtual_intf)
3680                 return -EOPNOTSUPP;
3681
3682         /*
3683          * If we remove a wireless device without a netdev then clear
3684          * user_ptr[1] so that nl80211_post_doit won't dereference it
3685          * to check if it needs to do dev_put(). Otherwise it crashes
3686          * since the wdev has been freed, unlike with a netdev where
3687          * we need the dev_put() for the netdev to really be freed.
3688          */
3689         if (!wdev->netdev)
3690                 info->user_ptr[1] = NULL;
3691
3692         return rdev_del_virtual_intf(rdev, wdev);
3693 }
3694
3695 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
3696 {
3697         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3698         struct net_device *dev = info->user_ptr[1];
3699         u16 noack_map;
3700
3701         if (!info->attrs[NL80211_ATTR_NOACK_MAP])
3702                 return -EINVAL;
3703
3704         if (!rdev->ops->set_noack_map)
3705                 return -EOPNOTSUPP;
3706
3707         noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
3708
3709         return rdev_set_noack_map(rdev, dev, noack_map);
3710 }
3711
3712 struct get_key_cookie {
3713         struct sk_buff *msg;
3714         int error;
3715         int idx;
3716 };
3717
3718 static void get_key_callback(void *c, struct key_params *params)
3719 {
3720         struct nlattr *key;
3721         struct get_key_cookie *cookie = c;
3722
3723         if ((params->key &&
3724              nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3725                      params->key_len, params->key)) ||
3726             (params->seq &&
3727              nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3728                      params->seq_len, params->seq)) ||
3729             (params->cipher &&
3730              nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3731                          params->cipher)))
3732                 goto nla_put_failure;
3733
3734         key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY);
3735         if (!key)
3736                 goto nla_put_failure;
3737
3738         if ((params->key &&
3739              nla_put(cookie->msg, NL80211_KEY_DATA,
3740                      params->key_len, params->key)) ||
3741             (params->seq &&
3742              nla_put(cookie->msg, NL80211_KEY_SEQ,
3743                      params->seq_len, params->seq)) ||
3744             (params->cipher &&
3745              nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3746                          params->cipher)))
3747                 goto nla_put_failure;
3748
3749         if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx))
3750                 goto nla_put_failure;
3751
3752         nla_nest_end(cookie->msg, key);
3753
3754         return;
3755  nla_put_failure:
3756         cookie->error = 1;
3757 }
3758
3759 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3760 {
3761         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3762         int err;
3763         struct net_device *dev = info->user_ptr[1];
3764         u8 key_idx = 0;
3765         const u8 *mac_addr = NULL;
3766         bool pairwise;
3767         struct get_key_cookie cookie = {
3768                 .error = 0,
3769         };
3770         void *hdr;
3771         struct sk_buff *msg;
3772
3773         if (info->attrs[NL80211_ATTR_KEY_IDX])
3774                 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3775
3776         if (info->attrs[NL80211_ATTR_MAC])
3777                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3778
3779         pairwise = !!mac_addr;
3780         if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3781                 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
3782
3783                 if (kt != NL80211_KEYTYPE_GROUP &&
3784                     kt != NL80211_KEYTYPE_PAIRWISE)
3785                         return -EINVAL;
3786                 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3787         }
3788
3789         if (!rdev->ops->get_key)
3790                 return -EOPNOTSUPP;
3791
3792         if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3793                 return -ENOENT;
3794
3795         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3796         if (!msg)
3797                 return -ENOMEM;
3798
3799         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3800                              NL80211_CMD_NEW_KEY);
3801         if (!hdr)
3802                 goto nla_put_failure;
3803
3804         cookie.msg = msg;
3805         cookie.idx = key_idx;
3806
3807         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3808             nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3809                 goto nla_put_failure;
3810         if (mac_addr &&
3811             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3812                 goto nla_put_failure;
3813
3814         err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3815                            get_key_callback);
3816
3817         if (err)
3818                 goto free_msg;
3819
3820         if (cookie.error)
3821                 goto nla_put_failure;
3822
3823         genlmsg_end(msg, hdr);
3824         return genlmsg_reply(msg, info);
3825
3826  nla_put_failure:
3827         err = -ENOBUFS;
3828  free_msg:
3829         nlmsg_free(msg);
3830         return err;
3831 }
3832
3833 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3834 {
3835         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3836         struct key_parse key;
3837         int err;
3838         struct net_device *dev = info->user_ptr[1];
3839
3840         err = nl80211_parse_key(info, &key);
3841         if (err)
3842                 return err;
3843
3844         if (key.idx < 0)
3845                 return -EINVAL;
3846
3847         /* Only support setting default key and
3848          * Extended Key ID action NL80211_KEY_SET_TX.
3849          */
3850         if (!key.def && !key.defmgmt &&
3851             !(key.p.mode == NL80211_KEY_SET_TX))
3852                 return -EINVAL;
3853
3854         wdev_lock(dev->ieee80211_ptr);
3855
3856         if (key.def) {
3857                 if (!rdev->ops->set_default_key) {
3858                         err = -EOPNOTSUPP;
3859                         goto out;
3860                 }
3861
3862                 err = nl80211_key_allowed(dev->ieee80211_ptr);
3863                 if (err)
3864                         goto out;
3865
3866                 err = rdev_set_default_key(rdev, dev, key.idx,
3867                                                  key.def_uni, key.def_multi);
3868
3869                 if (err)
3870                         goto out;
3871
3872 #ifdef CONFIG_CFG80211_WEXT
3873                 dev->ieee80211_ptr->wext.default_key = key.idx;
3874 #endif
3875         } else if (key.defmgmt) {
3876                 if (key.def_uni || !key.def_multi) {
3877                         err = -EINVAL;
3878                         goto out;
3879                 }
3880
3881                 if (!rdev->ops->set_default_mgmt_key) {
3882                         err = -EOPNOTSUPP;
3883                         goto out;
3884                 }
3885
3886                 err = nl80211_key_allowed(dev->ieee80211_ptr);
3887                 if (err)
3888                         goto out;
3889
3890                 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
3891                 if (err)
3892                         goto out;
3893
3894 #ifdef CONFIG_CFG80211_WEXT
3895                 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3896 #endif
3897         } else if (key.p.mode == NL80211_KEY_SET_TX &&
3898                    wiphy_ext_feature_isset(&rdev->wiphy,
3899                                            NL80211_EXT_FEATURE_EXT_KEY_ID)) {
3900                 u8 *mac_addr = NULL;
3901
3902                 if (info->attrs[NL80211_ATTR_MAC])
3903                         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3904
3905                 if (!mac_addr || key.idx < 0 || key.idx > 1) {
3906                         err = -EINVAL;
3907                         goto out;
3908                 }
3909
3910                 err = rdev_add_key(rdev, dev, key.idx,
3911                                    NL80211_KEYTYPE_PAIRWISE,
3912                                    mac_addr, &key.p);
3913         } else {
3914                 err = -EINVAL;
3915         }
3916  out:
3917         wdev_unlock(dev->ieee80211_ptr);
3918
3919         return err;
3920 }
3921
3922 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3923 {
3924         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3925         int err;
3926         struct net_device *dev = info->user_ptr[1];
3927         struct key_parse key;
3928         const u8 *mac_addr = NULL;
3929
3930         err = nl80211_parse_key(info, &key);
3931         if (err)
3932                 return err;
3933
3934         if (!key.p.key)
3935                 return -EINVAL;
3936
3937         if (info->attrs[NL80211_ATTR_MAC])
3938                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3939
3940         if (key.type == -1) {
3941                 if (mac_addr)
3942                         key.type = NL80211_KEYTYPE_PAIRWISE;
3943                 else
3944                         key.type = NL80211_KEYTYPE_GROUP;
3945         }
3946
3947         /* for now */
3948         if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3949             key.type != NL80211_KEYTYPE_GROUP)
3950                 return -EINVAL;
3951
3952         if (!rdev->ops->add_key)
3953                 return -EOPNOTSUPP;
3954
3955         if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3956                                            key.type == NL80211_KEYTYPE_PAIRWISE,
3957                                            mac_addr))
3958                 return -EINVAL;
3959
3960         wdev_lock(dev->ieee80211_ptr);
3961         err = nl80211_key_allowed(dev->ieee80211_ptr);
3962         if (!err)
3963                 err = rdev_add_key(rdev, dev, key.idx,
3964                                    key.type == NL80211_KEYTYPE_PAIRWISE,
3965                                     mac_addr, &key.p);
3966         wdev_unlock(dev->ieee80211_ptr);
3967
3968         return err;
3969 }
3970
3971 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3972 {
3973         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3974         int err;
3975         struct net_device *dev = info->user_ptr[1];
3976         u8 *mac_addr = NULL;
3977         struct key_parse key;
3978
3979         err = nl80211_parse_key(info, &key);
3980         if (err)
3981                 return err;
3982
3983         if (info->attrs[NL80211_ATTR_MAC])
3984                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3985
3986         if (key.type == -1) {
3987                 if (mac_addr)
3988                         key.type = NL80211_KEYTYPE_PAIRWISE;
3989                 else
3990                         key.type = NL80211_KEYTYPE_GROUP;
3991         }
3992
3993         /* for now */
3994         if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3995             key.type != NL80211_KEYTYPE_GROUP)
3996                 return -EINVAL;
3997
3998         if (!cfg80211_valid_key_idx(rdev, key.idx,
3999                                     key.type == NL80211_KEYTYPE_PAIRWISE))
4000                 return -EINVAL;
4001
4002         if (!rdev->ops->del_key)
4003                 return -EOPNOTSUPP;
4004
4005         wdev_lock(dev->ieee80211_ptr);
4006         err = nl80211_key_allowed(dev->ieee80211_ptr);
4007
4008         if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
4009             !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
4010                 err = -ENOENT;
4011
4012         if (!err)
4013                 err = rdev_del_key(rdev, dev, key.idx,
4014                                    key.type == NL80211_KEYTYPE_PAIRWISE,
4015                                    mac_addr);
4016
4017 #ifdef CONFIG_CFG80211_WEXT
4018         if (!err) {
4019                 if (key.idx == dev->ieee80211_ptr->wext.default_key)
4020                         dev->ieee80211_ptr->wext.default_key = -1;
4021                 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
4022                         dev->ieee80211_ptr->wext.default_mgmt_key = -1;
4023         }
4024 #endif
4025         wdev_unlock(dev->ieee80211_ptr);
4026
4027         return err;
4028 }
4029
4030 /* This function returns an error or the number of nested attributes */
4031 static int validate_acl_mac_addrs(struct nlattr *nl_attr)
4032 {
4033         struct nlattr *attr;
4034         int n_entries = 0, tmp;
4035
4036         nla_for_each_nested(attr, nl_attr, tmp) {
4037                 if (nla_len(attr) != ETH_ALEN)
4038                         return -EINVAL;
4039
4040                 n_entries++;
4041         }
4042
4043         return n_entries;
4044 }
4045
4046 /*
4047  * This function parses ACL information and allocates memory for ACL data.
4048  * On successful return, the calling function is responsible to free the
4049  * ACL buffer returned by this function.
4050  */
4051 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
4052                                                 struct genl_info *info)
4053 {
4054         enum nl80211_acl_policy acl_policy;
4055         struct nlattr *attr;
4056         struct cfg80211_acl_data *acl;
4057         int i = 0, n_entries, tmp;
4058
4059         if (!wiphy->max_acl_mac_addrs)
4060                 return ERR_PTR(-EOPNOTSUPP);
4061
4062         if (!info->attrs[NL80211_ATTR_ACL_POLICY])
4063                 return ERR_PTR(-EINVAL);
4064
4065         acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
4066         if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
4067             acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
4068                 return ERR_PTR(-EINVAL);
4069
4070         if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
4071                 return ERR_PTR(-EINVAL);
4072
4073         n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
4074         if (n_entries < 0)
4075                 return ERR_PTR(n_entries);
4076
4077         if (n_entries > wiphy->max_acl_mac_addrs)
4078                 return ERR_PTR(-ENOTSUPP);
4079
4080         acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL);
4081         if (!acl)
4082                 return ERR_PTR(-ENOMEM);
4083
4084         nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
4085                 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
4086                 i++;
4087         }
4088
4089         acl->n_acl_entries = n_entries;
4090         acl->acl_policy = acl_policy;
4091
4092         return acl;
4093 }
4094
4095 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
4096 {
4097         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4098         struct net_device *dev = info->user_ptr[1];
4099         struct cfg80211_acl_data *acl;
4100         int err;
4101
4102         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4103             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4104                 return -EOPNOTSUPP;
4105
4106         if (!dev->ieee80211_ptr->beacon_interval)
4107                 return -EINVAL;
4108
4109         acl = parse_acl_data(&rdev->wiphy, info);
4110         if (IS_ERR(acl))
4111                 return PTR_ERR(acl);
4112
4113         err = rdev_set_mac_acl(rdev, dev, acl);
4114
4115         kfree(acl);
4116
4117         return err;
4118 }
4119
4120 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
4121                            u8 *rates, u8 rates_len)
4122 {
4123         u8 i;
4124         u32 mask = 0;
4125
4126         for (i = 0; i < rates_len; i++) {
4127                 int rate = (rates[i] & 0x7f) * 5;
4128                 int ridx;
4129
4130                 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
4131                         struct ieee80211_rate *srate =
4132                                 &sband->bitrates[ridx];
4133                         if (rate == srate->bitrate) {
4134                                 mask |= 1 << ridx;
4135                                 break;
4136                         }
4137                 }
4138                 if (ridx == sband->n_bitrates)
4139                         return 0; /* rate not found */
4140         }
4141
4142         return mask;
4143 }
4144
4145 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
4146                                u8 *rates, u8 rates_len,
4147                                u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
4148 {
4149         u8 i;
4150
4151         memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
4152
4153         for (i = 0; i < rates_len; i++) {
4154                 int ridx, rbit;
4155
4156                 ridx = rates[i] / 8;
4157                 rbit = BIT(rates[i] % 8);
4158
4159                 /* check validity */
4160                 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
4161                         return false;
4162
4163                 /* check availability */
4164                 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
4165                 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
4166                         mcs[ridx] |= rbit;
4167                 else
4168                         return false;
4169         }
4170
4171         return true;
4172 }
4173
4174 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
4175 {
4176         u16 mcs_mask = 0;
4177
4178         switch (vht_mcs_map) {
4179         case IEEE80211_VHT_MCS_NOT_SUPPORTED:
4180                 break;
4181         case IEEE80211_VHT_MCS_SUPPORT_0_7:
4182                 mcs_mask = 0x00FF;
4183                 break;
4184         case IEEE80211_VHT_MCS_SUPPORT_0_8:
4185                 mcs_mask = 0x01FF;
4186                 break;
4187         case IEEE80211_VHT_MCS_SUPPORT_0_9:
4188                 mcs_mask = 0x03FF;
4189                 break;
4190         default:
4191                 break;
4192         }
4193
4194         return mcs_mask;
4195 }
4196
4197 static void vht_build_mcs_mask(u16 vht_mcs_map,
4198                                u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
4199 {
4200         u8 nss;
4201
4202         for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
4203                 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
4204                 vht_mcs_map >>= 2;
4205         }
4206 }
4207
4208 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
4209                              struct nl80211_txrate_vht *txrate,
4210                              u16 mcs[NL80211_VHT_NSS_MAX])
4211 {
4212         u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
4213         u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
4214         u8 i;
4215
4216         if (!sband->vht_cap.vht_supported)
4217                 return false;
4218
4219         memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
4220
4221         /* Build vht_mcs_mask from VHT capabilities */
4222         vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
4223
4224         for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
4225                 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
4226                         mcs[i] = txrate->mcs[i];
4227                 else
4228                         return false;
4229         }
4230
4231         return true;
4232 }
4233
4234 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
4235         [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
4236                                     .len = NL80211_MAX_SUPP_RATES },
4237         [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
4238                                 .len = NL80211_MAX_SUPP_HT_RATES },
4239         [NL80211_TXRATE_VHT] = {
4240                 .type = NLA_EXACT_LEN_WARN,
4241                 .len = sizeof(struct nl80211_txrate_vht),
4242         },
4243         [NL80211_TXRATE_GI] = { .type = NLA_U8 },
4244 };
4245
4246 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
4247                                          struct cfg80211_bitrate_mask *mask)
4248 {
4249         struct nlattr *tb[NL80211_TXRATE_MAX + 1];
4250         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4251         int rem, i;
4252         struct nlattr *tx_rates;
4253         struct ieee80211_supported_band *sband;
4254         u16 vht_tx_mcs_map;
4255
4256         memset(mask, 0, sizeof(*mask));
4257         /* Default to all rates enabled */
4258         for (i = 0; i < NUM_NL80211_BANDS; i++) {
4259                 sband = rdev->wiphy.bands[i];
4260
4261                 if (!sband)
4262                         continue;
4263
4264                 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
4265                 memcpy(mask->control[i].ht_mcs,
4266                        sband->ht_cap.mcs.rx_mask,
4267                        sizeof(mask->control[i].ht_mcs));
4268
4269                 if (!sband->vht_cap.vht_supported)
4270                         continue;
4271
4272                 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
4273                 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
4274         }
4275
4276         /* if no rates are given set it back to the defaults */
4277         if (!info->attrs[NL80211_ATTR_TX_RATES])
4278                 goto out;
4279
4280         /* The nested attribute uses enum nl80211_band as the index. This maps
4281          * directly to the enum nl80211_band values used in cfg80211.
4282          */
4283         BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
4284         nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
4285                 enum nl80211_band band = nla_type(tx_rates);
4286                 int err;
4287
4288                 if (band < 0 || band >= NUM_NL80211_BANDS)
4289                         return -EINVAL;
4290                 sband = rdev->wiphy.bands[band];
4291                 if (sband == NULL)
4292                         return -EINVAL;
4293                 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX,
4294                                                   tx_rates,
4295                                                   nl80211_txattr_policy,
4296                                                   info->extack);
4297                 if (err)
4298                         return err;
4299                 if (tb[NL80211_TXRATE_LEGACY]) {
4300                         mask->control[band].legacy = rateset_to_mask(
4301                                 sband,
4302                                 nla_data(tb[NL80211_TXRATE_LEGACY]),
4303                                 nla_len(tb[NL80211_TXRATE_LEGACY]));
4304                         if ((mask->control[band].legacy == 0) &&
4305                             nla_len(tb[NL80211_TXRATE_LEGACY]))
4306                                 return -EINVAL;
4307                 }
4308                 if (tb[NL80211_TXRATE_HT]) {
4309                         if (!ht_rateset_to_mask(
4310                                         sband,
4311                                         nla_data(tb[NL80211_TXRATE_HT]),
4312                                         nla_len(tb[NL80211_TXRATE_HT]),
4313                                         mask->control[band].ht_mcs))
4314                                 return -EINVAL;
4315                 }
4316                 if (tb[NL80211_TXRATE_VHT]) {
4317                         if (!vht_set_mcs_mask(
4318                                         sband,
4319                                         nla_data(tb[NL80211_TXRATE_VHT]),
4320                                         mask->control[band].vht_mcs))
4321                                 return -EINVAL;
4322                 }
4323                 if (tb[NL80211_TXRATE_GI]) {
4324                         mask->control[band].gi =
4325                                 nla_get_u8(tb[NL80211_TXRATE_GI]);
4326                         if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
4327                                 return -EINVAL;
4328                 }
4329
4330                 if (mask->control[band].legacy == 0) {
4331                         /* don't allow empty legacy rates if HT or VHT
4332                          * are not even supported.
4333                          */
4334                         if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
4335                               rdev->wiphy.bands[band]->vht_cap.vht_supported))
4336                                 return -EINVAL;
4337
4338                         for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
4339                                 if (mask->control[band].ht_mcs[i])
4340                                         goto out;
4341
4342                         for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
4343                                 if (mask->control[band].vht_mcs[i])
4344                                         goto out;
4345
4346                         /* legacy and mcs rates may not be both empty */
4347                         return -EINVAL;
4348                 }
4349         }
4350
4351 out:
4352         return 0;
4353 }
4354
4355 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
4356                                    enum nl80211_band band,
4357                                    struct cfg80211_bitrate_mask *beacon_rate)
4358 {
4359         u32 count_ht, count_vht, i;
4360         u32 rate = beacon_rate->control[band].legacy;
4361
4362         /* Allow only one rate */
4363         if (hweight32(rate) > 1)
4364                 return -EINVAL;
4365
4366         count_ht = 0;
4367         for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
4368                 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
4369                         return -EINVAL;
4370                 } else if (beacon_rate->control[band].ht_mcs[i]) {
4371                         count_ht++;
4372                         if (count_ht > 1)
4373                                 return -EINVAL;
4374                 }
4375                 if (count_ht && rate)
4376                         return -EINVAL;
4377         }
4378
4379         count_vht = 0;
4380         for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
4381                 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
4382                         return -EINVAL;
4383                 } else if (beacon_rate->control[band].vht_mcs[i]) {
4384                         count_vht++;
4385                         if (count_vht > 1)
4386                                 return -EINVAL;
4387                 }
4388                 if (count_vht && rate)
4389                         return -EINVAL;
4390         }
4391
4392         if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
4393                 return -EINVAL;
4394
4395         if (rate &&
4396             !wiphy_ext_feature_isset(&rdev->wiphy,
4397                                      NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
4398                 return -EINVAL;
4399         if (count_ht &&
4400             !wiphy_ext_feature_isset(&rdev->wiphy,
4401                                      NL80211_EXT_FEATURE_BEACON_RATE_HT))
4402                 return -EINVAL;
4403         if (count_vht &&
4404             !wiphy_ext_feature_isset(&rdev->wiphy,
4405                                      NL80211_EXT_FEATURE_BEACON_RATE_VHT))
4406                 return -EINVAL;
4407
4408         return 0;
4409 }
4410
4411 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev,
4412                                 struct nlattr *attrs[],
4413                                 struct cfg80211_beacon_data *bcn)
4414 {
4415         bool haveinfo = false;
4416         int err;
4417
4418         memset(bcn, 0, sizeof(*bcn));
4419
4420         if (attrs[NL80211_ATTR_BEACON_HEAD]) {
4421                 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
4422                 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
4423                 if (!bcn->head_len)
4424                         return -EINVAL;
4425                 haveinfo = true;
4426         }
4427
4428         if (attrs[NL80211_ATTR_BEACON_TAIL]) {
4429                 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
4430                 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
4431                 haveinfo = true;
4432         }
4433
4434         if (!haveinfo)
4435                 return -EINVAL;
4436
4437         if (attrs[NL80211_ATTR_IE]) {
4438                 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
4439                 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
4440         }
4441
4442         if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
4443                 bcn->proberesp_ies =
4444                         nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
4445                 bcn->proberesp_ies_len =
4446                         nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
4447         }
4448
4449         if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
4450                 bcn->assocresp_ies =
4451                         nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
4452                 bcn->assocresp_ies_len =
4453                         nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
4454         }
4455
4456         if (attrs[NL80211_ATTR_PROBE_RESP]) {
4457                 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
4458                 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
4459         }
4460
4461         if (attrs[NL80211_ATTR_FTM_RESPONDER]) {
4462                 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1];
4463
4464                 err = nla_parse_nested_deprecated(tb,
4465                                                   NL80211_FTM_RESP_ATTR_MAX,
4466                                                   attrs[NL80211_ATTR_FTM_RESPONDER],
4467                                                   NULL, NULL);
4468                 if (err)
4469                         return err;
4470
4471                 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] &&
4472                     wiphy_ext_feature_isset(&rdev->wiphy,
4473                                             NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER))
4474                         bcn->ftm_responder = 1;
4475                 else
4476                         return -EOPNOTSUPP;
4477
4478                 if (tb[NL80211_FTM_RESP_ATTR_LCI]) {
4479                         bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]);
4480                         bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]);
4481                 }
4482
4483                 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) {
4484                         bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
4485                         bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
4486                 }
4487         } else {
4488                 bcn->ftm_responder = -1;
4489         }
4490
4491         return 0;
4492 }
4493
4494 static int nl80211_parse_he_obss_pd(struct nlattr *attrs,
4495                                     struct ieee80211_he_obss_pd *he_obss_pd)
4496 {
4497         struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1];
4498         int err;
4499
4500         err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs,
4501                                he_obss_pd_policy, NULL);
4502         if (err)
4503                 return err;
4504
4505         if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET])
4506                 he_obss_pd->min_offset =
4507                         nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]);
4508         if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET])
4509                 he_obss_pd->max_offset =
4510                         nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]);
4511
4512         if (he_obss_pd->min_offset > he_obss_pd->max_offset)
4513                 return -EINVAL;
4514
4515         he_obss_pd->enable = true;
4516
4517         return 0;
4518 }
4519
4520 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
4521                                             const u8 *rates)
4522 {
4523         int i;
4524
4525         if (!rates)
4526                 return;
4527
4528         for (i = 0; i < rates[1]; i++) {
4529                 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
4530                         params->ht_required = true;
4531                 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
4532                         params->vht_required = true;
4533         }
4534 }
4535
4536 /*
4537  * Since the nl80211 API didn't include, from the beginning, attributes about
4538  * HT/VHT requirements/capabilities, we parse them out of the IEs for the
4539  * benefit of drivers that rebuild IEs in the firmware.
4540  */
4541 static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
4542 {
4543         const struct cfg80211_beacon_data *bcn = &params->beacon;
4544         size_t ies_len = bcn->tail_len;
4545         const u8 *ies = bcn->tail;
4546         const u8 *rates;
4547         const u8 *cap;
4548
4549         rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
4550         nl80211_check_ap_rate_selectors(params, rates);
4551
4552         rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
4553         nl80211_check_ap_rate_selectors(params, rates);
4554
4555         cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
4556         if (cap && cap[1] >= sizeof(*params->ht_cap))
4557                 params->ht_cap = (void *)(cap + 2);
4558         cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
4559         if (cap && cap[1] >= sizeof(*params->vht_cap))
4560                 params->vht_cap = (void *)(cap + 2);
4561         cap = cfg80211_find_ext_ie(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len);
4562         if (cap && cap[1] >= sizeof(*params->he_cap) + 1)
4563                 params->he_cap = (void *)(cap + 3);
4564 }
4565
4566 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
4567                                    struct cfg80211_ap_settings *params)
4568 {
4569         struct wireless_dev *wdev;
4570         bool ret = false;
4571
4572         list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
4573                 if (wdev->iftype != NL80211_IFTYPE_AP &&
4574                     wdev->iftype != NL80211_IFTYPE_P2P_GO)
4575                         continue;
4576
4577                 if (!wdev->preset_chandef.chan)
4578                         continue;
4579
4580                 params->chandef = wdev->preset_chandef;
4581                 ret = true;
4582                 break;
4583         }
4584
4585         return ret;
4586 }
4587
4588 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
4589                                     enum nl80211_auth_type auth_type,
4590                                     enum nl80211_commands cmd)
4591 {
4592         if (auth_type > NL80211_AUTHTYPE_MAX)
4593                 return false;
4594
4595         switch (cmd) {
4596         case NL80211_CMD_AUTHENTICATE:
4597                 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
4598                     auth_type == NL80211_AUTHTYPE_SAE)
4599                         return false;
4600                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
4601                                              NL80211_EXT_FEATURE_FILS_STA) &&
4602                     (auth_type == NL80211_AUTHTYPE_FILS_SK ||
4603                      auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4604                      auth_type == NL80211_AUTHTYPE_FILS_PK))
4605                         return false;
4606                 return true;
4607         case NL80211_CMD_CONNECT:
4608                 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
4609                     !wiphy_ext_feature_isset(&rdev->wiphy,
4610                                              NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
4611                     auth_type == NL80211_AUTHTYPE_SAE)
4612                         return false;
4613
4614                 /* FILS with SK PFS or PK not supported yet */
4615                 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4616                     auth_type == NL80211_AUTHTYPE_FILS_PK)
4617                         return false;
4618                 if (!wiphy_ext_feature_isset(
4619                             &rdev->wiphy,
4620                             NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
4621                     auth_type == NL80211_AUTHTYPE_FILS_SK)
4622                         return false;
4623                 return true;
4624         case NL80211_CMD_START_AP:
4625                 /* SAE not supported yet */
4626                 if (auth_type == NL80211_AUTHTYPE_SAE)
4627                         return false;
4628                 /* FILS not supported yet */
4629                 if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
4630                     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4631                     auth_type == NL80211_AUTHTYPE_FILS_PK)
4632                         return false;
4633                 return true;
4634         default:
4635                 return false;
4636         }
4637 }
4638
4639 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
4640 {
4641         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4642         struct net_device *dev = info->user_ptr[1];
4643         struct wireless_dev *wdev = dev->ieee80211_ptr;
4644         struct cfg80211_ap_settings params;
4645         int err;
4646
4647         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4648             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4649                 return -EOPNOTSUPP;
4650
4651         if (!rdev->ops->start_ap)
4652                 return -EOPNOTSUPP;
4653
4654         if (wdev->beacon_interval)
4655                 return -EALREADY;
4656
4657         memset(&params, 0, sizeof(params));
4658
4659         /* these are required for START_AP */
4660         if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
4661             !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
4662             !info->attrs[NL80211_ATTR_BEACON_HEAD])
4663                 return -EINVAL;
4664
4665         err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon);
4666         if (err)
4667                 return err;
4668
4669         params.beacon_interval =
4670                 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
4671         params.dtim_period =
4672                 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
4673
4674         err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
4675                                            params.beacon_interval);
4676         if (err)
4677                 return err;
4678
4679         /*
4680          * In theory, some of these attributes should be required here
4681          * but since they were not used when the command was originally
4682          * added, keep them optional for old user space programs to let
4683          * them continue to work with drivers that do not need the
4684          * additional information -- drivers must check!
4685          */
4686         if (info->attrs[NL80211_ATTR_SSID]) {
4687                 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4688                 params.ssid_len =
4689                         nla_len(info->attrs[NL80211_ATTR_SSID]);
4690                 if (params.ssid_len == 0 ||
4691                     params.ssid_len > IEEE80211_MAX_SSID_LEN)
4692                         return -EINVAL;
4693         }
4694
4695         if (info->attrs[NL80211_ATTR_HIDDEN_SSID])
4696                 params.hidden_ssid = nla_get_u32(
4697                         info->attrs[NL80211_ATTR_HIDDEN_SSID]);
4698
4699         params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4700
4701         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4702                 params.auth_type = nla_get_u32(
4703                         info->attrs[NL80211_ATTR_AUTH_TYPE]);
4704                 if (!nl80211_valid_auth_type(rdev, params.auth_type,
4705                                              NL80211_CMD_START_AP))
4706                         return -EINVAL;
4707         } else
4708                 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4709
4710         err = nl80211_crypto_settings(rdev, info, &params.crypto,
4711                                       NL80211_MAX_NR_CIPHER_SUITES);
4712         if (err)
4713                 return err;
4714
4715         if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
4716                 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
4717                         return -EOPNOTSUPP;
4718                 params.inactivity_timeout = nla_get_u16(
4719                         info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
4720         }
4721
4722         if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
4723                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4724                         return -EINVAL;
4725                 params.p2p_ctwindow =
4726                         nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
4727                 if (params.p2p_ctwindow != 0 &&
4728                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
4729                         return -EINVAL;
4730         }
4731
4732         if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
4733                 u8 tmp;
4734
4735                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4736                         return -EINVAL;
4737                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
4738                 params.p2p_opp_ps = tmp;
4739                 if (params.p2p_opp_ps != 0 &&
4740                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
4741                         return -EINVAL;
4742         }
4743
4744         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
4745                 err = nl80211_parse_chandef(rdev, info, &params.chandef);
4746                 if (err)
4747                         return err;
4748         } else if (wdev->preset_chandef.chan) {
4749                 params.chandef = wdev->preset_chandef;
4750         } else if (!nl80211_get_ap_channel(rdev, &params))
4751                 return -EINVAL;
4752
4753         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
4754                                            wdev->iftype))
4755                 return -EINVAL;
4756
4757         if (info->attrs[NL80211_ATTR_TX_RATES]) {
4758                 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
4759                 if (err)
4760                         return err;
4761
4762                 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
4763                                               &params.beacon_rate);
4764                 if (err)
4765                         return err;
4766         }
4767
4768         if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
4769                 params.smps_mode =
4770                         nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
4771                 switch (params.smps_mode) {
4772                 case NL80211_SMPS_OFF:
4773                         break;
4774                 case NL80211_SMPS_STATIC:
4775                         if (!(rdev->wiphy.features &
4776                               NL80211_FEATURE_STATIC_SMPS))
4777                                 return -EINVAL;
4778                         break;
4779                 case NL80211_SMPS_DYNAMIC:
4780                         if (!(rdev->wiphy.features &
4781                               NL80211_FEATURE_DYNAMIC_SMPS))
4782                                 return -EINVAL;
4783                         break;
4784                 default:
4785                         return -EINVAL;
4786                 }
4787         } else {
4788                 params.smps_mode = NL80211_SMPS_OFF;
4789         }
4790
4791         params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
4792         if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
4793                 return -EOPNOTSUPP;
4794
4795         if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
4796                 params.acl = parse_acl_data(&rdev->wiphy, info);
4797                 if (IS_ERR(params.acl))
4798                         return PTR_ERR(params.acl);
4799         }
4800
4801         params.twt_responder =
4802                     nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]);
4803
4804         if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) {
4805                 err = nl80211_parse_he_obss_pd(
4806                                         info->attrs[NL80211_ATTR_HE_OBSS_PD],
4807                                         &params.he_obss_pd);
4808                 if (err)
4809                         goto out;
4810         }
4811
4812         nl80211_calculate_ap_params(&params);
4813
4814         if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])
4815                 params.flags |= AP_SETTINGS_EXTERNAL_AUTH_SUPPORT;
4816
4817         wdev_lock(wdev);
4818         err = rdev_start_ap(rdev, dev, &params);
4819         if (!err) {
4820                 wdev->preset_chandef = params.chandef;
4821                 wdev->beacon_interval = params.beacon_interval;
4822                 wdev->chandef = params.chandef;
4823                 wdev->ssid_len = params.ssid_len;
4824                 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
4825
4826                 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
4827                         wdev->conn_owner_nlportid = info->snd_portid;
4828         }
4829         wdev_unlock(wdev);
4830
4831 out:
4832         kfree(params.acl);
4833
4834         return err;
4835 }
4836
4837 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
4838 {
4839         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4840         struct net_device *dev = info->user_ptr[1];
4841         struct wireless_dev *wdev = dev->ieee80211_ptr;
4842         struct cfg80211_beacon_data params;
4843         int err;
4844
4845         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4846             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4847                 return -EOPNOTSUPP;
4848
4849         if (!rdev->ops->change_beacon)
4850                 return -EOPNOTSUPP;
4851
4852         if (!wdev->beacon_interval)
4853                 return -EINVAL;
4854
4855         err = nl80211_parse_beacon(rdev, info->attrs, &params);
4856         if (err)
4857                 return err;
4858
4859         wdev_lock(wdev);
4860         err = rdev_change_beacon(rdev, dev, &params);
4861         wdev_unlock(wdev);
4862
4863         return err;
4864 }
4865
4866 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
4867 {
4868         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4869         struct net_device *dev = info->user_ptr[1];
4870
4871         return cfg80211_stop_ap(rdev, dev, false);
4872 }
4873
4874 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
4875         [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
4876         [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
4877         [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
4878         [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
4879         [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
4880         [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
4881 };
4882
4883 static int parse_station_flags(struct genl_info *info,
4884                                enum nl80211_iftype iftype,
4885                                struct station_parameters *params)
4886 {
4887         struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
4888         struct nlattr *nla;
4889         int flag;
4890
4891         /*
4892          * Try parsing the new attribute first so userspace
4893          * can specify both for older kernels.
4894          */
4895         nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4896         if (nla) {
4897                 struct nl80211_sta_flag_update *sta_flags;
4898
4899                 sta_flags = nla_data(nla);
4900                 params->sta_flags_mask = sta_flags->mask;
4901                 params->sta_flags_set = sta_flags->set;
4902                 params->sta_flags_set &= params->sta_flags_mask;
4903                 if ((params->sta_flags_mask |
4904                      params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4905                         return -EINVAL;
4906                 return 0;
4907         }
4908
4909         /* if present, parse the old attribute */
4910
4911         nla = info->attrs[NL80211_ATTR_STA_FLAGS];
4912         if (!nla)
4913                 return 0;
4914
4915         if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack))
4916                 return -EINVAL;
4917
4918         /*
4919          * Only allow certain flags for interface types so that
4920          * other attributes are silently ignored. Remember that
4921          * this is backward compatibility code with old userspace
4922          * and shouldn't be hit in other cases anyway.
4923          */
4924         switch (iftype) {
4925         case NL80211_IFTYPE_AP:
4926         case NL80211_IFTYPE_AP_VLAN:
4927         case NL80211_IFTYPE_P2P_GO:
4928                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4929                                          BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4930                                          BIT(NL80211_STA_FLAG_WME) |
4931                                          BIT(NL80211_STA_FLAG_MFP);
4932                 break;
4933         case NL80211_IFTYPE_P2P_CLIENT:
4934         case NL80211_IFTYPE_STATION:
4935                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4936                                          BIT(NL80211_STA_FLAG_TDLS_PEER);
4937                 break;
4938         case NL80211_IFTYPE_MESH_POINT:
4939                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4940                                          BIT(NL80211_STA_FLAG_MFP) |
4941                                          BIT(NL80211_STA_FLAG_AUTHORIZED);
4942                 break;
4943         default:
4944                 return -EINVAL;
4945         }
4946
4947         for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4948                 if (flags[flag]) {
4949                         params->sta_flags_set |= (1<<flag);
4950
4951                         /* no longer support new API additions in old API */
4952                         if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4953                                 return -EINVAL;
4954                 }
4955         }
4956
4957         return 0;
4958 }
4959
4960 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr)
4961 {
4962         struct nlattr *rate;
4963         u32 bitrate;
4964         u16 bitrate_compat;
4965         enum nl80211_rate_info rate_flg;
4966
4967         rate = nla_nest_start_noflag(msg, attr);
4968         if (!rate)
4969                 return false;
4970
4971         /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4972         bitrate = cfg80211_calculate_bitrate(info);
4973         /* report 16-bit bitrate only if we can */
4974         bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
4975         if (bitrate > 0 &&
4976             nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4977                 return false;
4978         if (bitrate_compat > 0 &&
4979             nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4980                 return false;
4981
4982         switch (info->bw) {
4983         case RATE_INFO_BW_5:
4984                 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4985                 break;
4986         case RATE_INFO_BW_10:
4987                 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4988                 break;
4989         default:
4990                 WARN_ON(1);
4991                 /* fall through */
4992         case RATE_INFO_BW_20:
4993                 rate_flg = 0;
4994                 break;
4995         case RATE_INFO_BW_40:
4996                 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4997                 break;
4998         case RATE_INFO_BW_80:
4999                 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
5000                 break;
5001         case RATE_INFO_BW_160:
5002                 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
5003                 break;
5004         case RATE_INFO_BW_HE_RU:
5005                 rate_flg = 0;
5006                 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS));
5007         }
5008
5009         if (rate_flg && nla_put_flag(msg, rate_flg))
5010                 return false;
5011
5012         if (info->flags & RATE_INFO_FLAGS_MCS) {
5013                 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
5014                         return false;
5015                 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
5016                     nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
5017                         return false;
5018         } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
5019                 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
5020                         return false;
5021                 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
5022                         return false;
5023                 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
5024                     nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
5025                         return false;
5026         } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) {
5027                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs))
5028                         return false;
5029                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss))
5030                         return false;
5031                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi))
5032                         return false;
5033                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm))
5034                         return false;
5035                 if (info->bw == RATE_INFO_BW_HE_RU &&
5036                     nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC,
5037                                info->he_ru_alloc))
5038                         return false;
5039         }
5040
5041         nla_nest_end(msg, rate);
5042         return true;
5043 }
5044
5045 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
5046                                int id)
5047 {
5048         void *attr;
5049         int i = 0;
5050
5051         if (!mask)
5052                 return true;
5053
5054         attr = nla_nest_start_noflag(msg, id);
5055         if (!attr)
5056                 return false;
5057
5058         for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
5059                 if (!(mask & BIT(i)))
5060                         continue;
5061
5062                 if (nla_put_u8(msg, i, signal[i]))
5063                         return false;
5064         }
5065
5066         nla_nest_end(msg, attr);
5067
5068         return true;
5069 }
5070
5071 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
5072                                 u32 seq, int flags,
5073                                 struct cfg80211_registered_device *rdev,
5074                                 struct net_device *dev,
5075                                 const u8 *mac_addr, struct station_info *sinfo)
5076 {
5077         void *hdr;
5078         struct nlattr *sinfoattr, *bss_param;
5079
5080         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
5081         if (!hdr) {
5082                 cfg80211_sinfo_release_content(sinfo);
5083                 return -1;
5084         }
5085
5086         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5087             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
5088             nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
5089                 goto nla_put_failure;
5090
5091         sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO);
5092         if (!sinfoattr)
5093                 goto nla_put_failure;
5094
5095 #define PUT_SINFO(attr, memb, type) do {                                \
5096         BUILD_BUG_ON(sizeof(type) == sizeof(u64));                      \
5097         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&       \
5098             nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr,            \
5099                              sinfo->memb))                              \
5100                 goto nla_put_failure;                                   \
5101         } while (0)
5102 #define PUT_SINFO_U64(attr, memb) do {                                  \
5103         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&       \
5104             nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr,           \
5105                               sinfo->memb, NL80211_STA_INFO_PAD))       \
5106                 goto nla_put_failure;                                   \
5107         } while (0)
5108
5109         PUT_SINFO(CONNECTED_TIME, connected_time, u32);
5110         PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
5111         PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at);
5112
5113         if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) |
5114                              BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) &&
5115             nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
5116                         (u32)sinfo->rx_bytes))
5117                 goto nla_put_failure;
5118
5119         if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) |
5120                              BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) &&
5121             nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
5122                         (u32)sinfo->tx_bytes))
5123                 goto nla_put_failure;
5124
5125         PUT_SINFO_U64(RX_BYTES64, rx_bytes);
5126         PUT_SINFO_U64(TX_BYTES64, tx_bytes);
5127         PUT_SINFO(LLID, llid, u16);
5128         PUT_SINFO(PLID, plid, u16);
5129         PUT_SINFO(PLINK_STATE, plink_state, u8);
5130         PUT_SINFO_U64(RX_DURATION, rx_duration);
5131         PUT_SINFO_U64(TX_DURATION, tx_duration);
5132
5133         if (wiphy_ext_feature_isset(&rdev->wiphy,
5134                                     NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
5135                 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16);
5136
5137         switch (rdev->wiphy.signal_type) {
5138         case CFG80211_SIGNAL_TYPE_MBM:
5139                 PUT_SINFO(SIGNAL, signal, u8);
5140                 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
5141                 break;
5142         default:
5143                 break;
5144         }
5145         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) {
5146                 if (!nl80211_put_signal(msg, sinfo->chains,
5147                                         sinfo->chain_signal,
5148                                         NL80211_STA_INFO_CHAIN_SIGNAL))
5149                         goto nla_put_failure;
5150         }
5151         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
5152                 if (!nl80211_put_signal(msg, sinfo->chains,
5153                                         sinfo->chain_signal_avg,
5154                                         NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
5155                         goto nla_put_failure;
5156         }
5157         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) {
5158                 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
5159                                           NL80211_STA_INFO_TX_BITRATE))
5160                         goto nla_put_failure;
5161         }
5162         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) {
5163                 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
5164                                           NL80211_STA_INFO_RX_BITRATE))
5165                         goto nla_put_failure;
5166         }
5167
5168         PUT_SINFO(RX_PACKETS, rx_packets, u32);
5169         PUT_SINFO(TX_PACKETS, tx_packets, u32);
5170         PUT_SINFO(TX_RETRIES, tx_retries, u32);
5171         PUT_SINFO(TX_FAILED, tx_failed, u32);
5172         PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
5173         PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32);
5174         PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
5175         PUT_SINFO(LOCAL_PM, local_pm, u32);
5176         PUT_SINFO(PEER_PM, peer_pm, u32);
5177         PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
5178         PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8);
5179
5180         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) {
5181                 bss_param = nla_nest_start_noflag(msg,
5182                                                   NL80211_STA_INFO_BSS_PARAM);
5183                 if (!bss_param)
5184                         goto nla_put_failure;
5185
5186                 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
5187                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
5188                     ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
5189                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
5190                     ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
5191                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
5192                     nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
5193                                sinfo->bss_param.dtim_period) ||
5194                     nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
5195                                 sinfo->bss_param.beacon_interval))
5196                         goto nla_put_failure;
5197
5198                 nla_nest_end(msg, bss_param);
5199         }
5200         if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) &&
5201             nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
5202                     sizeof(struct nl80211_sta_flag_update),
5203                     &sinfo->sta_flags))
5204                 goto nla_put_failure;
5205
5206         PUT_SINFO_U64(T_OFFSET, t_offset);
5207         PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
5208         PUT_SINFO_U64(BEACON_RX, rx_beacon);
5209         PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
5210         PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32);
5211         PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32);
5212         if (wiphy_ext_feature_isset(&rdev->wiphy,
5213                                     NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) {
5214                 PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
5215                 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8);
5216         }
5217
5218 #undef PUT_SINFO
5219 #undef PUT_SINFO_U64
5220
5221         if (sinfo->pertid) {
5222                 struct nlattr *tidsattr;
5223                 int tid;
5224
5225                 tidsattr = nla_nest_start_noflag(msg,
5226                                                  NL80211_STA_INFO_TID_STATS);
5227                 if (!tidsattr)
5228                         goto nla_put_failure;
5229
5230                 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
5231                         struct cfg80211_tid_stats *tidstats;
5232                         struct nlattr *tidattr;
5233
5234                         tidstats = &sinfo->pertid[tid];
5235
5236                         if (!tidstats->filled)
5237                                 continue;
5238
5239                         tidattr = nla_nest_start_noflag(msg, tid + 1);
5240                         if (!tidattr)
5241                                 goto nla_put_failure;
5242
5243 #define PUT_TIDVAL_U64(attr, memb) do {                                 \
5244         if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) &&       \
5245             nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr,          \
5246                               tidstats->memb, NL80211_TID_STATS_PAD))   \
5247                 goto nla_put_failure;                                   \
5248         } while (0)
5249
5250                         PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
5251                         PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
5252                         PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
5253                         PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
5254
5255 #undef PUT_TIDVAL_U64
5256                         if ((tidstats->filled &
5257                              BIT(NL80211_TID_STATS_TXQ_STATS)) &&
5258                             !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
5259                                                    NL80211_TID_STATS_TXQ_STATS))
5260                                 goto nla_put_failure;
5261
5262                         nla_nest_end(msg, tidattr);
5263                 }
5264
5265                 nla_nest_end(msg, tidsattr);
5266         }
5267
5268         nla_nest_end(msg, sinfoattr);
5269
5270         if (sinfo->assoc_req_ies_len &&
5271             nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
5272                     sinfo->assoc_req_ies))
5273                 goto nla_put_failure;
5274
5275         cfg80211_sinfo_release_content(sinfo);
5276         genlmsg_end(msg, hdr);
5277         return 0;
5278
5279  nla_put_failure:
5280         cfg80211_sinfo_release_content(sinfo);
5281         genlmsg_cancel(msg, hdr);
5282         return -EMSGSIZE;
5283 }
5284
5285 static int nl80211_dump_station(struct sk_buff *skb,
5286                                 struct netlink_callback *cb)
5287 {
5288         struct station_info sinfo;
5289         struct cfg80211_registered_device *rdev;
5290         struct wireless_dev *wdev;
5291         u8 mac_addr[ETH_ALEN];
5292         int sta_idx = cb->args[2];
5293         int err;
5294
5295         rtnl_lock();
5296         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
5297         if (err)
5298                 goto out_err;
5299
5300         if (!wdev->netdev) {
5301                 err = -EINVAL;
5302                 goto out_err;
5303         }
5304
5305         if (!rdev->ops->dump_station) {
5306                 err = -EOPNOTSUPP;
5307                 goto out_err;
5308         }
5309
5310         while (1) {
5311                 memset(&sinfo, 0, sizeof(sinfo));
5312                 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
5313                                         mac_addr, &sinfo);
5314                 if (err == -ENOENT)
5315                         break;
5316                 if (err)
5317                         goto out_err;
5318
5319                 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
5320                                 NETLINK_CB(cb->skb).portid,
5321                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5322                                 rdev, wdev->netdev, mac_addr,
5323                                 &sinfo) < 0)
5324                         goto out;
5325
5326                 sta_idx++;
5327         }
5328
5329  out:
5330         cb->args[2] = sta_idx;
5331         err = skb->len;
5332  out_err:
5333         rtnl_unlock();
5334
5335         return err;
5336 }
5337
5338 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
5339 {
5340         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5341         struct net_device *dev = info->user_ptr[1];
5342         struct station_info sinfo;
5343         struct sk_buff *msg;
5344         u8 *mac_addr = NULL;
5345         int err;
5346
5347         memset(&sinfo, 0, sizeof(sinfo));
5348
5349         if (!info->attrs[NL80211_ATTR_MAC])
5350                 return -EINVAL;
5351
5352         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5353
5354         if (!rdev->ops->get_station)
5355                 return -EOPNOTSUPP;
5356
5357         err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
5358         if (err)
5359                 return err;
5360
5361         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5362         if (!msg) {
5363                 cfg80211_sinfo_release_content(&sinfo);
5364                 return -ENOMEM;
5365         }
5366
5367         if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
5368                                  info->snd_portid, info->snd_seq, 0,
5369                                  rdev, dev, mac_addr, &sinfo) < 0) {
5370                 nlmsg_free(msg);
5371                 return -ENOBUFS;
5372         }
5373
5374         return genlmsg_reply(msg, info);
5375 }
5376
5377 int cfg80211_check_station_change(struct wiphy *wiphy,
5378                                   struct station_parameters *params,
5379                                   enum cfg80211_station_type statype)
5380 {
5381         if (params->listen_interval != -1 &&
5382             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5383                 return -EINVAL;
5384
5385         if (params->support_p2p_ps != -1 &&
5386             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5387                 return -EINVAL;
5388
5389         if (params->aid &&
5390             !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
5391             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5392                 return -EINVAL;
5393
5394         /* When you run into this, adjust the code below for the new flag */
5395         BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5396
5397         switch (statype) {
5398         case CFG80211_STA_MESH_PEER_KERNEL:
5399         case CFG80211_STA_MESH_PEER_USER:
5400                 /*
5401                  * No ignoring the TDLS flag here -- the userspace mesh
5402                  * code doesn't have the bug of including TDLS in the
5403                  * mask everywhere.
5404                  */
5405                 if (params->sta_flags_mask &
5406                                 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5407                                   BIT(NL80211_STA_FLAG_MFP) |
5408                                   BIT(NL80211_STA_FLAG_AUTHORIZED)))
5409                         return -EINVAL;
5410                 break;
5411         case CFG80211_STA_TDLS_PEER_SETUP:
5412         case CFG80211_STA_TDLS_PEER_ACTIVE:
5413                 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5414                         return -EINVAL;
5415                 /* ignore since it can't change */
5416                 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5417                 break;
5418         default:
5419                 /* disallow mesh-specific things */
5420                 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
5421                         return -EINVAL;
5422                 if (params->local_pm)
5423                         return -EINVAL;
5424                 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
5425                         return -EINVAL;
5426         }
5427
5428         if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
5429             statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
5430                 /* TDLS can't be set, ... */
5431                 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
5432                         return -EINVAL;
5433                 /*
5434                  * ... but don't bother the driver with it. This works around
5435                  * a hostapd/wpa_supplicant issue -- it always includes the
5436                  * TLDS_PEER flag in the mask even for AP mode.
5437                  */
5438                 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5439         }
5440
5441         if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
5442             statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
5443                 /* reject other things that can't change */
5444                 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
5445                         return -EINVAL;
5446                 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
5447                         return -EINVAL;
5448                 if (params->supported_rates)
5449                         return -EINVAL;
5450                 if (params->ext_capab || params->ht_capa || params->vht_capa ||
5451                     params->he_capa)
5452                         return -EINVAL;
5453         }
5454
5455         if (statype != CFG80211_STA_AP_CLIENT &&
5456             statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
5457                 if (params->vlan)
5458                         return -EINVAL;
5459         }
5460
5461         switch (statype) {
5462         case CFG80211_STA_AP_MLME_CLIENT:
5463                 /* Use this only for authorizing/unauthorizing a station */
5464                 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
5465                         return -EOPNOTSUPP;
5466                 break;
5467         case CFG80211_STA_AP_CLIENT:
5468         case CFG80211_STA_AP_CLIENT_UNASSOC:
5469                 /* accept only the listed bits */
5470                 if (params->sta_flags_mask &
5471                                 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
5472                                   BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5473                                   BIT(NL80211_STA_FLAG_ASSOCIATED) |
5474                                   BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
5475                                   BIT(NL80211_STA_FLAG_WME) |
5476                                   BIT(NL80211_STA_FLAG_MFP)))
5477                         return -EINVAL;
5478
5479                 /* but authenticated/associated only if driver handles it */
5480                 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5481                     params->sta_flags_mask &
5482                                 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5483                                  BIT(NL80211_STA_FLAG_ASSOCIATED)))
5484                         return -EINVAL;
5485                 break;
5486         case CFG80211_STA_IBSS:
5487         case CFG80211_STA_AP_STA:
5488                 /* reject any changes other than AUTHORIZED */
5489                 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
5490                         return -EINVAL;
5491                 break;
5492         case CFG80211_STA_TDLS_PEER_SETUP:
5493                 /* reject any changes other than AUTHORIZED or WME */
5494                 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
5495                                                BIT(NL80211_STA_FLAG_WME)))
5496                         return -EINVAL;
5497                 /* force (at least) rates when authorizing */
5498                 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
5499                     !params->supported_rates)
5500                         return -EINVAL;
5501                 break;
5502         case CFG80211_STA_TDLS_PEER_ACTIVE:
5503                 /* reject any changes */
5504                 return -EINVAL;
5505         case CFG80211_STA_MESH_PEER_KERNEL:
5506                 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
5507                         return -EINVAL;
5508                 break;
5509         case CFG80211_STA_MESH_PEER_USER:
5510                 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
5511                     params->plink_action != NL80211_PLINK_ACTION_BLOCK)
5512                         return -EINVAL;
5513                 break;
5514         }
5515
5516         /*
5517          * Older kernel versions ignored this attribute entirely, so don't
5518          * reject attempts to update it but mark it as unused instead so the
5519          * driver won't look at the data.
5520          */
5521         if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
5522             statype != CFG80211_STA_TDLS_PEER_SETUP)
5523                 params->opmode_notif_used = false;
5524
5525         return 0;
5526 }
5527 EXPORT_SYMBOL(cfg80211_check_station_change);
5528
5529 /*
5530  * Get vlan interface making sure it is running and on the right wiphy.
5531  */
5532 static struct net_device *get_vlan(struct genl_info *info,
5533                                    struct cfg80211_registered_device *rdev)
5534 {
5535         struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
5536         struct net_device *v;
5537         int ret;
5538
5539         if (!vlanattr)
5540                 return NULL;
5541
5542         v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
5543         if (!v)
5544                 return ERR_PTR(-ENODEV);
5545
5546         if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
5547                 ret = -EINVAL;
5548                 goto error;
5549         }
5550
5551         if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5552             v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5553             v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
5554                 ret = -EINVAL;
5555                 goto error;
5556         }
5557
5558         if (!netif_running(v)) {
5559                 ret = -ENETDOWN;
5560                 goto error;
5561         }
5562
5563         return v;
5564  error:
5565         dev_put(v);
5566         return ERR_PTR(ret);
5567 }
5568
5569 static const struct nla_policy
5570 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
5571         [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
5572         [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
5573 };
5574
5575 static int nl80211_parse_sta_wme(struct genl_info *info,
5576                                  struct station_parameters *params)
5577 {
5578         struct nlattr *tb[NL80211_STA_WME_MAX + 1];
5579         struct nlattr *nla;
5580         int err;
5581
5582         /* parse WME attributes if present */
5583         if (!info->attrs[NL80211_ATTR_STA_WME])
5584                 return 0;
5585
5586         nla = info->attrs[NL80211_ATTR_STA_WME];
5587         err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla,
5588                                           nl80211_sta_wme_policy,
5589                                           info->extack);
5590         if (err)
5591                 return err;
5592
5593         if (tb[NL80211_STA_WME_UAPSD_QUEUES])
5594                 params->uapsd_queues = nla_get_u8(
5595                         tb[NL80211_STA_WME_UAPSD_QUEUES]);
5596         if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
5597                 return -EINVAL;
5598
5599         if (tb[NL80211_STA_WME_MAX_SP])
5600                 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
5601
5602         if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
5603                 return -EINVAL;
5604
5605         params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
5606
5607         return 0;
5608 }
5609
5610 static int nl80211_parse_sta_channel_info(struct genl_info *info,
5611                                       struct station_parameters *params)
5612 {
5613         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
5614                 params->supported_channels =
5615                      nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
5616                 params->supported_channels_len =
5617                      nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
5618                 /*
5619                  * Need to include at least one (first channel, number of
5620                  * channels) tuple for each subband, and must have proper
5621                  * tuples for the rest of the data as well.
5622                  */
5623                 if (params->supported_channels_len < 2)
5624                         return -EINVAL;
5625                 if (params->supported_channels_len % 2)
5626                         return -EINVAL;
5627         }
5628
5629         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
5630                 params->supported_oper_classes =
5631                  nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
5632                 params->supported_oper_classes_len =
5633                   nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
5634                 /*
5635                  * The value of the Length field of the Supported Operating
5636                  * Classes element is between 2 and 253.
5637                  */
5638                 if (params->supported_oper_classes_len < 2 ||
5639                     params->supported_oper_classes_len > 253)
5640                         return -EINVAL;
5641         }
5642         return 0;
5643 }
5644
5645 static int nl80211_set_station_tdls(struct genl_info *info,
5646                                     struct station_parameters *params)
5647 {
5648         int err;
5649         /* Dummy STA entry gets updated once the peer capabilities are known */
5650         if (info->attrs[NL80211_ATTR_PEER_AID])
5651                 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5652         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5653                 params->ht_capa =
5654                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5655         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5656                 params->vht_capa =
5657                         nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5658         if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
5659                 params->he_capa =
5660                         nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5661                 params->he_capa_len =
5662                         nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5663
5664                 if (params->he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN)
5665                         return -EINVAL;
5666         }
5667
5668         err = nl80211_parse_sta_channel_info(info, params);
5669         if (err)
5670                 return err;
5671
5672         return nl80211_parse_sta_wme(info, params);
5673 }
5674
5675 static int nl80211_parse_sta_txpower_setting(struct genl_info *info,
5676                                              struct station_parameters *params)
5677 {
5678         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5679         int idx;
5680
5681         if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) {
5682                 if (!rdev->ops->set_tx_power ||
5683                     !wiphy_ext_feature_isset(&rdev->wiphy,
5684                                          NL80211_EXT_FEATURE_STA_TX_PWR))
5685                         return -EOPNOTSUPP;
5686
5687                 idx = NL80211_ATTR_STA_TX_POWER_SETTING;
5688                 params->txpwr.type = nla_get_u8(info->attrs[idx]);
5689
5690                 if (params->txpwr.type == NL80211_TX_POWER_LIMITED) {
5691                         idx = NL80211_ATTR_STA_TX_POWER;
5692
5693                         if (info->attrs[idx])
5694                                 params->txpwr.power =
5695                                         nla_get_s16(info->attrs[idx]);
5696                         else
5697                                 return -EINVAL;
5698                 }
5699                 params->sta_modify_mask |= STATION_PARAM_APPLY_STA_TXPOWER;
5700         }
5701
5702         return 0;
5703 }
5704
5705 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
5706 {
5707         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5708         struct net_device *dev = info->user_ptr[1];
5709         struct station_parameters params;
5710         u8 *mac_addr;
5711         int err;
5712
5713         memset(&params, 0, sizeof(params));
5714
5715         if (!rdev->ops->change_station)
5716                 return -EOPNOTSUPP;
5717
5718         /*
5719          * AID and listen_interval properties can be set only for unassociated
5720          * station. Include these parameters here and will check them in
5721          * cfg80211_check_station_change().
5722          */
5723         if (info->attrs[NL80211_ATTR_STA_AID])
5724                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5725
5726         if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5727                 params.listen_interval =
5728                      nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5729         else
5730                 params.listen_interval = -1;
5731
5732         if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS])
5733                 params.support_p2p_ps =
5734                         nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5735         else
5736                 params.support_p2p_ps = -1;
5737
5738         if (!info->attrs[NL80211_ATTR_MAC])
5739                 return -EINVAL;
5740
5741         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5742
5743         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
5744                 params.supported_rates =
5745                         nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5746                 params.supported_rates_len =
5747                         nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5748         }
5749
5750         if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5751                 params.capability =
5752                         nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5753                 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5754         }
5755
5756         if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5757                 params.ext_capab =
5758                         nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5759                 params.ext_capab_len =
5760                         nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5761         }
5762
5763         if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5764                 return -EINVAL;
5765
5766         if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
5767                 params.plink_action =
5768                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5769
5770         if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
5771                 params.plink_state =
5772                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
5773                 if (info->attrs[NL80211_ATTR_MESH_PEER_AID])
5774                         params.peer_aid = nla_get_u16(
5775                                 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
5776                 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
5777         }
5778
5779         if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE])
5780                 params.local_pm = nla_get_u32(
5781                         info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
5782
5783         if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5784                 params.opmode_notif_used = true;
5785                 params.opmode_notif =
5786                         nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5787         }
5788
5789         if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
5790                 params.airtime_weight =
5791                         nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
5792
5793         if (params.airtime_weight &&
5794             !wiphy_ext_feature_isset(&rdev->wiphy,
5795                                      NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
5796                 return -EOPNOTSUPP;
5797
5798         err = nl80211_parse_sta_txpower_setting(info, &params);
5799         if (err)
5800                 return err;
5801
5802         /* Include parameters for TDLS peer (will check later) */
5803         err = nl80211_set_station_tdls(info, &params);
5804         if (err)
5805                 return err;
5806
5807         params.vlan = get_vlan(info, rdev);
5808         if (IS_ERR(params.vlan))
5809                 return PTR_ERR(params.vlan);
5810
5811         switch (dev->ieee80211_ptr->iftype) {
5812         case NL80211_IFTYPE_AP:
5813         case NL80211_IFTYPE_AP_VLAN:
5814         case NL80211_IFTYPE_P2P_GO:
5815         case NL80211_IFTYPE_P2P_CLIENT:
5816         case NL80211_IFTYPE_STATION:
5817         case NL80211_IFTYPE_ADHOC:
5818         case NL80211_IFTYPE_MESH_POINT:
5819                 break;
5820         default:
5821                 err = -EOPNOTSUPP;
5822                 goto out_put_vlan;
5823         }
5824
5825         /* driver will call cfg80211_check_station_change() */
5826         err = rdev_change_station(rdev, dev, mac_addr, &params);
5827
5828  out_put_vlan:
5829         if (params.vlan)
5830                 dev_put(params.vlan);
5831
5832         return err;
5833 }
5834
5835 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
5836 {
5837         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5838         int err;
5839         struct net_device *dev = info->user_ptr[1];
5840         struct station_parameters params;
5841         u8 *mac_addr = NULL;
5842         u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5843                          BIT(NL80211_STA_FLAG_ASSOCIATED);
5844
5845         memset(&params, 0, sizeof(params));
5846
5847         if (!rdev->ops->add_station)
5848                 return -EOPNOTSUPP;
5849
5850         if (!info->attrs[NL80211_ATTR_MAC])
5851                 return -EINVAL;
5852
5853         if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5854                 return -EINVAL;
5855
5856         if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
5857                 return -EINVAL;
5858
5859         if (!info->attrs[NL80211_ATTR_STA_AID] &&
5860             !info->attrs[NL80211_ATTR_PEER_AID])
5861                 return -EINVAL;
5862
5863         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5864         params.supported_rates =
5865                 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5866         params.supported_rates_len =
5867                 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5868         params.listen_interval =
5869                 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5870
5871         if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
5872                 params.support_p2p_ps =
5873                         nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5874         } else {
5875                 /*
5876                  * if not specified, assume it's supported for P2P GO interface,
5877                  * and is NOT supported for AP interface
5878                  */
5879                 params.support_p2p_ps =
5880                         dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
5881         }
5882
5883         if (info->attrs[NL80211_ATTR_PEER_AID])
5884                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5885         else
5886                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5887
5888         if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5889                 params.capability =
5890                         nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5891                 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5892         }
5893
5894         if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5895                 params.ext_capab =
5896                         nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5897                 params.ext_capab_len =
5898                         nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5899         }
5900
5901         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5902                 params.ht_capa =
5903                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5904
5905         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5906                 params.vht_capa =
5907                         nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5908
5909         if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
5910                 params.he_capa =
5911                         nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5912                 params.he_capa_len =
5913                         nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5914
5915                 /* max len is validated in nla policy */
5916                 if (params.he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN)
5917                         return -EINVAL;
5918         }
5919
5920         if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5921                 params.opmode_notif_used = true;
5922                 params.opmode_notif =
5923                         nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5924         }
5925
5926         if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
5927                 params.plink_action =
5928                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5929
5930         if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
5931                 params.airtime_weight =
5932                         nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
5933
5934         if (params.airtime_weight &&
5935             !wiphy_ext_feature_isset(&rdev->wiphy,
5936                                      NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
5937                 return -EOPNOTSUPP;
5938
5939         err = nl80211_parse_sta_txpower_setting(info, &params);
5940         if (err)
5941                 return err;
5942
5943         err = nl80211_parse_sta_channel_info(info, &params);
5944         if (err)
5945                 return err;
5946
5947         err = nl80211_parse_sta_wme(info, &params);
5948         if (err)
5949                 return err;
5950
5951         if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5952                 return -EINVAL;
5953
5954         /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
5955          * as userspace might just pass through the capabilities from the IEs
5956          * directly, rather than enforcing this restriction and returning an
5957          * error in this case.
5958          */
5959         if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
5960                 params.ht_capa = NULL;
5961                 params.vht_capa = NULL;
5962
5963                 /* HE requires WME */
5964                 if (params.he_capa_len)
5965                         return -EINVAL;
5966         }
5967
5968         /* When you run into this, adjust the code below for the new flag */
5969         BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5970
5971         switch (dev->ieee80211_ptr->iftype) {
5972         case NL80211_IFTYPE_AP:
5973         case NL80211_IFTYPE_AP_VLAN:
5974         case NL80211_IFTYPE_P2P_GO:
5975                 /* ignore WME attributes if iface/sta is not capable */
5976                 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
5977                     !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
5978                         params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5979
5980                 /* TDLS peers cannot be added */
5981                 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5982                     info->attrs[NL80211_ATTR_PEER_AID])
5983                         return -EINVAL;
5984                 /* but don't bother the driver with it */
5985                 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5986
5987                 /* allow authenticated/associated only if driver handles it */
5988                 if (!(rdev->wiphy.features &
5989                                 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5990                     params.sta_flags_mask & auth_assoc)
5991                         return -EINVAL;
5992
5993                 /* Older userspace, or userspace wanting to be compatible with
5994                  * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5995                  * and assoc flags in the mask, but assumes the station will be
5996                  * added as associated anyway since this was the required driver
5997                  * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5998                  * introduced.
5999                  * In order to not bother drivers with this quirk in the API
6000                  * set the flags in both the mask and set for new stations in
6001                  * this case.
6002                  */
6003                 if (!(params.sta_flags_mask & auth_assoc)) {
6004                         params.sta_flags_mask |= auth_assoc;
6005                         params.sta_flags_set |= auth_assoc;
6006                 }
6007
6008                 /* must be last in here for error handling */
6009                 params.vlan = get_vlan(info, rdev);
6010                 if (IS_ERR(params.vlan))
6011                         return PTR_ERR(params.vlan);
6012                 break;
6013         case NL80211_IFTYPE_MESH_POINT:
6014                 /* ignore uAPSD data */
6015                 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
6016
6017                 /* associated is disallowed */
6018                 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
6019                         return -EINVAL;
6020                 /* TDLS peers cannot be added */
6021                 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
6022                     info->attrs[NL80211_ATTR_PEER_AID])
6023                         return -EINVAL;
6024                 break;
6025         case NL80211_IFTYPE_STATION:
6026         case NL80211_IFTYPE_P2P_CLIENT:
6027                 /* ignore uAPSD data */
6028                 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
6029
6030                 /* these are disallowed */
6031                 if (params.sta_flags_mask &
6032                                 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
6033                                  BIT(NL80211_STA_FLAG_AUTHENTICATED)))
6034                         return -EINVAL;
6035                 /* Only TDLS peers can be added */
6036                 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
6037                         return -EINVAL;
6038                 /* Can only add if TDLS ... */
6039                 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
6040                         return -EOPNOTSUPP;
6041                 /* ... with external setup is supported */
6042                 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
6043                         return -EOPNOTSUPP;
6044                 /*
6045                  * Older wpa_supplicant versions always mark the TDLS peer
6046                  * as authorized, but it shouldn't yet be.
6047                  */
6048                 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
6049                 break;
6050         default:
6051                 return -EOPNOTSUPP;
6052         }
6053
6054         /* be aware of params.vlan when changing code here */
6055
6056         err = rdev_add_station(rdev, dev, mac_addr, &params);
6057
6058         if (params.vlan)
6059                 dev_put(params.vlan);
6060         return err;
6061 }
6062
6063 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
6064 {
6065         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6066         struct net_device *dev = info->user_ptr[1];
6067         struct station_del_parameters params;
6068
6069         memset(&params, 0, sizeof(params));
6070
6071         if (info->attrs[NL80211_ATTR_MAC])
6072                 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
6073
6074         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
6075             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
6076             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
6077             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6078                 return -EINVAL;
6079
6080         if (!rdev->ops->del_station)
6081                 return -EOPNOTSUPP;
6082
6083         if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
6084                 params.subtype =
6085                         nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
6086                 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
6087                     params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
6088                         return -EINVAL;
6089         } else {
6090                 /* Default to Deauthentication frame */
6091                 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
6092         }
6093
6094         if (info->attrs[NL80211_ATTR_REASON_CODE]) {
6095                 params.reason_code =
6096                         nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
6097                 if (params.reason_code == 0)
6098                         return -EINVAL; /* 0 is reserved */
6099         } else {
6100                 /* Default to reason code 2 */
6101                 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
6102         }
6103
6104         return rdev_del_station(rdev, dev, &params);
6105 }
6106
6107 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
6108                                 int flags, struct net_device *dev,
6109                                 u8 *dst, u8 *next_hop,
6110                                 struct mpath_info *pinfo)
6111 {
6112         void *hdr;
6113         struct nlattr *pinfoattr;
6114
6115         hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
6116         if (!hdr)
6117                 return -1;
6118
6119         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
6120             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
6121             nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
6122             nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
6123                 goto nla_put_failure;
6124
6125         pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO);
6126         if (!pinfoattr)
6127                 goto nla_put_failure;
6128         if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
6129             nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
6130                         pinfo->frame_qlen))
6131                 goto nla_put_failure;
6132         if (((pinfo->filled & MPATH_INFO_SN) &&
6133              nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
6134             ((pinfo->filled & MPATH_INFO_METRIC) &&
6135              nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
6136                          pinfo->metric)) ||
6137             ((pinfo->filled & MPATH_INFO_EXPTIME) &&
6138              nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
6139                          pinfo->exptime)) ||
6140             ((pinfo->filled & MPATH_INFO_FLAGS) &&
6141              nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
6142                         pinfo->flags)) ||
6143             ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
6144              nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
6145                          pinfo->discovery_timeout)) ||
6146             ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
6147              nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
6148                         pinfo->discovery_retries)) ||
6149             ((pinfo->filled & MPATH_INFO_HOP_COUNT) &&
6150              nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT,
6151                         pinfo->hop_count)) ||
6152             ((pinfo->filled & MPATH_INFO_PATH_CHANGE) &&
6153              nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE,
6154                          pinfo->path_change_count)))
6155                 goto nla_put_failure;
6156
6157         nla_nest_end(msg, pinfoattr);
6158
6159         genlmsg_end(msg, hdr);
6160         return 0;
6161
6162  nla_put_failure:
6163         genlmsg_cancel(msg, hdr);
6164         return -EMSGSIZE;
6165 }
6166
6167 static int nl80211_dump_mpath(struct sk_buff *skb,
6168                               struct netlink_callback *cb)
6169 {
6170         struct mpath_info pinfo;
6171         struct cfg80211_registered_device *rdev;
6172         struct wireless_dev *wdev;
6173         u8 dst[ETH_ALEN];
6174         u8 next_hop[ETH_ALEN];
6175         int path_idx = cb->args[2];
6176         int err;
6177
6178         rtnl_lock();
6179         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
6180         if (err)
6181                 goto out_err;
6182
6183         if (!rdev->ops->dump_mpath) {
6184                 err = -EOPNOTSUPP;
6185                 goto out_err;
6186         }
6187
6188         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
6189                 err = -EOPNOTSUPP;
6190                 goto out_err;
6191         }
6192
6193         while (1) {
6194                 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
6195                                       next_hop, &pinfo);
6196                 if (err == -ENOENT)
6197                         break;
6198                 if (err)
6199                         goto out_err;
6200
6201                 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
6202                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
6203                                        wdev->netdev, dst, next_hop,
6204                                        &pinfo) < 0)
6205                         goto out;
6206
6207                 path_idx++;
6208         }
6209
6210  out:
6211         cb->args[2] = path_idx;
6212         err = skb->len;
6213  out_err:
6214         rtnl_unlock();
6215         return err;
6216 }
6217
6218 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
6219 {
6220         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6221         int err;
6222         struct net_device *dev = info->user_ptr[1];
6223         struct mpath_info pinfo;
6224         struct sk_buff *msg;
6225         u8 *dst = NULL;
6226         u8 next_hop[ETH_ALEN];
6227
6228         memset(&pinfo, 0, sizeof(pinfo));
6229
6230         if (!info->attrs[NL80211_ATTR_MAC])
6231                 return -EINVAL;
6232
6233         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6234
6235         if (!rdev->ops->get_mpath)
6236                 return -EOPNOTSUPP;
6237
6238         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6239                 return -EOPNOTSUPP;
6240
6241         err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
6242         if (err)
6243                 return err;
6244
6245         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6246         if (!msg)
6247                 return -ENOMEM;
6248
6249         if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
6250                                  dev, dst, next_hop, &pinfo) < 0) {
6251                 nlmsg_free(msg);
6252                 return -ENOBUFS;
6253         }
6254
6255         return genlmsg_reply(msg, info);
6256 }
6257
6258 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
6259 {
6260         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6261         struct net_device *dev = info->user_ptr[1];
6262         u8 *dst = NULL;
6263         u8 *next_hop = NULL;
6264
6265         if (!info->attrs[NL80211_ATTR_MAC])
6266                 return -EINVAL;
6267
6268         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
6269                 return -EINVAL;
6270
6271         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6272         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
6273
6274         if (!rdev->ops->change_mpath)
6275                 return -EOPNOTSUPP;
6276
6277         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6278                 return -EOPNOTSUPP;
6279
6280         return rdev_change_mpath(rdev, dev, dst, next_hop);
6281 }
6282
6283 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
6284 {
6285         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6286         struct net_device *dev = info->user_ptr[1];
6287         u8 *dst = NULL;
6288         u8 *next_hop = NULL;
6289
6290         if (!info->attrs[NL80211_ATTR_MAC])
6291                 return -EINVAL;
6292
6293         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
6294                 return -EINVAL;
6295
6296         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6297         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
6298
6299         if (!rdev->ops->add_mpath)
6300                 return -EOPNOTSUPP;
6301
6302         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6303                 return -EOPNOTSUPP;
6304
6305         return rdev_add_mpath(rdev, dev, dst, next_hop);
6306 }
6307
6308 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
6309 {
6310         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6311         struct net_device *dev = info->user_ptr[1];
6312         u8 *dst = NULL;
6313
6314         if (info->attrs[NL80211_ATTR_MAC])
6315                 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6316
6317         if (!rdev->ops->del_mpath)
6318                 return -EOPNOTSUPP;
6319
6320         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6321                 return -EOPNOTSUPP;
6322
6323         return rdev_del_mpath(rdev, dev, dst);
6324 }
6325
6326 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
6327 {
6328         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6329         int err;
6330         struct net_device *dev = info->user_ptr[1];
6331         struct mpath_info pinfo;
6332         struct sk_buff *msg;
6333         u8 *dst = NULL;
6334         u8 mpp[ETH_ALEN];
6335
6336         memset(&pinfo, 0, sizeof(pinfo));
6337
6338         if (!info->attrs[NL80211_ATTR_MAC])
6339                 return -EINVAL;
6340
6341         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6342
6343         if (!rdev->ops->get_mpp)
6344                 return -EOPNOTSUPP;
6345
6346         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6347                 return -EOPNOTSUPP;
6348
6349         err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
6350         if (err)
6351                 return err;
6352
6353         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6354         if (!msg)
6355                 return -ENOMEM;
6356
6357         if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
6358                                dev, dst, mpp, &pinfo) < 0) {
6359                 nlmsg_free(msg);
6360                 return -ENOBUFS;
6361         }
6362
6363         return genlmsg_reply(msg, info);
6364 }
6365
6366 static int nl80211_dump_mpp(struct sk_buff *skb,
6367                             struct netlink_callback *cb)
6368 {
6369         struct mpath_info pinfo;
6370         struct cfg80211_registered_device *rdev;
6371         struct wireless_dev *wdev;
6372         u8 dst[ETH_ALEN];
6373         u8 mpp[ETH_ALEN];
6374         int path_idx = cb->args[2];
6375         int err;
6376
6377         rtnl_lock();
6378         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
6379         if (err)
6380                 goto out_err;
6381
6382         if (!rdev->ops->dump_mpp) {
6383                 err = -EOPNOTSUPP;
6384                 goto out_err;
6385         }
6386
6387         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
6388                 err = -EOPNOTSUPP;
6389                 goto out_err;
6390         }
6391
6392         while (1) {
6393                 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
6394                                     mpp, &pinfo);
6395                 if (err == -ENOENT)
6396                         break;
6397                 if (err)
6398                         goto out_err;
6399
6400                 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
6401                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
6402                                        wdev->netdev, dst, mpp,
6403                                        &pinfo) < 0)
6404                         goto out;
6405
6406                 path_idx++;
6407         }
6408
6409  out:
6410         cb->args[2] = path_idx;
6411         err = skb->len;
6412  out_err:
6413         rtnl_unlock();
6414         return err;
6415 }
6416
6417 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
6418 {
6419         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6420         struct net_device *dev = info->user_ptr[1];
6421         struct wireless_dev *wdev = dev->ieee80211_ptr;
6422         struct bss_parameters params;
6423         int err;
6424
6425         memset(&params, 0, sizeof(params));
6426         /* default to not changing parameters */
6427         params.use_cts_prot = -1;
6428         params.use_short_preamble = -1;
6429         params.use_short_slot_time = -1;
6430         params.ap_isolate = -1;
6431         params.ht_opmode = -1;
6432         params.p2p_ctwindow = -1;
6433         params.p2p_opp_ps = -1;
6434
6435         if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
6436                 params.use_cts_prot =
6437                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
6438         if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
6439                 params.use_short_preamble =
6440                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
6441         if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
6442                 params.use_short_slot_time =
6443                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
6444         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
6445                 params.basic_rates =
6446                         nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
6447                 params.basic_rates_len =
6448                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
6449         }
6450         if (info->attrs[NL80211_ATTR_AP_ISOLATE])
6451                 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
6452         if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
6453                 params.ht_opmode =
6454                         nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
6455
6456         if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
6457                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6458                         return -EINVAL;
6459                 params.p2p_ctwindow =
6460                         nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
6461                 if (params.p2p_ctwindow != 0 &&
6462                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
6463                         return -EINVAL;
6464         }
6465
6466         if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
6467                 u8 tmp;
6468
6469                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6470                         return -EINVAL;
6471                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
6472                 params.p2p_opp_ps = tmp;
6473                 if (params.p2p_opp_ps &&
6474                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
6475                         return -EINVAL;
6476         }
6477
6478         if (!rdev->ops->change_bss)
6479                 return -EOPNOTSUPP;
6480
6481         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
6482             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6483                 return -EOPNOTSUPP;
6484
6485         wdev_lock(wdev);
6486         err = rdev_change_bss(rdev, dev, &params);
6487         wdev_unlock(wdev);
6488
6489         return err;
6490 }
6491
6492 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
6493 {
6494         char *data = NULL;
6495         bool is_indoor;
6496         enum nl80211_user_reg_hint_type user_reg_hint_type;
6497         u32 owner_nlportid;
6498
6499         /*
6500          * You should only get this when cfg80211 hasn't yet initialized
6501          * completely when built-in to the kernel right between the time
6502          * window between nl80211_init() and regulatory_init(), if that is
6503          * even possible.
6504          */
6505         if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
6506                 return -EINPROGRESS;
6507
6508         if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
6509                 user_reg_hint_type =
6510                   nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
6511         else
6512                 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
6513
6514         switch (user_reg_hint_type) {
6515         case NL80211_USER_REG_HINT_USER:
6516         case NL80211_USER_REG_HINT_CELL_BASE:
6517                 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6518                         return -EINVAL;
6519
6520                 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6521                 return regulatory_hint_user(data, user_reg_hint_type);
6522         case NL80211_USER_REG_HINT_INDOOR:
6523                 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
6524                         owner_nlportid = info->snd_portid;
6525                         is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
6526                 } else {
6527                         owner_nlportid = 0;
6528                         is_indoor = true;
6529                 }
6530
6531                 return regulatory_hint_indoor(is_indoor, owner_nlportid);
6532         default:
6533                 return -EINVAL;
6534         }
6535 }
6536
6537 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
6538 {
6539         return reg_reload_regdb();
6540 }
6541
6542 static int nl80211_get_mesh_config(struct sk_buff *skb,
6543                                    struct genl_info *info)
6544 {
6545         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6546         struct net_device *dev = info->user_ptr[1];
6547         struct wireless_dev *wdev = dev->ieee80211_ptr;
6548         struct mesh_config cur_params;
6549         int err = 0;
6550         void *hdr;
6551         struct nlattr *pinfoattr;
6552         struct sk_buff *msg;
6553
6554         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6555                 return -EOPNOTSUPP;
6556
6557         if (!rdev->ops->get_mesh_config)
6558                 return -EOPNOTSUPP;
6559
6560         wdev_lock(wdev);
6561         /* If not connected, get default parameters */
6562         if (!wdev->mesh_id_len)
6563                 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
6564         else
6565                 err = rdev_get_mesh_config(rdev, dev, &cur_params);
6566         wdev_unlock(wdev);
6567
6568         if (err)
6569                 return err;
6570
6571         /* Draw up a netlink message to send back */
6572         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6573         if (!msg)
6574                 return -ENOMEM;
6575         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6576                              NL80211_CMD_GET_MESH_CONFIG);
6577         if (!hdr)
6578                 goto out;
6579         pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG);
6580         if (!pinfoattr)
6581                 goto nla_put_failure;
6582         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
6583             nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
6584                         cur_params.dot11MeshRetryTimeout) ||
6585             nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
6586                         cur_params.dot11MeshConfirmTimeout) ||
6587             nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
6588                         cur_params.dot11MeshHoldingTimeout) ||
6589             nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
6590                         cur_params.dot11MeshMaxPeerLinks) ||
6591             nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
6592                        cur_params.dot11MeshMaxRetries) ||
6593             nla_put_u8(msg, NL80211_MESHCONF_TTL,
6594                        cur_params.dot11MeshTTL) ||
6595             nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
6596                        cur_params.element_ttl) ||
6597             nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6598                        cur_params.auto_open_plinks) ||
6599             nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6600                         cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
6601             nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6602                        cur_params.dot11MeshHWMPmaxPREQretries) ||
6603             nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
6604                         cur_params.path_refresh_time) ||
6605             nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6606                         cur_params.min_discovery_timeout) ||
6607             nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6608                         cur_params.dot11MeshHWMPactivePathTimeout) ||
6609             nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6610                         cur_params.dot11MeshHWMPpreqMinInterval) ||
6611             nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6612                         cur_params.dot11MeshHWMPperrMinInterval) ||
6613             nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6614                         cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
6615             nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
6616                        cur_params.dot11MeshHWMPRootMode) ||
6617             nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6618                         cur_params.dot11MeshHWMPRannInterval) ||
6619             nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6620                        cur_params.dot11MeshGateAnnouncementProtocol) ||
6621             nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
6622                        cur_params.dot11MeshForwarding) ||
6623             nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
6624                         cur_params.rssi_threshold) ||
6625             nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
6626                         cur_params.ht_opmode) ||
6627             nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6628                         cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
6629             nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6630                         cur_params.dot11MeshHWMProotInterval) ||
6631             nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6632                         cur_params.dot11MeshHWMPconfirmationInterval) ||
6633             nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
6634                         cur_params.power_mode) ||
6635             nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
6636                         cur_params.dot11MeshAwakeWindowDuration) ||
6637             nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
6638                         cur_params.plink_timeout) ||
6639             nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE,
6640                        cur_params.dot11MeshConnectedToMeshGate))
6641                 goto nla_put_failure;
6642         nla_nest_end(msg, pinfoattr);
6643         genlmsg_end(msg, hdr);
6644         return genlmsg_reply(msg, info);
6645
6646  nla_put_failure:
6647  out:
6648         nlmsg_free(msg);
6649         return -ENOBUFS;
6650 }
6651
6652 static const struct nla_policy
6653 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
6654         [NL80211_MESHCONF_RETRY_TIMEOUT] =
6655                 NLA_POLICY_RANGE(NLA_U16, 1, 255),
6656         [NL80211_MESHCONF_CONFIRM_TIMEOUT] =
6657                 NLA_POLICY_RANGE(NLA_U16, 1, 255),
6658         [NL80211_MESHCONF_HOLDING_TIMEOUT] =
6659                 NLA_POLICY_RANGE(NLA_U16, 1, 255),
6660         [NL80211_MESHCONF_MAX_PEER_LINKS] =
6661                 NLA_POLICY_RANGE(NLA_U16, 0, 255),
6662         [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16),
6663         [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
6664         [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
6665         [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1),
6666         [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] =
6667                 NLA_POLICY_RANGE(NLA_U32, 1, 255),
6668         [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
6669         [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
6670         [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1),
6671         [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
6672         [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] =
6673                 NLA_POLICY_MIN(NLA_U16, 1),
6674         [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] =
6675                 NLA_POLICY_MIN(NLA_U16, 1),
6676         [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] =
6677                 NLA_POLICY_MIN(NLA_U16, 1),
6678         [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4),
6679         [NL80211_MESHCONF_HWMP_RANN_INTERVAL] =
6680                 NLA_POLICY_MIN(NLA_U16, 1),
6681         [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1),
6682         [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1),
6683         [NL80211_MESHCONF_RSSI_THRESHOLD] =
6684                 NLA_POLICY_RANGE(NLA_S32, -255, 0),
6685         [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
6686         [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
6687         [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] =
6688                 NLA_POLICY_MIN(NLA_U16, 1),
6689         [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] =
6690                 NLA_POLICY_MIN(NLA_U16, 1),
6691         [NL80211_MESHCONF_POWER_MODE] =
6692                 NLA_POLICY_RANGE(NLA_U32,
6693                                  NL80211_MESH_POWER_ACTIVE,
6694                                  NL80211_MESH_POWER_MAX),
6695         [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
6696         [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
6697         [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
6698 };
6699
6700 static const struct nla_policy
6701         nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
6702         [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
6703         [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
6704         [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
6705         [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
6706         [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
6707         [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
6708         [NL80211_MESH_SETUP_IE] =
6709                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
6710                                        IEEE80211_MAX_DATA_LEN),
6711         [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
6712 };
6713
6714 static int nl80211_parse_mesh_config(struct genl_info *info,
6715                                      struct mesh_config *cfg,
6716                                      u32 *mask_out)
6717 {
6718         struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
6719         u32 mask = 0;
6720         u16 ht_opmode;
6721
6722 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn)       \
6723 do {                                                                    \
6724         if (tb[attr]) {                                                 \
6725                 cfg->param = fn(tb[attr]);                              \
6726                 mask |= BIT((attr) - 1);                                \
6727         }                                                               \
6728 } while (0)
6729
6730         if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
6731                 return -EINVAL;
6732         if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack))
6733                 return -EINVAL;
6734
6735         /* This makes sure that there aren't more than 32 mesh config
6736          * parameters (otherwise our bitfield scheme would not work.) */
6737         BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
6738
6739         /* Fill in the params struct */
6740         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask,
6741                                   NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
6742         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask,
6743                                   NL80211_MESHCONF_CONFIRM_TIMEOUT,
6744                                   nla_get_u16);
6745         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask,
6746                                   NL80211_MESHCONF_HOLDING_TIMEOUT,
6747                                   nla_get_u16);
6748         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask,
6749                                   NL80211_MESHCONF_MAX_PEER_LINKS,
6750                                   nla_get_u16);
6751         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask,
6752                                   NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
6753         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask,
6754                                   NL80211_MESHCONF_TTL, nla_get_u8);
6755         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask,
6756                                   NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8);
6757         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask,
6758                                   NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6759                                   nla_get_u8);
6760         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
6761                                   mask,
6762                                   NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6763                                   nla_get_u32);
6764         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask,
6765                                   NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6766                                   nla_get_u8);
6767         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask,
6768                                   NL80211_MESHCONF_PATH_REFRESH_TIME,
6769                                   nla_get_u32);
6770         if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) &&
6771             (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535))
6772                 return -EINVAL;
6773         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask,
6774                                   NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6775                                   nla_get_u16);
6776         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
6777                                   mask,
6778                                   NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6779                                   nla_get_u32);
6780         if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) &&
6781             (cfg->dot11MeshHWMPactivePathTimeout < 1 ||
6782              cfg->dot11MeshHWMPactivePathTimeout > 65535))
6783                 return -EINVAL;
6784         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask,
6785                                   NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6786                                   nla_get_u16);
6787         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask,
6788                                   NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6789                                   nla_get_u16);
6790         FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6791                                   dot11MeshHWMPnetDiameterTraversalTime, mask,
6792                                   NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6793                                   nla_get_u16);
6794         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask,
6795                                   NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8);
6796         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask,
6797                                   NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6798                                   nla_get_u16);
6799         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol,
6800                                   mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6801                                   nla_get_u8);
6802         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask,
6803                                   NL80211_MESHCONF_FORWARDING, nla_get_u8);
6804         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask,
6805                                   NL80211_MESHCONF_RSSI_THRESHOLD,
6806                                   nla_get_s32);
6807         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask,
6808                                   NL80211_MESHCONF_CONNECTED_TO_GATE,
6809                                   nla_get_u8);
6810         /*
6811          * Check HT operation mode based on
6812          * IEEE 802.11-2016 9.4.2.57 HT Operation element.
6813          */
6814         if (tb[NL80211_MESHCONF_HT_OPMODE]) {
6815                 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
6816
6817                 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
6818                                   IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
6819                                   IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6820                         return -EINVAL;
6821
6822                 /* NON_HT_STA bit is reserved, but some programs set it */
6823                 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
6824
6825                 cfg->ht_opmode = ht_opmode;
6826                 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
6827         }
6828         FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6829                                   dot11MeshHWMPactivePathToRootTimeout, mask,
6830                                   NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6831                                   nla_get_u32);
6832         if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) &&
6833             (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 ||
6834              cfg->dot11MeshHWMPactivePathToRootTimeout > 65535))
6835                 return -EINVAL;
6836         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask,
6837                                   NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6838                                   nla_get_u16);
6839         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval,
6840                                   mask,
6841                                   NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6842                                   nla_get_u16);
6843         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask,
6844                                   NL80211_MESHCONF_POWER_MODE, nla_get_u32);
6845         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask,
6846                                   NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
6847         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask,
6848                                   NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32);
6849         if (mask_out)
6850                 *mask_out = mask;
6851
6852         return 0;
6853
6854 #undef FILL_IN_MESH_PARAM_IF_SET
6855 }
6856
6857 static int nl80211_parse_mesh_setup(struct genl_info *info,
6858                                      struct mesh_setup *setup)
6859 {
6860         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6861         struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
6862
6863         if (!info->attrs[NL80211_ATTR_MESH_SETUP])
6864                 return -EINVAL;
6865         if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack))
6866                 return -EINVAL;
6867
6868         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
6869                 setup->sync_method =
6870                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
6871                  IEEE80211_SYNC_METHOD_VENDOR :
6872                  IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
6873
6874         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
6875                 setup->path_sel_proto =
6876                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
6877                  IEEE80211_PATH_PROTOCOL_VENDOR :
6878                  IEEE80211_PATH_PROTOCOL_HWMP;
6879
6880         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
6881                 setup->path_metric =
6882                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
6883                  IEEE80211_PATH_METRIC_VENDOR :
6884                  IEEE80211_PATH_METRIC_AIRTIME;
6885
6886         if (tb[NL80211_MESH_SETUP_IE]) {
6887                 struct nlattr *ieattr =
6888                         tb[NL80211_MESH_SETUP_IE];
6889                 setup->ie = nla_data(ieattr);
6890                 setup->ie_len = nla_len(ieattr);
6891         }
6892         if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
6893             !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
6894                 return -EINVAL;
6895         setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
6896         setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
6897         setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
6898         if (setup->is_secure)
6899                 setup->user_mpm = true;
6900
6901         if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
6902                 if (!setup->user_mpm)
6903                         return -EINVAL;
6904                 setup->auth_id =
6905                         nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
6906         }
6907
6908         return 0;
6909 }
6910
6911 static int nl80211_update_mesh_config(struct sk_buff *skb,
6912                                       struct genl_info *info)
6913 {
6914         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6915         struct net_device *dev = info->user_ptr[1];
6916         struct wireless_dev *wdev = dev->ieee80211_ptr;
6917         struct mesh_config cfg;
6918         u32 mask;
6919         int err;
6920
6921         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6922                 return -EOPNOTSUPP;
6923
6924         if (!rdev->ops->update_mesh_config)
6925                 return -EOPNOTSUPP;
6926
6927         err = nl80211_parse_mesh_config(info, &cfg, &mask);
6928         if (err)
6929                 return err;
6930
6931         wdev_lock(wdev);
6932         if (!wdev->mesh_id_len)
6933                 err = -ENOLINK;
6934
6935         if (!err)
6936                 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
6937
6938         wdev_unlock(wdev);
6939
6940         return err;
6941 }
6942
6943 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
6944                               struct sk_buff *msg)
6945 {
6946         struct nlattr *nl_reg_rules;
6947         unsigned int i;
6948
6949         if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6950             (regdom->dfs_region &&
6951              nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
6952                 goto nla_put_failure;
6953
6954         nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES);
6955         if (!nl_reg_rules)
6956                 goto nla_put_failure;
6957
6958         for (i = 0; i < regdom->n_reg_rules; i++) {
6959                 struct nlattr *nl_reg_rule;
6960                 const struct ieee80211_reg_rule *reg_rule;
6961                 const struct ieee80211_freq_range *freq_range;
6962                 const struct ieee80211_power_rule *power_rule;
6963                 unsigned int max_bandwidth_khz;
6964
6965                 reg_rule = &regdom->reg_rules[i];
6966                 freq_range = &reg_rule->freq_range;
6967                 power_rule = &reg_rule->power_rule;
6968
6969                 nl_reg_rule = nla_nest_start_noflag(msg, i);
6970                 if (!nl_reg_rule)
6971                         goto nla_put_failure;
6972
6973                 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6974                 if (!max_bandwidth_khz)
6975                         max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6976                                                                   reg_rule);
6977
6978                 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6979                                 reg_rule->flags) ||
6980                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6981                                 freq_range->start_freq_khz) ||
6982                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6983                                 freq_range->end_freq_khz) ||
6984                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
6985                                 max_bandwidth_khz) ||
6986                     nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6987                                 power_rule->max_antenna_gain) ||
6988                     nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
6989                                 power_rule->max_eirp) ||
6990                     nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6991                                 reg_rule->dfs_cac_ms))
6992                         goto nla_put_failure;
6993
6994                 nla_nest_end(msg, nl_reg_rule);
6995         }
6996
6997         nla_nest_end(msg, nl_reg_rules);
6998         return 0;
6999
7000 nla_put_failure:
7001         return -EMSGSIZE;
7002 }
7003
7004 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
7005 {
7006         const struct ieee80211_regdomain *regdom = NULL;
7007         struct cfg80211_registered_device *rdev;
7008         struct wiphy *wiphy = NULL;
7009         struct sk_buff *msg;
7010         void *hdr;
7011
7012         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
7013         if (!msg)
7014                 return -ENOBUFS;
7015
7016         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
7017                              NL80211_CMD_GET_REG);
7018         if (!hdr)
7019                 goto put_failure;
7020
7021         if (info->attrs[NL80211_ATTR_WIPHY]) {
7022                 bool self_managed;
7023
7024                 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
7025                 if (IS_ERR(rdev)) {
7026                         nlmsg_free(msg);
7027                         return PTR_ERR(rdev);
7028                 }
7029
7030                 wiphy = &rdev->wiphy;
7031                 self_managed = wiphy->regulatory_flags &
7032                                REGULATORY_WIPHY_SELF_MANAGED;
7033                 regdom = get_wiphy_regdom(wiphy);
7034
7035                 /* a self-managed-reg device must have a private regdom */
7036                 if (WARN_ON(!regdom && self_managed)) {
7037                         nlmsg_free(msg);
7038                         return -EINVAL;
7039                 }
7040
7041                 if (regdom &&
7042                     nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
7043                         goto nla_put_failure;
7044         }
7045
7046         if (!wiphy && reg_last_request_cell_base() &&
7047             nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
7048                         NL80211_USER_REG_HINT_CELL_BASE))
7049                 goto nla_put_failure;
7050
7051         rcu_read_lock();
7052
7053         if (!regdom)
7054                 regdom = rcu_dereference(cfg80211_regdomain);
7055
7056         if (nl80211_put_regdom(regdom, msg))
7057                 goto nla_put_failure_rcu;
7058
7059         rcu_read_unlock();
7060
7061         genlmsg_end(msg, hdr);
7062         return genlmsg_reply(msg, info);
7063
7064 nla_put_failure_rcu:
7065         rcu_read_unlock();
7066 nla_put_failure:
7067 put_failure:
7068         nlmsg_free(msg);
7069         return -EMSGSIZE;
7070 }
7071
7072 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
7073                                u32 seq, int flags, struct wiphy *wiphy,
7074                                const struct ieee80211_regdomain *regdom)
7075 {
7076         void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
7077                                    NL80211_CMD_GET_REG);
7078
7079         if (!hdr)
7080                 return -1;
7081
7082         genl_dump_check_consistent(cb, hdr);
7083
7084         if (nl80211_put_regdom(regdom, msg))
7085                 goto nla_put_failure;
7086
7087         if (!wiphy && reg_last_request_cell_base() &&
7088             nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
7089                         NL80211_USER_REG_HINT_CELL_BASE))
7090                 goto nla_put_failure;
7091
7092         if (wiphy &&
7093             nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
7094                 goto nla_put_failure;
7095
7096         if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
7097             nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
7098                 goto nla_put_failure;
7099
7100         genlmsg_end(msg, hdr);
7101         return 0;
7102
7103 nla_put_failure:
7104         genlmsg_cancel(msg, hdr);
7105         return -EMSGSIZE;
7106 }
7107
7108 static int nl80211_get_reg_dump(struct sk_buff *skb,
7109                                 struct netlink_callback *cb)
7110 {
7111         const struct ieee80211_regdomain *regdom = NULL;
7112         struct cfg80211_registered_device *rdev;
7113         int err, reg_idx, start = cb->args[2];
7114
7115         rtnl_lock();
7116
7117         if (cfg80211_regdomain && start == 0) {
7118                 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
7119                                           NLM_F_MULTI, NULL,
7120                                           rtnl_dereference(cfg80211_regdomain));
7121                 if (err < 0)
7122                         goto out_err;
7123         }
7124
7125         /* the global regdom is idx 0 */
7126         reg_idx = 1;
7127         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
7128                 regdom = get_wiphy_regdom(&rdev->wiphy);
7129                 if (!regdom)
7130                         continue;
7131
7132                 if (++reg_idx <= start)
7133                         continue;
7134
7135                 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
7136                                           NLM_F_MULTI, &rdev->wiphy, regdom);
7137                 if (err < 0) {
7138                         reg_idx--;
7139                         break;
7140                 }
7141         }
7142
7143         cb->args[2] = reg_idx;
7144         err = skb->len;
7145 out_err:
7146         rtnl_unlock();
7147         return err;
7148 }
7149
7150 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
7151 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
7152         [NL80211_ATTR_REG_RULE_FLAGS]           = { .type = NLA_U32 },
7153         [NL80211_ATTR_FREQ_RANGE_START]         = { .type = NLA_U32 },
7154         [NL80211_ATTR_FREQ_RANGE_END]           = { .type = NLA_U32 },
7155         [NL80211_ATTR_FREQ_RANGE_MAX_BW]        = { .type = NLA_U32 },
7156         [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]  = { .type = NLA_U32 },
7157         [NL80211_ATTR_POWER_RULE_MAX_EIRP]      = { .type = NLA_U32 },
7158         [NL80211_ATTR_DFS_CAC_TIME]             = { .type = NLA_U32 },
7159 };
7160
7161 static int parse_reg_rule(struct nlattr *tb[],
7162         struct ieee80211_reg_rule *reg_rule)
7163 {
7164         struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
7165         struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
7166
7167         if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
7168                 return -EINVAL;
7169         if (!tb[NL80211_ATTR_FREQ_RANGE_START])
7170                 return -EINVAL;
7171         if (!tb[NL80211_ATTR_FREQ_RANGE_END])
7172                 return -EINVAL;
7173         if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
7174                 return -EINVAL;
7175         if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
7176                 return -EINVAL;
7177
7178         reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
7179
7180         freq_range->start_freq_khz =
7181                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
7182         freq_range->end_freq_khz =
7183                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
7184         freq_range->max_bandwidth_khz =
7185                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
7186
7187         power_rule->max_eirp =
7188                 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
7189
7190         if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
7191                 power_rule->max_antenna_gain =
7192                         nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
7193
7194         if (tb[NL80211_ATTR_DFS_CAC_TIME])
7195                 reg_rule->dfs_cac_ms =
7196                         nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
7197
7198         return 0;
7199 }
7200
7201 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
7202 {
7203         struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
7204         struct nlattr *nl_reg_rule;
7205         char *alpha2;
7206         int rem_reg_rules, r;
7207         u32 num_rules = 0, rule_idx = 0;
7208         enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
7209         struct ieee80211_regdomain *rd;
7210
7211         if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
7212                 return -EINVAL;
7213
7214         if (!info->attrs[NL80211_ATTR_REG_RULES])
7215                 return -EINVAL;
7216
7217         alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
7218
7219         if (info->attrs[NL80211_ATTR_DFS_REGION])
7220                 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
7221
7222         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
7223                             rem_reg_rules) {
7224                 num_rules++;
7225                 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
7226                         return -EINVAL;
7227         }
7228
7229         if (!reg_is_valid_request(alpha2))
7230                 return -EINVAL;
7231
7232         rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL);
7233         if (!rd)
7234                 return -ENOMEM;
7235
7236         rd->n_reg_rules = num_rules;
7237         rd->alpha2[0] = alpha2[0];
7238         rd->alpha2[1] = alpha2[1];
7239
7240         /*
7241          * Disable DFS master mode if the DFS region was
7242          * not supported or known on this kernel.
7243          */
7244         if (reg_supported_dfs_region(dfs_region))
7245                 rd->dfs_region = dfs_region;
7246
7247         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
7248                             rem_reg_rules) {
7249                 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX,
7250                                                 nl_reg_rule, reg_rule_policy,
7251                                                 info->extack);
7252                 if (r)
7253                         goto bad_reg;
7254                 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
7255                 if (r)
7256                         goto bad_reg;
7257
7258                 rule_idx++;
7259
7260                 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
7261                         r = -EINVAL;
7262                         goto bad_reg;
7263                 }
7264         }
7265
7266         /* set_regdom takes ownership of rd */
7267         return set_regdom(rd, REGD_SOURCE_CRDA);
7268  bad_reg:
7269         kfree(rd);
7270         return r;
7271 }
7272 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
7273
7274 static int validate_scan_freqs(struct nlattr *freqs)
7275 {
7276         struct nlattr *attr1, *attr2;
7277         int n_channels = 0, tmp1, tmp2;
7278
7279         nla_for_each_nested(attr1, freqs, tmp1)
7280                 if (nla_len(attr1) != sizeof(u32))
7281                         return 0;
7282
7283         nla_for_each_nested(attr1, freqs, tmp1) {
7284                 n_channels++;
7285                 /*
7286                  * Some hardware has a limited channel list for
7287                  * scanning, and it is pretty much nonsensical
7288                  * to scan for a channel twice, so disallow that
7289                  * and don't require drivers to check that the
7290                  * channel list they get isn't longer than what
7291                  * they can scan, as long as they can scan all
7292                  * the channels they registered at once.
7293                  */
7294                 nla_for_each_nested(attr2, freqs, tmp2)
7295                         if (attr1 != attr2 &&
7296                             nla_get_u32(attr1) == nla_get_u32(attr2))
7297                                 return 0;
7298         }
7299
7300         return n_channels;
7301 }
7302
7303 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
7304 {
7305         return b < NUM_NL80211_BANDS && wiphy->bands[b];
7306 }
7307
7308 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
7309                             struct cfg80211_bss_selection *bss_select)
7310 {
7311         struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
7312         struct nlattr *nest;
7313         int err;
7314         bool found = false;
7315         int i;
7316
7317         /* only process one nested attribute */
7318         nest = nla_data(nla);
7319         if (!nla_ok(nest, nla_len(nest)))
7320                 return -EINVAL;
7321
7322         err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX,
7323                                           nest, nl80211_bss_select_policy,
7324                                           NULL);
7325         if (err)
7326                 return err;
7327
7328         /* only one attribute may be given */
7329         for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
7330                 if (attr[i]) {
7331                         if (found)
7332                                 return -EINVAL;
7333                         found = true;
7334                 }
7335         }
7336
7337         bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
7338
7339         if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
7340                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
7341
7342         if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
7343                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
7344                 bss_select->param.band_pref =
7345                         nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
7346                 if (!is_band_valid(wiphy, bss_select->param.band_pref))
7347                         return -EINVAL;
7348         }
7349
7350         if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
7351                 struct nl80211_bss_select_rssi_adjust *adj_param;
7352
7353                 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
7354                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
7355                 bss_select->param.adjust.band = adj_param->band;
7356                 bss_select->param.adjust.delta = adj_param->delta;
7357                 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
7358                         return -EINVAL;
7359         }
7360
7361         /* user-space did not provide behaviour attribute */
7362         if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
7363                 return -EINVAL;
7364
7365         if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
7366                 return -EINVAL;
7367
7368         return 0;
7369 }
7370
7371 int nl80211_parse_random_mac(struct nlattr **attrs,
7372                              u8 *mac_addr, u8 *mac_addr_mask)
7373 {
7374         int i;
7375
7376         if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
7377                 eth_zero_addr(mac_addr);
7378                 eth_zero_addr(mac_addr_mask);
7379                 mac_addr[0] = 0x2;
7380                 mac_addr_mask[0] = 0x3;
7381
7382                 return 0;
7383         }
7384
7385         /* need both or none */
7386         if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
7387                 return -EINVAL;
7388
7389         memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
7390         memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
7391
7392         /* don't allow or configure an mcast address */
7393         if (!is_multicast_ether_addr(mac_addr_mask) ||
7394             is_multicast_ether_addr(mac_addr))
7395                 return -EINVAL;
7396
7397         /*
7398          * allow users to pass a MAC address that has bits set outside
7399          * of the mask, but don't bother drivers with having to deal
7400          * with such bits
7401          */
7402         for (i = 0; i < ETH_ALEN; i++)
7403                 mac_addr[i] &= mac_addr_mask[i];
7404
7405         return 0;
7406 }
7407
7408 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
7409 {
7410         ASSERT_WDEV_LOCK(wdev);
7411
7412         if (!cfg80211_beaconing_iface_active(wdev))
7413                 return true;
7414
7415         if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
7416                 return true;
7417
7418         return regulatory_pre_cac_allowed(wdev->wiphy);
7419 }
7420
7421 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag,
7422                                     enum nl80211_ext_feature_index feat)
7423 {
7424         if (!(flags & flag))
7425                 return true;
7426         if (wiphy_ext_feature_isset(wiphy, feat))
7427                 return true;
7428         return false;
7429 }
7430
7431 static int
7432 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
7433                          void *request, struct nlattr **attrs,
7434                          bool is_sched_scan)
7435 {
7436         u8 *mac_addr, *mac_addr_mask;
7437         u32 *flags;
7438         enum nl80211_feature_flags randomness_flag;
7439
7440         if (!attrs[NL80211_ATTR_SCAN_FLAGS])
7441                 return 0;
7442
7443         if (is_sched_scan) {
7444                 struct cfg80211_sched_scan_request *req = request;
7445
7446                 randomness_flag = wdev ?
7447                                   NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
7448                                   NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
7449                 flags = &req->flags;
7450                 mac_addr = req->mac_addr;
7451                 mac_addr_mask = req->mac_addr_mask;
7452         } else {
7453                 struct cfg80211_scan_request *req = request;
7454
7455                 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
7456                 flags = &req->flags;
7457                 mac_addr = req->mac_addr;
7458                 mac_addr_mask = req->mac_addr_mask;
7459         }
7460
7461         *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
7462
7463         if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
7464              !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
7465             !nl80211_check_scan_feat(wiphy, *flags,
7466                                      NL80211_SCAN_FLAG_LOW_SPAN,
7467                                      NL80211_EXT_FEATURE_LOW_SPAN_SCAN) ||
7468             !nl80211_check_scan_feat(wiphy, *flags,
7469                                      NL80211_SCAN_FLAG_LOW_POWER,
7470                                      NL80211_EXT_FEATURE_LOW_POWER_SCAN) ||
7471             !nl80211_check_scan_feat(wiphy, *flags,
7472                                      NL80211_SCAN_FLAG_HIGH_ACCURACY,
7473                                      NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) ||
7474             !nl80211_check_scan_feat(wiphy, *flags,
7475                                      NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME,
7476                                      NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) ||
7477             !nl80211_check_scan_feat(wiphy, *flags,
7478                                      NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP,
7479                                      NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) ||
7480             !nl80211_check_scan_feat(wiphy, *flags,
7481                                      NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION,
7482                                      NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) ||
7483             !nl80211_check_scan_feat(wiphy, *flags,
7484                                      NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE,
7485                                      NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) ||
7486             !nl80211_check_scan_feat(wiphy, *flags,
7487                                      NL80211_SCAN_FLAG_RANDOM_SN,
7488                                      NL80211_EXT_FEATURE_SCAN_RANDOM_SN) ||
7489             !nl80211_check_scan_feat(wiphy, *flags,
7490                                      NL80211_SCAN_FLAG_MIN_PREQ_CONTENT,
7491                                      NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT))
7492                 return -EOPNOTSUPP;
7493
7494         if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
7495                 int err;
7496
7497                 if (!(wiphy->features & randomness_flag) ||
7498                     (wdev && wdev->current_bss))
7499                         return -EOPNOTSUPP;
7500
7501                 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
7502                 if (err)
7503                         return err;
7504         }
7505
7506         return 0;
7507 }
7508
7509 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
7510 {
7511         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7512         struct wireless_dev *wdev = info->user_ptr[1];
7513         struct cfg80211_scan_request *request;
7514         struct nlattr *attr;
7515         struct wiphy *wiphy;
7516         int err, tmp, n_ssids = 0, n_channels, i;
7517         size_t ie_len;
7518
7519         wiphy = &rdev->wiphy;
7520
7521         if (wdev->iftype == NL80211_IFTYPE_NAN)
7522                 return -EOPNOTSUPP;
7523
7524         if (!rdev->ops->scan)
7525                 return -EOPNOTSUPP;
7526
7527         if (rdev->scan_req || rdev->scan_msg) {
7528                 err = -EBUSY;
7529                 goto unlock;
7530         }
7531
7532         if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7533                 n_channels = validate_scan_freqs(
7534                                 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7535                 if (!n_channels) {
7536                         err = -EINVAL;
7537                         goto unlock;
7538                 }
7539         } else {
7540                 n_channels = ieee80211_get_num_supported_channels(wiphy);
7541         }
7542
7543         if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
7544                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
7545                         n_ssids++;
7546
7547         if (n_ssids > wiphy->max_scan_ssids) {
7548                 err = -EINVAL;
7549                 goto unlock;
7550         }
7551
7552         if (info->attrs[NL80211_ATTR_IE])
7553                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7554         else
7555                 ie_len = 0;
7556
7557         if (ie_len > wiphy->max_scan_ie_len) {
7558                 err = -EINVAL;
7559                 goto unlock;
7560         }
7561
7562         request = kzalloc(sizeof(*request)
7563                         + sizeof(*request->ssids) * n_ssids
7564                         + sizeof(*request->channels) * n_channels
7565                         + ie_len, GFP_KERNEL);
7566         if (!request) {
7567                 err = -ENOMEM;
7568                 goto unlock;
7569         }
7570
7571         if (n_ssids)
7572                 request->ssids = (void *)&request->channels[n_channels];
7573         request->n_ssids = n_ssids;
7574         if (ie_len) {
7575                 if (n_ssids)
7576                         request->ie = (void *)(request->ssids + n_ssids);
7577                 else
7578                         request->ie = (void *)(request->channels + n_channels);
7579         }
7580
7581         i = 0;
7582         if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7583                 /* user specified, bail out if channel not found */
7584                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
7585                         struct ieee80211_channel *chan;
7586
7587                         chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7588
7589                         if (!chan) {
7590                                 err = -EINVAL;
7591                                 goto out_free;
7592                         }
7593
7594                         /* ignore disabled channels */
7595                         if (chan->flags & IEEE80211_CHAN_DISABLED)
7596                                 continue;
7597
7598                         request->channels[i] = chan;
7599                         i++;
7600                 }
7601         } else {
7602                 enum nl80211_band band;
7603
7604                 /* all channels */
7605                 for (band = 0; band < NUM_NL80211_BANDS; band++) {
7606                         int j;
7607
7608                         if (!wiphy->bands[band])
7609                                 continue;
7610                         for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7611                                 struct ieee80211_channel *chan;
7612
7613                                 chan = &wiphy->bands[band]->channels[j];
7614
7615                                 if (chan->flags & IEEE80211_CHAN_DISABLED)
7616                                         continue;
7617
7618                                 request->channels[i] = chan;
7619                                 i++;
7620                         }
7621                 }
7622         }
7623
7624         if (!i) {
7625                 err = -EINVAL;
7626                 goto out_free;
7627         }
7628
7629         request->n_channels = i;
7630
7631         wdev_lock(wdev);
7632         if (!cfg80211_off_channel_oper_allowed(wdev)) {
7633                 struct ieee80211_channel *chan;
7634
7635                 if (request->n_channels != 1) {
7636                         wdev_unlock(wdev);
7637                         err = -EBUSY;
7638                         goto out_free;
7639                 }
7640
7641                 chan = request->channels[0];
7642                 if (chan->center_freq != wdev->chandef.chan->center_freq) {
7643                         wdev_unlock(wdev);
7644                         err = -EBUSY;
7645                         goto out_free;
7646                 }
7647         }
7648         wdev_unlock(wdev);
7649
7650         i = 0;
7651         if (n_ssids) {
7652                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
7653                         if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7654                                 err = -EINVAL;
7655                                 goto out_free;
7656                         }
7657                         request->ssids[i].ssid_len = nla_len(attr);
7658                         memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
7659                         i++;
7660                 }
7661         }
7662
7663         if (info->attrs[NL80211_ATTR_IE]) {
7664                 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7665                 memcpy((void *)request->ie,
7666                        nla_data(info->attrs[NL80211_ATTR_IE]),
7667                        request->ie_len);
7668         }
7669
7670         for (i = 0; i < NUM_NL80211_BANDS; i++)
7671                 if (wiphy->bands[i])
7672                         request->rates[i] =
7673                                 (1 << wiphy->bands[i]->n_bitrates) - 1;
7674
7675         if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
7676                 nla_for_each_nested(attr,
7677                                     info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
7678                                     tmp) {
7679                         enum nl80211_band band = nla_type(attr);
7680
7681                         if (band < 0 || band >= NUM_NL80211_BANDS) {
7682                                 err = -EINVAL;
7683                                 goto out_free;
7684                         }
7685
7686                         if (!wiphy->bands[band])
7687                                 continue;
7688
7689                         err = ieee80211_get_ratemask(wiphy->bands[band],
7690                                                      nla_data(attr),
7691                                                      nla_len(attr),
7692                                                      &request->rates[band]);
7693                         if (err)
7694                                 goto out_free;
7695                 }
7696         }
7697
7698         if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
7699                 if (!wiphy_ext_feature_isset(wiphy,
7700                                         NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
7701                         err = -EOPNOTSUPP;
7702                         goto out_free;
7703                 }
7704
7705                 request->duration =
7706                         nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
7707                 request->duration_mandatory =
7708                         nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
7709         }
7710
7711         err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
7712                                        false);
7713         if (err)
7714                 goto out_free;
7715
7716         request->no_cck =
7717                 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
7718
7719         /* Initial implementation used NL80211_ATTR_MAC to set the specific
7720          * BSSID to scan for. This was problematic because that same attribute
7721          * was already used for another purpose (local random MAC address). The
7722          * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
7723          * compatibility with older userspace components, also use the
7724          * NL80211_ATTR_MAC value here if it can be determined to be used for
7725          * the specific BSSID use case instead of the random MAC address
7726          * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
7727          */
7728         if (info->attrs[NL80211_ATTR_BSSID])
7729                 memcpy(request->bssid,
7730                        nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
7731         else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
7732                  info->attrs[NL80211_ATTR_MAC])
7733                 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
7734                        ETH_ALEN);
7735         else
7736                 eth_broadcast_addr(request->bssid);
7737
7738         request->wdev = wdev;
7739         request->wiphy = &rdev->wiphy;
7740         request->scan_start = jiffies;
7741
7742         rdev->scan_req = request;
7743         err = rdev_scan(rdev, request);
7744
7745         if (!err) {
7746                 nl80211_send_scan_start(rdev, wdev);
7747                 if (wdev->netdev)
7748                         dev_hold(wdev->netdev);
7749         } else {
7750  out_free:
7751                 rdev->scan_req = NULL;
7752                 kfree(request);
7753         }
7754
7755  unlock:
7756         return err;
7757 }
7758
7759 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
7760 {
7761         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7762         struct wireless_dev *wdev = info->user_ptr[1];
7763
7764         if (!rdev->ops->abort_scan)
7765                 return -EOPNOTSUPP;
7766
7767         if (rdev->scan_msg)
7768                 return 0;
7769
7770         if (!rdev->scan_req)
7771                 return -ENOENT;
7772
7773         rdev_abort_scan(rdev, wdev);
7774         return 0;
7775 }
7776
7777 static int
7778 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
7779                                struct cfg80211_sched_scan_request *request,
7780                                struct nlattr **attrs)
7781 {
7782         int tmp, err, i = 0;
7783         struct nlattr *attr;
7784
7785         if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7786                 u32 interval;
7787
7788                 /*
7789                  * If scan plans are not specified,
7790                  * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
7791                  * case one scan plan will be set with the specified scan
7792                  * interval and infinite number of iterations.
7793                  */
7794                 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
7795                 if (!interval)
7796                         return -EINVAL;
7797
7798                 request->scan_plans[0].interval =
7799                         DIV_ROUND_UP(interval, MSEC_PER_SEC);
7800                 if (!request->scan_plans[0].interval)
7801                         return -EINVAL;
7802
7803                 if (request->scan_plans[0].interval >
7804                     wiphy->max_sched_scan_plan_interval)
7805                         request->scan_plans[0].interval =
7806                                 wiphy->max_sched_scan_plan_interval;
7807
7808                 return 0;
7809         }
7810
7811         nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
7812                 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
7813
7814                 if (WARN_ON(i >= n_plans))
7815                         return -EINVAL;
7816
7817                 err = nla_parse_nested_deprecated(plan,
7818                                                   NL80211_SCHED_SCAN_PLAN_MAX,
7819                                                   attr, nl80211_plan_policy,
7820                                                   NULL);
7821                 if (err)
7822                         return err;
7823
7824                 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
7825                         return -EINVAL;
7826
7827                 request->scan_plans[i].interval =
7828                         nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
7829                 if (!request->scan_plans[i].interval ||
7830                     request->scan_plans[i].interval >
7831                     wiphy->max_sched_scan_plan_interval)
7832                         return -EINVAL;
7833
7834                 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
7835                         request->scan_plans[i].iterations =
7836                                 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
7837                         if (!request->scan_plans[i].iterations ||
7838                             (request->scan_plans[i].iterations >
7839                              wiphy->max_sched_scan_plan_iterations))
7840                                 return -EINVAL;
7841                 } else if (i < n_plans - 1) {
7842                         /*
7843                          * All scan plans but the last one must specify
7844                          * a finite number of iterations
7845                          */
7846                         return -EINVAL;
7847                 }
7848
7849                 i++;
7850         }
7851
7852         /*
7853          * The last scan plan must not specify the number of
7854          * iterations, it is supposed to run infinitely
7855          */
7856         if (request->scan_plans[n_plans - 1].iterations)
7857                 return  -EINVAL;
7858
7859         return 0;
7860 }
7861
7862 static int
7863 nl80211_parse_sched_scan_per_band_rssi(struct wiphy *wiphy,
7864                                        struct cfg80211_match_set *match_sets,
7865                                        struct nlattr *tb_band_rssi,
7866                                        s32 rssi_thold)
7867 {
7868         struct nlattr *attr;
7869         int i, tmp, ret = 0;
7870
7871         if (!wiphy_ext_feature_isset(wiphy,
7872                     NL80211_EXT_FEATURE_SCHED_SCAN_BAND_SPECIFIC_RSSI_THOLD)) {
7873                 if (tb_band_rssi)
7874                         ret = -EOPNOTSUPP;
7875                 else
7876                         for (i = 0; i < NUM_NL80211_BANDS; i++)
7877                                 match_sets->per_band_rssi_thold[i] =
7878                                         NL80211_SCAN_RSSI_THOLD_OFF;
7879                 return ret;
7880         }
7881
7882         for (i = 0; i < NUM_NL80211_BANDS; i++)
7883                 match_sets->per_band_rssi_thold[i] = rssi_thold;
7884
7885         nla_for_each_nested(attr, tb_band_rssi, tmp) {
7886                 enum nl80211_band band = nla_type(attr);
7887
7888                 if (band < 0 || band >= NUM_NL80211_BANDS)
7889                         return -EINVAL;
7890
7891                 match_sets->per_band_rssi_thold[band] = nla_get_s32(attr);
7892         }
7893
7894         return 0;
7895 }
7896
7897 static struct cfg80211_sched_scan_request *
7898 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
7899                          struct nlattr **attrs, int max_match_sets)
7900 {
7901         struct cfg80211_sched_scan_request *request;
7902         struct nlattr *attr;
7903         int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
7904         enum nl80211_band band;
7905         size_t ie_len;
7906         struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
7907         s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
7908
7909         if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7910                 n_channels = validate_scan_freqs(
7911                                 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7912                 if (!n_channels)
7913                         return ERR_PTR(-EINVAL);
7914         } else {
7915                 n_channels = ieee80211_get_num_supported_channels(wiphy);
7916         }
7917
7918         if (attrs[NL80211_ATTR_SCAN_SSIDS])
7919                 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7920                                     tmp)
7921                         n_ssids++;
7922
7923         if (n_ssids > wiphy->max_sched_scan_ssids)
7924                 return ERR_PTR(-EINVAL);
7925
7926         /*
7927          * First, count the number of 'real' matchsets. Due to an issue with
7928          * the old implementation, matchsets containing only the RSSI attribute
7929          * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
7930          * RSSI for all matchsets, rather than their own matchset for reporting
7931          * all APs with a strong RSSI. This is needed to be compatible with
7932          * older userspace that treated a matchset with only the RSSI as the
7933          * global RSSI for all other matchsets - if there are other matchsets.
7934          */
7935         if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7936                 nla_for_each_nested(attr,
7937                                     attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7938                                     tmp) {
7939                         struct nlattr *rssi;
7940
7941                         err = nla_parse_nested_deprecated(tb,
7942                                                           NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7943                                                           attr,
7944                                                           nl80211_match_policy,
7945                                                           NULL);
7946                         if (err)
7947                                 return ERR_PTR(err);
7948
7949                         /* SSID and BSSID are mutually exclusive */
7950                         if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
7951                             tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
7952                                 return ERR_PTR(-EINVAL);
7953
7954                         /* add other standalone attributes here */
7955                         if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
7956                             tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
7957                                 n_match_sets++;
7958                                 continue;
7959                         }
7960                         rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7961                         if (rssi)
7962                                 default_match_rssi = nla_get_s32(rssi);
7963                 }
7964         }
7965
7966         /* However, if there's no other matchset, add the RSSI one */
7967         if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
7968                 n_match_sets = 1;
7969
7970         if (n_match_sets > max_match_sets)
7971                 return ERR_PTR(-EINVAL);
7972
7973         if (attrs[NL80211_ATTR_IE])
7974                 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
7975         else
7976                 ie_len = 0;
7977
7978         if (ie_len > wiphy->max_sched_scan_ie_len)
7979                 return ERR_PTR(-EINVAL);
7980
7981         if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7982                 /*
7983                  * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
7984                  * each scan plan already specifies its own interval
7985                  */
7986                 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7987                         return ERR_PTR(-EINVAL);
7988
7989                 nla_for_each_nested(attr,
7990                                     attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
7991                         n_plans++;
7992         } else {
7993                 /*
7994                  * The scan interval attribute is kept for backward
7995                  * compatibility. If no scan plans are specified and sched scan
7996                  * interval is specified, one scan plan will be set with this
7997                  * scan interval and infinite number of iterations.
7998                  */
7999                 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
8000                         return ERR_PTR(-EINVAL);
8001
8002                 n_plans = 1;
8003         }
8004
8005         if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
8006                 return ERR_PTR(-EINVAL);
8007
8008         if (!wiphy_ext_feature_isset(
8009                     wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
8010             (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
8011              attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
8012                 return ERR_PTR(-EINVAL);
8013
8014         request = kzalloc(sizeof(*request)
8015                         + sizeof(*request->ssids) * n_ssids
8016                         + sizeof(*request->match_sets) * n_match_sets
8017                         + sizeof(*request->scan_plans) * n_plans
8018                         + sizeof(*request->channels) * n_channels
8019                         + ie_len, GFP_KERNEL);
8020         if (!request)
8021                 return ERR_PTR(-ENOMEM);
8022
8023         if (n_ssids)
8024                 request->ssids = (void *)&request->channels[n_channels];
8025         request->n_ssids = n_ssids;
8026         if (ie_len) {
8027                 if (n_ssids)
8028                         request->ie = (void *)(request->ssids + n_ssids);
8029                 else
8030                         request->ie = (void *)(request->channels + n_channels);
8031         }
8032
8033         if (n_match_sets) {
8034                 if (request->ie)
8035                         request->match_sets = (void *)(request->ie + ie_len);
8036                 else if (n_ssids)
8037                         request->match_sets =
8038                                 (void *)(request->ssids + n_ssids);
8039                 else
8040                         request->match_sets =
8041                                 (void *)(request->channels + n_channels);
8042         }
8043         request->n_match_sets = n_match_sets;
8044
8045         if (n_match_sets)
8046                 request->scan_plans = (void *)(request->match_sets +
8047                                                n_match_sets);
8048         else if (request->ie)
8049                 request->scan_plans = (void *)(request->ie + ie_len);
8050         else if (n_ssids)
8051                 request->scan_plans = (void *)(request->ssids + n_ssids);
8052         else
8053                 request->scan_plans = (void *)(request->channels + n_channels);
8054
8055         request->n_scan_plans = n_plans;
8056
8057         i = 0;
8058         if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
8059                 /* user specified, bail out if channel not found */
8060                 nla_for_each_nested(attr,
8061                                     attrs[NL80211_ATTR_SCAN_FREQUENCIES],
8062                                     tmp) {
8063                         struct ieee80211_channel *chan;
8064
8065                         chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
8066
8067                         if (!chan) {
8068                                 err = -EINVAL;
8069                                 goto out_free;
8070                         }
8071
8072                         /* ignore disabled channels */
8073                         if (chan->flags & IEEE80211_CHAN_DISABLED)
8074                                 continue;
8075
8076                         request->channels[i] = chan;
8077                         i++;
8078                 }
8079         } else {
8080                 /* all channels */
8081                 for (band = 0; band < NUM_NL80211_BANDS; band++) {
8082                         int j;
8083
8084                         if (!wiphy->bands[band])
8085                                 continue;
8086                         for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
8087                                 struct ieee80211_channel *chan;
8088
8089                                 chan = &wiphy->bands[band]->channels[j];
8090
8091                                 if (chan->flags & IEEE80211_CHAN_DISABLED)
8092                                         continue;
8093
8094                                 request->channels[i] = chan;
8095                                 i++;
8096                         }
8097                 }
8098         }
8099
8100         if (!i) {
8101                 err = -EINVAL;
8102                 goto out_free;
8103         }
8104
8105         request->n_channels = i;
8106
8107         i = 0;
8108         if (n_ssids) {
8109                 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
8110                                     tmp) {
8111                         if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
8112                                 err = -EINVAL;
8113                                 goto out_free;
8114                         }
8115                         request->ssids[i].ssid_len = nla_len(attr);
8116                         memcpy(request->ssids[i].ssid, nla_data(attr),
8117                                nla_len(attr));
8118                         i++;
8119                 }
8120         }
8121
8122         i = 0;
8123         if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
8124                 nla_for_each_nested(attr,
8125                                     attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
8126                                     tmp) {
8127                         struct nlattr *ssid, *bssid, *rssi;
8128
8129                         err = nla_parse_nested_deprecated(tb,
8130                                                           NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
8131                                                           attr,
8132                                                           nl80211_match_policy,
8133                                                           NULL);
8134                         if (err)
8135                                 goto out_free;
8136                         ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
8137                         bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
8138
8139                         if (!ssid && !bssid) {
8140                                 i++;
8141                                 continue;
8142                         }
8143
8144                         if (WARN_ON(i >= n_match_sets)) {
8145                                 /* this indicates a programming error,
8146                                  * the loop above should have verified
8147                                  * things properly
8148                                  */
8149                                 err = -EINVAL;
8150                                 goto out_free;
8151                         }
8152
8153                         if (ssid) {
8154                                 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
8155                                         err = -EINVAL;
8156                                         goto out_free;
8157                                 }
8158                                 memcpy(request->match_sets[i].ssid.ssid,
8159                                        nla_data(ssid), nla_len(ssid));
8160                                 request->match_sets[i].ssid.ssid_len =
8161                                         nla_len(ssid);
8162                         }
8163                         if (bssid) {
8164                                 if (nla_len(bssid) != ETH_ALEN) {
8165                                         err = -EINVAL;
8166                                         goto out_free;
8167                                 }
8168                                 memcpy(request->match_sets[i].bssid,
8169                                        nla_data(bssid), ETH_ALEN);
8170                         }
8171
8172                         /* special attribute - old implementation w/a */
8173                         request->match_sets[i].rssi_thold = default_match_rssi;
8174                         rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
8175                         if (rssi)
8176                                 request->match_sets[i].rssi_thold =
8177                                         nla_get_s32(rssi);
8178
8179                         /* Parse per band RSSI attribute */
8180                         err = nl80211_parse_sched_scan_per_band_rssi(wiphy,
8181                                 &request->match_sets[i],
8182                                 tb[NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI],
8183                                 request->match_sets[i].rssi_thold);
8184                         if (err)
8185                                 goto out_free;
8186
8187                         i++;
8188                 }
8189
8190                 /* there was no other matchset, so the RSSI one is alone */
8191                 if (i == 0 && n_match_sets)
8192                         request->match_sets[0].rssi_thold = default_match_rssi;
8193
8194                 request->min_rssi_thold = INT_MAX;
8195                 for (i = 0; i < n_match_sets; i++)
8196                         request->min_rssi_thold =
8197                                 min(request->match_sets[i].rssi_thold,
8198                                     request->min_rssi_thold);
8199         } else {
8200                 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
8201         }
8202
8203         if (ie_len) {
8204                 request->ie_len = ie_len;
8205                 memcpy((void *)request->ie,
8206                        nla_data(attrs[NL80211_ATTR_IE]),
8207                        request->ie_len);
8208         }
8209
8210         err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
8211         if (err)
8212                 goto out_free;
8213
8214         if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
8215                 request->delay =
8216                         nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
8217
8218         if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
8219                 request->relative_rssi = nla_get_s8(
8220                         attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
8221                 request->relative_rssi_set = true;
8222         }
8223
8224         if (request->relative_rssi_set &&
8225             attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
8226                 struct nl80211_bss_select_rssi_adjust *rssi_adjust;
8227
8228                 rssi_adjust = nla_data(
8229                         attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
8230                 request->rssi_adjust.band = rssi_adjust->band;
8231                 request->rssi_adjust.delta = rssi_adjust->delta;
8232                 if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
8233                         err = -EINVAL;
8234                         goto out_free;
8235                 }
8236         }
8237
8238         err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
8239         if (err)
8240                 goto out_free;
8241
8242         request->scan_start = jiffies;
8243
8244         return request;
8245
8246 out_free:
8247         kfree(request);
8248         return ERR_PTR(err);
8249 }
8250
8251 static int nl80211_start_sched_scan(struct sk_buff *skb,
8252                                     struct genl_info *info)
8253 {
8254         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8255         struct net_device *dev = info->user_ptr[1];
8256         struct wireless_dev *wdev = dev->ieee80211_ptr;
8257         struct cfg80211_sched_scan_request *sched_scan_req;
8258         bool want_multi;
8259         int err;
8260
8261         if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
8262                 return -EOPNOTSUPP;
8263
8264         want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
8265         err = cfg80211_sched_scan_req_possible(rdev, want_multi);
8266         if (err)
8267                 return err;
8268
8269         sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
8270                                                   info->attrs,
8271                                                   rdev->wiphy.max_match_sets);
8272
8273         err = PTR_ERR_OR_ZERO(sched_scan_req);
8274         if (err)
8275                 goto out_err;
8276
8277         /* leave request id zero for legacy request
8278          * or if driver does not support multi-scheduled scan
8279          */
8280         if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) {
8281                 while (!sched_scan_req->reqid)
8282                         sched_scan_req->reqid = cfg80211_assign_cookie(rdev);
8283         }
8284
8285         err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
8286         if (err)
8287                 goto out_free;
8288
8289         sched_scan_req->dev = dev;
8290         sched_scan_req->wiphy = &rdev->wiphy;
8291
8292         if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
8293                 sched_scan_req->owner_nlportid = info->snd_portid;
8294
8295         cfg80211_add_sched_scan_req(rdev, sched_scan_req);
8296
8297         nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
8298         return 0;
8299
8300 out_free:
8301         kfree(sched_scan_req);
8302 out_err:
8303         return err;
8304 }
8305
8306 static int nl80211_stop_sched_scan(struct sk_buff *skb,
8307                                    struct genl_info *info)
8308 {
8309         struct cfg80211_sched_scan_request *req;
8310         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8311         u64 cookie;
8312
8313         if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
8314                 return -EOPNOTSUPP;
8315
8316         if (info->attrs[NL80211_ATTR_COOKIE]) {
8317                 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
8318                 return __cfg80211_stop_sched_scan(rdev, cookie, false);
8319         }
8320
8321         req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
8322                                      struct cfg80211_sched_scan_request,
8323                                      list);
8324         if (!req || req->reqid ||
8325             (req->owner_nlportid &&
8326              req->owner_nlportid != info->snd_portid))
8327                 return -ENOENT;
8328
8329         return cfg80211_stop_sched_scan_req(rdev, req, false);
8330 }
8331
8332 static int nl80211_start_radar_detection(struct sk_buff *skb,
8333                                          struct genl_info *info)
8334 {
8335         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8336         struct net_device *dev = info->user_ptr[1];
8337         struct wireless_dev *wdev = dev->ieee80211_ptr;
8338         struct wiphy *wiphy = wdev->wiphy;
8339         struct cfg80211_chan_def chandef;
8340         enum nl80211_dfs_regions dfs_region;
8341         unsigned int cac_time_ms;
8342         int err;
8343
8344         dfs_region = reg_get_dfs_region(wiphy);
8345         if (dfs_region == NL80211_DFS_UNSET)
8346                 return -EINVAL;
8347
8348         err = nl80211_parse_chandef(rdev, info, &chandef);
8349         if (err)
8350                 return err;
8351
8352         if (netif_carrier_ok(dev))
8353                 return -EBUSY;
8354
8355         if (wdev->cac_started)
8356                 return -EBUSY;
8357
8358         err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
8359         if (err < 0)
8360                 return err;
8361
8362         if (err == 0)
8363                 return -EINVAL;
8364
8365         if (!cfg80211_chandef_dfs_usable(wiphy, &chandef))
8366                 return -EINVAL;
8367
8368         /* CAC start is offloaded to HW and can't be started manually */
8369         if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD))
8370                 return -EOPNOTSUPP;
8371
8372         if (!rdev->ops->start_radar_detection)
8373                 return -EOPNOTSUPP;
8374
8375         cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
8376         if (WARN_ON(!cac_time_ms))
8377                 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
8378
8379         err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
8380         if (!err) {
8381                 wdev->chandef = chandef;
8382                 wdev->cac_started = true;
8383                 wdev->cac_start_time = jiffies;
8384                 wdev->cac_time_ms = cac_time_ms;
8385         }
8386         return err;
8387 }
8388
8389 static int nl80211_notify_radar_detection(struct sk_buff *skb,
8390                                           struct genl_info *info)
8391 {
8392         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8393         struct net_device *dev = info->user_ptr[1];
8394         struct wireless_dev *wdev = dev->ieee80211_ptr;
8395         struct wiphy *wiphy = wdev->wiphy;
8396         struct cfg80211_chan_def chandef;
8397         enum nl80211_dfs_regions dfs_region;
8398         int err;
8399
8400         dfs_region = reg_get_dfs_region(wiphy);
8401         if (dfs_region == NL80211_DFS_UNSET) {
8402                 GENL_SET_ERR_MSG(info,
8403                                  "DFS Region is not set. Unexpected Radar indication");
8404                 return -EINVAL;
8405         }
8406
8407         err = nl80211_parse_chandef(rdev, info, &chandef);
8408         if (err) {
8409                 GENL_SET_ERR_MSG(info, "Unable to extract chandef info");
8410                 return err;
8411         }
8412
8413         err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
8414         if (err < 0) {
8415                 GENL_SET_ERR_MSG(info, "chandef is invalid");
8416                 return err;
8417         }
8418
8419         if (err == 0) {
8420                 GENL_SET_ERR_MSG(info,
8421                                  "Unexpected Radar indication for chandef/iftype");
8422                 return -EINVAL;
8423         }
8424
8425         /* Do not process this notification if radar is already detected
8426          * by kernel on this channel, and return success.
8427          */
8428         if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE)
8429                 return 0;
8430
8431         cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE);
8432
8433         cfg80211_sched_dfs_chan_update(rdev);
8434
8435         rdev->radar_chandef = chandef;
8436
8437         /* Propagate this notification to other radios as well */
8438         queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk);
8439
8440         return 0;
8441 }
8442
8443 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
8444 {
8445         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8446         struct net_device *dev = info->user_ptr[1];
8447         struct wireless_dev *wdev = dev->ieee80211_ptr;
8448         struct cfg80211_csa_settings params;
8449         /* csa_attrs is defined static to avoid waste of stack size - this
8450          * function is called under RTNL lock, so this should not be a problem.
8451          */
8452         static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
8453         int err;
8454         bool need_new_beacon = false;
8455         bool need_handle_dfs_flag = true;
8456         int len, i;
8457         u32 cs_count;
8458
8459         if (!rdev->ops->channel_switch ||
8460             !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
8461                 return -EOPNOTSUPP;
8462
8463         switch (dev->ieee80211_ptr->iftype) {
8464         case NL80211_IFTYPE_AP:
8465         case NL80211_IFTYPE_P2P_GO:
8466                 need_new_beacon = true;
8467                 /* For all modes except AP the handle_dfs flag needs to be
8468                  * supplied to tell the kernel that userspace will handle radar
8469                  * events when they happen. Otherwise a switch to a channel
8470                  * requiring DFS will be rejected.
8471                  */
8472                 need_handle_dfs_flag = false;
8473
8474                 /* useless if AP is not running */
8475                 if (!wdev->beacon_interval)
8476                         return -ENOTCONN;
8477                 break;
8478         case NL80211_IFTYPE_ADHOC:
8479                 if (!wdev->ssid_len)
8480                         return -ENOTCONN;
8481                 break;
8482         case NL80211_IFTYPE_MESH_POINT:
8483                 if (!wdev->mesh_id_len)
8484                         return -ENOTCONN;
8485                 break;
8486         default:
8487                 return -EOPNOTSUPP;
8488         }
8489
8490         memset(&params, 0, sizeof(params));
8491         params.beacon_csa.ftm_responder = -1;
8492
8493         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
8494             !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
8495                 return -EINVAL;
8496
8497         /* only important for AP, IBSS and mesh create IEs internally */
8498         if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
8499                 return -EINVAL;
8500
8501         /* Even though the attribute is u32, the specification says
8502          * u8, so let's make sure we don't overflow.
8503          */
8504         cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
8505         if (cs_count > 255)
8506                 return -EINVAL;
8507
8508         params.count = cs_count;
8509
8510         if (!need_new_beacon)
8511                 goto skip_beacons;
8512
8513         err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_after);
8514         if (err)
8515                 return err;
8516
8517         err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX,
8518                                           info->attrs[NL80211_ATTR_CSA_IES],
8519                                           nl80211_policy, info->extack);
8520         if (err)
8521                 return err;
8522
8523         err = nl80211_parse_beacon(rdev, csa_attrs, &params.beacon_csa);
8524         if (err)
8525                 return err;
8526
8527         if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
8528                 return -EINVAL;
8529
8530         len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
8531         if (!len || (len % sizeof(u16)))
8532                 return -EINVAL;
8533
8534         params.n_counter_offsets_beacon = len / sizeof(u16);
8535         if (rdev->wiphy.max_num_csa_counters &&
8536             (params.n_counter_offsets_beacon >
8537              rdev->wiphy.max_num_csa_counters))
8538                 return -EINVAL;
8539
8540         params.counter_offsets_beacon =
8541                 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
8542
8543         /* sanity checks - counters should fit and be the same */
8544         for (i = 0; i < params.n_counter_offsets_beacon; i++) {
8545                 u16 offset = params.counter_offsets_beacon[i];
8546
8547                 if (offset >= params.beacon_csa.tail_len)
8548                         return -EINVAL;
8549
8550                 if (params.beacon_csa.tail[offset] != params.count)
8551                         return -EINVAL;
8552         }
8553
8554         if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
8555                 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
8556                 if (!len || (len % sizeof(u16)))
8557                         return -EINVAL;
8558
8559                 params.n_counter_offsets_presp = len / sizeof(u16);
8560                 if (rdev->wiphy.max_num_csa_counters &&
8561                     (params.n_counter_offsets_presp >
8562                      rdev->wiphy.max_num_csa_counters))
8563                         return -EINVAL;
8564
8565                 params.counter_offsets_presp =
8566                         nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
8567
8568                 /* sanity checks - counters should fit and be the same */
8569                 for (i = 0; i < params.n_counter_offsets_presp; i++) {
8570                         u16 offset = params.counter_offsets_presp[i];
8571
8572                         if (offset >= params.beacon_csa.probe_resp_len)
8573                                 return -EINVAL;
8574
8575                         if (params.beacon_csa.probe_resp[offset] !=
8576                             params.count)
8577                                 return -EINVAL;
8578                 }
8579         }
8580
8581 skip_beacons:
8582         err = nl80211_parse_chandef(rdev, info, &params.chandef);
8583         if (err)
8584                 return err;
8585
8586         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
8587                                            wdev->iftype))
8588                 return -EINVAL;
8589
8590         err = cfg80211_chandef_dfs_required(wdev->wiphy,
8591                                             &params.chandef,
8592                                             wdev->iftype);
8593         if (err < 0)
8594                 return err;
8595
8596         if (err > 0) {
8597                 params.radar_required = true;
8598                 if (need_handle_dfs_flag &&
8599                     !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
8600                         return -EINVAL;
8601                 }
8602         }
8603
8604         if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
8605                 params.block_tx = true;
8606
8607         wdev_lock(wdev);
8608         err = rdev_channel_switch(rdev, dev, &params);
8609         wdev_unlock(wdev);
8610
8611         return err;
8612 }
8613
8614 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
8615                             u32 seq, int flags,
8616                             struct cfg80211_registered_device *rdev,
8617                             struct wireless_dev *wdev,
8618                             struct cfg80211_internal_bss *intbss)
8619 {
8620         struct cfg80211_bss *res = &intbss->pub;
8621         const struct cfg80211_bss_ies *ies;
8622         void *hdr;
8623         struct nlattr *bss;
8624
8625         ASSERT_WDEV_LOCK(wdev);
8626
8627         hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
8628                              NL80211_CMD_NEW_SCAN_RESULTS);
8629         if (!hdr)
8630                 return -1;
8631
8632         genl_dump_check_consistent(cb, hdr);
8633
8634         if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
8635                 goto nla_put_failure;
8636         if (wdev->netdev &&
8637             nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
8638                 goto nla_put_failure;
8639         if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
8640                               NL80211_ATTR_PAD))
8641                 goto nla_put_failure;
8642
8643         bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS);
8644         if (!bss)
8645                 goto nla_put_failure;
8646         if ((!is_zero_ether_addr(res->bssid) &&
8647              nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
8648                 goto nla_put_failure;
8649
8650         rcu_read_lock();
8651         /* indicate whether we have probe response data or not */
8652         if (rcu_access_pointer(res->proberesp_ies) &&
8653             nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
8654                 goto fail_unlock_rcu;
8655
8656         /* this pointer prefers to be pointed to probe response data
8657          * but is always valid
8658          */
8659         ies = rcu_dereference(res->ies);
8660         if (ies) {
8661                 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
8662                                       NL80211_BSS_PAD))
8663                         goto fail_unlock_rcu;
8664                 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
8665                                         ies->len, ies->data))
8666                         goto fail_unlock_rcu;
8667         }
8668
8669         /* and this pointer is always (unless driver didn't know) beacon data */
8670         ies = rcu_dereference(res->beacon_ies);
8671         if (ies && ies->from_beacon) {
8672                 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
8673                                       NL80211_BSS_PAD))
8674                         goto fail_unlock_rcu;
8675                 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
8676                                         ies->len, ies->data))
8677                         goto fail_unlock_rcu;
8678         }
8679         rcu_read_unlock();
8680
8681         if (res->beacon_interval &&
8682             nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
8683                 goto nla_put_failure;
8684         if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
8685             nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
8686             nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
8687             nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
8688                         jiffies_to_msecs(jiffies - intbss->ts)))
8689                 goto nla_put_failure;
8690
8691         if (intbss->parent_tsf &&
8692             (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
8693                                intbss->parent_tsf, NL80211_BSS_PAD) ||
8694              nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
8695                      intbss->parent_bssid)))
8696                 goto nla_put_failure;
8697
8698         if (intbss->ts_boottime &&
8699             nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
8700                               intbss->ts_boottime, NL80211_BSS_PAD))
8701                 goto nla_put_failure;
8702
8703         if (!nl80211_put_signal(msg, intbss->pub.chains,
8704                                 intbss->pub.chain_signal,
8705                                 NL80211_BSS_CHAIN_SIGNAL))
8706                 goto nla_put_failure;
8707
8708         switch (rdev->wiphy.signal_type) {
8709         case CFG80211_SIGNAL_TYPE_MBM:
8710                 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
8711                         goto nla_put_failure;
8712                 break;
8713         case CFG80211_SIGNAL_TYPE_UNSPEC:
8714                 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
8715                         goto nla_put_failure;
8716                 break;
8717         default:
8718                 break;
8719         }
8720
8721         switch (wdev->iftype) {
8722         case NL80211_IFTYPE_P2P_CLIENT:
8723         case NL80211_IFTYPE_STATION:
8724                 if (intbss == wdev->current_bss &&
8725                     nla_put_u32(msg, NL80211_BSS_STATUS,
8726                                 NL80211_BSS_STATUS_ASSOCIATED))
8727                         goto nla_put_failure;
8728                 break;
8729         case NL80211_IFTYPE_ADHOC:
8730                 if (intbss == wdev->current_bss &&
8731                     nla_put_u32(msg, NL80211_BSS_STATUS,
8732                                 NL80211_BSS_STATUS_IBSS_JOINED))
8733                         goto nla_put_failure;
8734                 break;
8735         default:
8736                 break;
8737         }
8738
8739         nla_nest_end(msg, bss);
8740
8741         genlmsg_end(msg, hdr);
8742         return 0;
8743
8744  fail_unlock_rcu:
8745         rcu_read_unlock();
8746  nla_put_failure:
8747         genlmsg_cancel(msg, hdr);
8748         return -EMSGSIZE;
8749 }
8750
8751 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
8752 {
8753         struct cfg80211_registered_device *rdev;
8754         struct cfg80211_internal_bss *scan;
8755         struct wireless_dev *wdev;
8756         int start = cb->args[2], idx = 0;
8757         int err;
8758
8759         rtnl_lock();
8760         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
8761         if (err) {
8762                 rtnl_unlock();
8763                 return err;
8764         }
8765
8766         wdev_lock(wdev);
8767         spin_lock_bh(&rdev->bss_lock);
8768
8769         /*
8770          * dump_scan will be called multiple times to break up the scan results
8771          * into multiple messages.  It is unlikely that any more bss-es will be
8772          * expired after the first call, so only call only call this on the
8773          * first dump_scan invocation.
8774          */
8775         if (start == 0)
8776                 cfg80211_bss_expire(rdev);
8777
8778         cb->seq = rdev->bss_generation;
8779
8780         list_for_each_entry(scan, &rdev->bss_list, list) {
8781                 if (++idx <= start)
8782                         continue;
8783                 if (nl80211_send_bss(skb, cb,
8784                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8785                                 rdev, wdev, scan) < 0) {
8786                         idx--;
8787                         break;
8788                 }
8789         }
8790
8791         spin_unlock_bh(&rdev->bss_lock);
8792         wdev_unlock(wdev);
8793
8794         cb->args[2] = idx;
8795         rtnl_unlock();
8796
8797         return skb->len;
8798 }
8799
8800 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
8801                                int flags, struct net_device *dev,
8802                                bool allow_radio_stats,
8803                                struct survey_info *survey)
8804 {
8805         void *hdr;
8806         struct nlattr *infoattr;
8807
8808         /* skip radio stats if userspace didn't request them */
8809         if (!survey->channel && !allow_radio_stats)
8810                 return 0;
8811
8812         hdr = nl80211hdr_put(msg, portid, seq, flags,
8813                              NL80211_CMD_NEW_SURVEY_RESULTS);
8814         if (!hdr)
8815                 return -ENOMEM;
8816
8817         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
8818                 goto nla_put_failure;
8819
8820         infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO);
8821         if (!infoattr)
8822                 goto nla_put_failure;
8823
8824         if (survey->channel &&
8825             nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
8826                         survey->channel->center_freq))
8827                 goto nla_put_failure;
8828
8829         if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
8830             nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
8831                 goto nla_put_failure;
8832         if ((survey->filled & SURVEY_INFO_IN_USE) &&
8833             nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
8834                 goto nla_put_failure;
8835         if ((survey->filled & SURVEY_INFO_TIME) &&
8836             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
8837                         survey->time, NL80211_SURVEY_INFO_PAD))
8838                 goto nla_put_failure;
8839         if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
8840             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
8841                               survey->time_busy, NL80211_SURVEY_INFO_PAD))
8842                 goto nla_put_failure;
8843         if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
8844             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
8845                               survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
8846                 goto nla_put_failure;
8847         if ((survey->filled & SURVEY_INFO_TIME_RX) &&
8848             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
8849                               survey->time_rx, NL80211_SURVEY_INFO_PAD))
8850                 goto nla_put_failure;
8851         if ((survey->filled & SURVEY_INFO_TIME_TX) &&
8852             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
8853                               survey->time_tx, NL80211_SURVEY_INFO_PAD))
8854                 goto nla_put_failure;
8855         if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
8856             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
8857                               survey->time_scan, NL80211_SURVEY_INFO_PAD))
8858                 goto nla_put_failure;
8859         if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) &&
8860             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX,
8861                               survey->time_bss_rx, NL80211_SURVEY_INFO_PAD))
8862                 goto nla_put_failure;
8863
8864         nla_nest_end(msg, infoattr);
8865
8866         genlmsg_end(msg, hdr);
8867         return 0;
8868
8869  nla_put_failure:
8870         genlmsg_cancel(msg, hdr);
8871         return -EMSGSIZE;
8872 }
8873
8874 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
8875 {
8876         struct nlattr **attrbuf;
8877         struct survey_info survey;
8878         struct cfg80211_registered_device *rdev;
8879         struct wireless_dev *wdev;
8880         int survey_idx = cb->args[2];
8881         int res;
8882         bool radio_stats;
8883
8884         attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
8885         if (!attrbuf)
8886                 return -ENOMEM;
8887
8888         rtnl_lock();
8889         res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
8890         if (res)
8891                 goto out_err;
8892
8893         /* prepare_wdev_dump parsed the attributes */
8894         radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
8895
8896         if (!wdev->netdev) {
8897                 res = -EINVAL;
8898                 goto out_err;
8899         }
8900
8901         if (!rdev->ops->dump_survey) {
8902                 res = -EOPNOTSUPP;
8903                 goto out_err;
8904         }
8905
8906         while (1) {
8907                 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
8908                 if (res == -ENOENT)
8909                         break;
8910                 if (res)
8911                         goto out_err;
8912
8913                 /* don't send disabled channels, but do send non-channel data */
8914                 if (survey.channel &&
8915                     survey.channel->flags & IEEE80211_CHAN_DISABLED) {
8916                         survey_idx++;
8917                         continue;
8918                 }
8919
8920                 if (nl80211_send_survey(skb,
8921                                 NETLINK_CB(cb->skb).portid,
8922                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8923                                 wdev->netdev, radio_stats, &survey) < 0)
8924                         goto out;
8925                 survey_idx++;
8926         }
8927
8928  out:
8929         cb->args[2] = survey_idx;
8930         res = skb->len;
8931  out_err:
8932         kfree(attrbuf);
8933         rtnl_unlock();
8934         return res;
8935 }
8936
8937 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
8938 {
8939         return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
8940                                   NL80211_WPA_VERSION_2 |
8941                                   NL80211_WPA_VERSION_3));
8942 }
8943
8944 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
8945 {
8946         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8947         struct net_device *dev = info->user_ptr[1];
8948         struct ieee80211_channel *chan;
8949         const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
8950         int err, ssid_len, ie_len = 0, auth_data_len = 0;
8951         enum nl80211_auth_type auth_type;
8952         struct key_parse key;
8953         bool local_state_change;
8954
8955         if (!info->attrs[NL80211_ATTR_MAC])
8956                 return -EINVAL;
8957
8958         if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
8959                 return -EINVAL;
8960
8961         if (!info->attrs[NL80211_ATTR_SSID])
8962                 return -EINVAL;
8963
8964         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
8965                 return -EINVAL;
8966
8967         err = nl80211_parse_key(info, &key);
8968         if (err)
8969                 return err;
8970
8971         if (key.idx >= 0) {
8972                 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
8973                         return -EINVAL;
8974                 if (!key.p.key || !key.p.key_len)
8975                         return -EINVAL;
8976                 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
8977                      key.p.key_len != WLAN_KEY_LEN_WEP40) &&
8978                     (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
8979                      key.p.key_len != WLAN_KEY_LEN_WEP104))
8980                         return -EINVAL;
8981                 if (key.idx > 3)
8982                         return -EINVAL;
8983         } else {
8984                 key.p.key_len = 0;
8985                 key.p.key = NULL;
8986         }
8987
8988         if (key.idx >= 0) {
8989                 int i;
8990                 bool ok = false;
8991
8992                 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
8993                         if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
8994                                 ok = true;
8995                                 break;
8996                         }
8997                 }
8998                 if (!ok)
8999                         return -EINVAL;
9000         }
9001
9002         if (!rdev->ops->auth)
9003                 return -EOPNOTSUPP;
9004
9005         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9006             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9007                 return -EOPNOTSUPP;
9008
9009         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9010         chan = nl80211_get_valid_chan(&rdev->wiphy,
9011                                       info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9012         if (!chan)
9013                 return -EINVAL;
9014
9015         ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9016         ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9017
9018         if (info->attrs[NL80211_ATTR_IE]) {
9019                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9020                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9021         }
9022
9023         auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9024         if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
9025                 return -EINVAL;
9026
9027         if ((auth_type == NL80211_AUTHTYPE_SAE ||
9028              auth_type == NL80211_AUTHTYPE_FILS_SK ||
9029              auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
9030              auth_type == NL80211_AUTHTYPE_FILS_PK) &&
9031             !info->attrs[NL80211_ATTR_AUTH_DATA])
9032                 return -EINVAL;
9033
9034         if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
9035                 if (auth_type != NL80211_AUTHTYPE_SAE &&
9036                     auth_type != NL80211_AUTHTYPE_FILS_SK &&
9037                     auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
9038                     auth_type != NL80211_AUTHTYPE_FILS_PK)
9039                         return -EINVAL;
9040                 auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
9041                 auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
9042                 /* need to include at least Auth Transaction and Status Code */
9043                 if (auth_data_len < 4)
9044                         return -EINVAL;
9045         }
9046
9047         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9048
9049         /*
9050          * Since we no longer track auth state, ignore
9051          * requests to only change local state.
9052          */
9053         if (local_state_change)
9054                 return 0;
9055
9056         wdev_lock(dev->ieee80211_ptr);
9057         err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
9058                                  ssid, ssid_len, ie, ie_len,
9059                                  key.p.key, key.p.key_len, key.idx,
9060                                  auth_data, auth_data_len);
9061         wdev_unlock(dev->ieee80211_ptr);
9062         return err;
9063 }
9064
9065 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
9066                                      struct genl_info *info)
9067 {
9068         if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9069                 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
9070                 return -EINVAL;
9071         }
9072
9073         if (!rdev->ops->tx_control_port ||
9074             !wiphy_ext_feature_isset(&rdev->wiphy,
9075                                      NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
9076                 return -EOPNOTSUPP;
9077
9078         return 0;
9079 }
9080
9081 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
9082                                    struct genl_info *info,
9083                                    struct cfg80211_crypto_settings *settings,
9084                                    int cipher_limit)
9085 {
9086         memset(settings, 0, sizeof(*settings));
9087
9088         settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
9089
9090         if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
9091                 u16 proto;
9092
9093                 proto = nla_get_u16(
9094                         info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
9095                 settings->control_port_ethertype = cpu_to_be16(proto);
9096                 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
9097                     proto != ETH_P_PAE)
9098                         return -EINVAL;
9099                 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
9100                         settings->control_port_no_encrypt = true;
9101         } else
9102                 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
9103
9104         if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
9105                 int r = validate_pae_over_nl80211(rdev, info);
9106
9107                 if (r < 0)
9108                         return r;
9109
9110                 settings->control_port_over_nl80211 = true;
9111         }
9112
9113         if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
9114                 void *data;
9115                 int len, i;
9116
9117                 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
9118                 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
9119                 settings->n_ciphers_pairwise = len / sizeof(u32);
9120
9121                 if (len % sizeof(u32))
9122                         return -EINVAL;
9123
9124                 if (settings->n_ciphers_pairwise > cipher_limit)
9125                         return -EINVAL;
9126
9127                 memcpy(settings->ciphers_pairwise, data, len);
9128
9129                 for (i = 0; i < settings->n_ciphers_pairwise; i++)
9130                         if (!cfg80211_supported_cipher_suite(
9131                                         &rdev->wiphy,
9132                                         settings->ciphers_pairwise[i]))
9133                                 return -EINVAL;
9134         }
9135
9136         if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
9137                 settings->cipher_group =
9138                         nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
9139                 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
9140                                                      settings->cipher_group))
9141                         return -EINVAL;
9142         }
9143
9144         if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
9145                 settings->wpa_versions =
9146                         nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
9147                 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
9148                         return -EINVAL;
9149         }
9150
9151         if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
9152                 void *data;
9153                 int len;
9154
9155                 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
9156                 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
9157                 settings->n_akm_suites = len / sizeof(u32);
9158
9159                 if (len % sizeof(u32))
9160                         return -EINVAL;
9161
9162                 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
9163                         return -EINVAL;
9164
9165                 memcpy(settings->akm_suites, data, len);
9166         }
9167
9168         if (info->attrs[NL80211_ATTR_PMK]) {
9169                 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
9170                         return -EINVAL;
9171                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
9172                                              NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK))
9173                         return -EINVAL;
9174                 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
9175         }
9176
9177         if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) {
9178                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
9179                                              NL80211_EXT_FEATURE_SAE_OFFLOAD))
9180                         return -EINVAL;
9181                 settings->sae_pwd =
9182                         nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
9183                 settings->sae_pwd_len =
9184                         nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
9185         }
9186
9187         return 0;
9188 }
9189
9190 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
9191 {
9192         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9193         struct net_device *dev = info->user_ptr[1];
9194         struct ieee80211_channel *chan;
9195         struct cfg80211_assoc_request req = {};
9196         const u8 *bssid, *ssid;
9197         int err, ssid_len = 0;
9198
9199         if (dev->ieee80211_ptr->conn_owner_nlportid &&
9200             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9201                 return -EPERM;
9202
9203         if (!info->attrs[NL80211_ATTR_MAC] ||
9204             !info->attrs[NL80211_ATTR_SSID] ||
9205             !info->attrs[NL80211_ATTR_WIPHY_FREQ])
9206                 return -EINVAL;
9207
9208         if (!rdev->ops->assoc)
9209                 return -EOPNOTSUPP;
9210
9211         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9212             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9213                 return -EOPNOTSUPP;
9214
9215         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9216
9217         chan = nl80211_get_valid_chan(&rdev->wiphy,
9218                                       info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9219         if (!chan)
9220                 return -EINVAL;
9221
9222         ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9223         ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9224
9225         if (info->attrs[NL80211_ATTR_IE]) {
9226                 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9227                 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9228         }
9229
9230         if (info->attrs[NL80211_ATTR_USE_MFP]) {
9231                 enum nl80211_mfp mfp =
9232                         nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
9233                 if (mfp == NL80211_MFP_REQUIRED)
9234                         req.use_mfp = true;
9235                 else if (mfp != NL80211_MFP_NO)
9236                         return -EINVAL;
9237         }
9238
9239         if (info->attrs[NL80211_ATTR_PREV_BSSID])
9240                 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
9241
9242         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
9243                 req.flags |= ASSOC_REQ_DISABLE_HT;
9244
9245         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9246                 memcpy(&req.ht_capa_mask,
9247                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9248                        sizeof(req.ht_capa_mask));
9249
9250         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9251                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9252                         return -EINVAL;
9253                 memcpy(&req.ht_capa,
9254                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9255                        sizeof(req.ht_capa));
9256         }
9257
9258         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
9259                 req.flags |= ASSOC_REQ_DISABLE_VHT;
9260
9261         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9262                 memcpy(&req.vht_capa_mask,
9263                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
9264                        sizeof(req.vht_capa_mask));
9265
9266         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
9267                 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9268                         return -EINVAL;
9269                 memcpy(&req.vht_capa,
9270                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
9271                        sizeof(req.vht_capa));
9272         }
9273
9274         if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
9275                 if (!((rdev->wiphy.features &
9276                         NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
9277                        (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
9278                     !wiphy_ext_feature_isset(&rdev->wiphy,
9279                                              NL80211_EXT_FEATURE_RRM))
9280                         return -EINVAL;
9281                 req.flags |= ASSOC_REQ_USE_RRM;
9282         }
9283
9284         if (info->attrs[NL80211_ATTR_FILS_KEK]) {
9285                 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
9286                 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
9287                 if (!info->attrs[NL80211_ATTR_FILS_NONCES])
9288                         return -EINVAL;
9289                 req.fils_nonces =
9290                         nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
9291         }
9292
9293         err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
9294         if (!err) {
9295                 wdev_lock(dev->ieee80211_ptr);
9296
9297                 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
9298                                           ssid, ssid_len, &req);
9299
9300                 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9301                         dev->ieee80211_ptr->conn_owner_nlportid =
9302                                 info->snd_portid;
9303                         memcpy(dev->ieee80211_ptr->disconnect_bssid,
9304                                bssid, ETH_ALEN);
9305                 }
9306
9307                 wdev_unlock(dev->ieee80211_ptr);
9308         }
9309
9310         return err;
9311 }
9312
9313 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
9314 {
9315         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9316         struct net_device *dev = info->user_ptr[1];
9317         const u8 *ie = NULL, *bssid;
9318         int ie_len = 0, err;
9319         u16 reason_code;
9320         bool local_state_change;
9321
9322         if (dev->ieee80211_ptr->conn_owner_nlportid &&
9323             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9324                 return -EPERM;
9325
9326         if (!info->attrs[NL80211_ATTR_MAC])
9327                 return -EINVAL;
9328
9329         if (!info->attrs[NL80211_ATTR_REASON_CODE])
9330                 return -EINVAL;
9331
9332         if (!rdev->ops->deauth)
9333                 return -EOPNOTSUPP;
9334
9335         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9336             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9337                 return -EOPNOTSUPP;
9338
9339         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9340
9341         reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9342         if (reason_code == 0) {
9343                 /* Reason Code 0 is reserved */
9344                 return -EINVAL;
9345         }
9346
9347         if (info->attrs[NL80211_ATTR_IE]) {
9348                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9349                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9350         }
9351
9352         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9353
9354         wdev_lock(dev->ieee80211_ptr);
9355         err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
9356                                    local_state_change);
9357         wdev_unlock(dev->ieee80211_ptr);
9358         return err;
9359 }
9360
9361 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
9362 {
9363         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9364         struct net_device *dev = info->user_ptr[1];
9365         const u8 *ie = NULL, *bssid;
9366         int ie_len = 0, err;
9367         u16 reason_code;
9368         bool local_state_change;
9369
9370         if (dev->ieee80211_ptr->conn_owner_nlportid &&
9371             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9372                 return -EPERM;
9373
9374         if (!info->attrs[NL80211_ATTR_MAC])
9375                 return -EINVAL;
9376
9377         if (!info->attrs[NL80211_ATTR_REASON_CODE])
9378                 return -EINVAL;
9379
9380         if (!rdev->ops->disassoc)
9381                 return -EOPNOTSUPP;
9382
9383         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9384             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9385                 return -EOPNOTSUPP;
9386
9387         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9388
9389         reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9390         if (reason_code == 0) {
9391                 /* Reason Code 0 is reserved */
9392                 return -EINVAL;
9393         }
9394
9395         if (info->attrs[NL80211_ATTR_IE]) {
9396                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9397                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9398         }
9399
9400         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9401
9402         wdev_lock(dev->ieee80211_ptr);
9403         err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
9404                                      local_state_change);
9405         wdev_unlock(dev->ieee80211_ptr);
9406         return err;
9407 }
9408
9409 static bool
9410 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
9411                          int mcast_rate[NUM_NL80211_BANDS],
9412                          int rateval)
9413 {
9414         struct wiphy *wiphy = &rdev->wiphy;
9415         bool found = false;
9416         int band, i;
9417
9418         for (band = 0; band < NUM_NL80211_BANDS; band++) {
9419                 struct ieee80211_supported_band *sband;
9420
9421                 sband = wiphy->bands[band];
9422                 if (!sband)
9423                         continue;
9424
9425                 for (i = 0; i < sband->n_bitrates; i++) {
9426                         if (sband->bitrates[i].bitrate == rateval) {
9427                                 mcast_rate[band] = i + 1;
9428                                 found = true;
9429                                 break;
9430                         }
9431                 }
9432         }
9433
9434         return found;
9435 }
9436
9437 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
9438 {
9439         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9440         struct net_device *dev = info->user_ptr[1];
9441         struct cfg80211_ibss_params ibss;
9442         struct wiphy *wiphy;
9443         struct cfg80211_cached_keys *connkeys = NULL;
9444         int err;
9445
9446         memset(&ibss, 0, sizeof(ibss));
9447
9448         if (!info->attrs[NL80211_ATTR_SSID] ||
9449             !nla_len(info->attrs[NL80211_ATTR_SSID]))
9450                 return -EINVAL;
9451
9452         ibss.beacon_interval = 100;
9453
9454         if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
9455                 ibss.beacon_interval =
9456                         nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
9457
9458         err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
9459                                            ibss.beacon_interval);
9460         if (err)
9461                 return err;
9462
9463         if (!rdev->ops->join_ibss)
9464                 return -EOPNOTSUPP;
9465
9466         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
9467                 return -EOPNOTSUPP;
9468
9469         wiphy = &rdev->wiphy;
9470
9471         if (info->attrs[NL80211_ATTR_MAC]) {
9472                 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9473
9474                 if (!is_valid_ether_addr(ibss.bssid))
9475                         return -EINVAL;
9476         }
9477         ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9478         ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9479
9480         if (info->attrs[NL80211_ATTR_IE]) {
9481                 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9482                 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9483         }
9484
9485         err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
9486         if (err)
9487                 return err;
9488
9489         if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
9490                                      NL80211_IFTYPE_ADHOC))
9491                 return -EINVAL;
9492
9493         switch (ibss.chandef.width) {
9494         case NL80211_CHAN_WIDTH_5:
9495         case NL80211_CHAN_WIDTH_10:
9496         case NL80211_CHAN_WIDTH_20_NOHT:
9497                 break;
9498         case NL80211_CHAN_WIDTH_20:
9499         case NL80211_CHAN_WIDTH_40:
9500                 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
9501                         return -EINVAL;
9502                 break;
9503         case NL80211_CHAN_WIDTH_80:
9504         case NL80211_CHAN_WIDTH_80P80:
9505         case NL80211_CHAN_WIDTH_160:
9506                 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
9507                         return -EINVAL;
9508                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
9509                                              NL80211_EXT_FEATURE_VHT_IBSS))
9510                         return -EINVAL;
9511                 break;
9512         default:
9513                 return -EINVAL;
9514         }
9515
9516         ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
9517         ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
9518
9519         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
9520                 u8 *rates =
9521                         nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9522                 int n_rates =
9523                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9524                 struct ieee80211_supported_band *sband =
9525                         wiphy->bands[ibss.chandef.chan->band];
9526
9527                 err = ieee80211_get_ratemask(sband, rates, n_rates,
9528                                              &ibss.basic_rates);
9529                 if (err)
9530                         return err;
9531         }
9532
9533         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9534                 memcpy(&ibss.ht_capa_mask,
9535                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9536                        sizeof(ibss.ht_capa_mask));
9537
9538         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9539                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9540                         return -EINVAL;
9541                 memcpy(&ibss.ht_capa,
9542                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9543                        sizeof(ibss.ht_capa));
9544         }
9545
9546         if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
9547             !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
9548                         nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
9549                 return -EINVAL;
9550
9551         if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
9552                 bool no_ht = false;
9553
9554                 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
9555                 if (IS_ERR(connkeys))
9556                         return PTR_ERR(connkeys);
9557
9558                 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
9559                     no_ht) {
9560                         kzfree(connkeys);
9561                         return -EINVAL;
9562                 }
9563         }
9564
9565         ibss.control_port =
9566                 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
9567
9568         if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
9569                 int r = validate_pae_over_nl80211(rdev, info);
9570
9571                 if (r < 0) {
9572                         kzfree(connkeys);
9573                         return r;
9574                 }
9575
9576                 ibss.control_port_over_nl80211 = true;
9577         }
9578
9579         ibss.userspace_handles_dfs =
9580                 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
9581
9582         wdev_lock(dev->ieee80211_ptr);
9583         err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
9584         if (err)
9585                 kzfree(connkeys);
9586         else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
9587                 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9588         wdev_unlock(dev->ieee80211_ptr);
9589
9590         return err;
9591 }
9592
9593 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
9594 {
9595         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9596         struct net_device *dev = info->user_ptr[1];
9597
9598         if (!rdev->ops->leave_ibss)
9599                 return -EOPNOTSUPP;
9600
9601         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
9602                 return -EOPNOTSUPP;
9603
9604         return cfg80211_leave_ibss(rdev, dev, false);
9605 }
9606
9607 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
9608 {
9609         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9610         struct net_device *dev = info->user_ptr[1];
9611         int mcast_rate[NUM_NL80211_BANDS];
9612         u32 nla_rate;
9613         int err;
9614
9615         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
9616             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
9617             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
9618                 return -EOPNOTSUPP;
9619
9620         if (!rdev->ops->set_mcast_rate)
9621                 return -EOPNOTSUPP;
9622
9623         memset(mcast_rate, 0, sizeof(mcast_rate));
9624
9625         if (!info->attrs[NL80211_ATTR_MCAST_RATE])
9626                 return -EINVAL;
9627
9628         nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
9629         if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
9630                 return -EINVAL;
9631
9632         err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
9633
9634         return err;
9635 }
9636
9637 static struct sk_buff *
9638 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
9639                             struct wireless_dev *wdev, int approxlen,
9640                             u32 portid, u32 seq, enum nl80211_commands cmd,
9641                             enum nl80211_attrs attr,
9642                             const struct nl80211_vendor_cmd_info *info,
9643                             gfp_t gfp)
9644 {
9645         struct sk_buff *skb;
9646         void *hdr;
9647         struct nlattr *data;
9648
9649         skb = nlmsg_new(approxlen + 100, gfp);
9650         if (!skb)
9651                 return NULL;
9652
9653         hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
9654         if (!hdr) {
9655                 kfree_skb(skb);
9656                 return NULL;
9657         }
9658
9659         if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
9660                 goto nla_put_failure;
9661
9662         if (info) {
9663                 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
9664                                 info->vendor_id))
9665                         goto nla_put_failure;
9666                 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
9667                                 info->subcmd))
9668                         goto nla_put_failure;
9669         }
9670
9671         if (wdev) {
9672                 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
9673                                       wdev_id(wdev), NL80211_ATTR_PAD))
9674                         goto nla_put_failure;
9675                 if (wdev->netdev &&
9676                     nla_put_u32(skb, NL80211_ATTR_IFINDEX,
9677                                 wdev->netdev->ifindex))
9678                         goto nla_put_failure;
9679         }
9680
9681         data = nla_nest_start_noflag(skb, attr);
9682         if (!data)
9683                 goto nla_put_failure;
9684
9685         ((void **)skb->cb)[0] = rdev;
9686         ((void **)skb->cb)[1] = hdr;
9687         ((void **)skb->cb)[2] = data;
9688
9689         return skb;
9690
9691  nla_put_failure:
9692         kfree_skb(skb);
9693         return NULL;
9694 }
9695
9696 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
9697                                            struct wireless_dev *wdev,
9698                                            enum nl80211_commands cmd,
9699                                            enum nl80211_attrs attr,
9700                                            unsigned int portid,
9701                                            int vendor_event_idx,
9702                                            int approxlen, gfp_t gfp)
9703 {
9704         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
9705         const struct nl80211_vendor_cmd_info *info;
9706
9707         switch (cmd) {
9708         case NL80211_CMD_TESTMODE:
9709                 if (WARN_ON(vendor_event_idx != -1))
9710                         return NULL;
9711                 info = NULL;
9712                 break;
9713         case NL80211_CMD_VENDOR:
9714                 if (WARN_ON(vendor_event_idx < 0 ||
9715                             vendor_event_idx >= wiphy->n_vendor_events))
9716                         return NULL;
9717                 info = &wiphy->vendor_events[vendor_event_idx];
9718                 break;
9719         default:
9720                 WARN_ON(1);
9721                 return NULL;
9722         }
9723
9724         return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0,
9725                                            cmd, attr, info, gfp);
9726 }
9727 EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
9728
9729 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
9730 {
9731         struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
9732         void *hdr = ((void **)skb->cb)[1];
9733         struct nlmsghdr *nlhdr = nlmsg_hdr(skb);
9734         struct nlattr *data = ((void **)skb->cb)[2];
9735         enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
9736
9737         /* clear CB data for netlink core to own from now on */
9738         memset(skb->cb, 0, sizeof(skb->cb));
9739
9740         nla_nest_end(skb, data);
9741         genlmsg_end(skb, hdr);
9742
9743         if (nlhdr->nlmsg_pid) {
9744                 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb,
9745                                 nlhdr->nlmsg_pid);
9746         } else {
9747                 if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
9748                         mcgrp = NL80211_MCGRP_VENDOR;
9749
9750                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
9751                                         skb, 0, mcgrp, gfp);
9752         }
9753 }
9754 EXPORT_SYMBOL(__cfg80211_send_event_skb);
9755
9756 #ifdef CONFIG_NL80211_TESTMODE
9757 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
9758 {
9759         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9760         struct wireless_dev *wdev =
9761                 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
9762         int err;
9763
9764         if (!rdev->ops->testmode_cmd)
9765                 return -EOPNOTSUPP;
9766
9767         if (IS_ERR(wdev)) {
9768                 err = PTR_ERR(wdev);
9769                 if (err != -EINVAL)
9770                         return err;
9771                 wdev = NULL;
9772         } else if (wdev->wiphy != &rdev->wiphy) {
9773                 return -EINVAL;
9774         }
9775
9776         if (!info->attrs[NL80211_ATTR_TESTDATA])
9777                 return -EINVAL;
9778
9779         rdev->cur_cmd_info = info;
9780         err = rdev_testmode_cmd(rdev, wdev,
9781                                 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
9782                                 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
9783         rdev->cur_cmd_info = NULL;
9784
9785         return err;
9786 }
9787
9788 static int nl80211_testmode_dump(struct sk_buff *skb,
9789                                  struct netlink_callback *cb)
9790 {
9791         struct cfg80211_registered_device *rdev;
9792         struct nlattr **attrbuf = NULL;
9793         int err;
9794         long phy_idx;
9795         void *data = NULL;
9796         int data_len = 0;
9797
9798         rtnl_lock();
9799
9800         if (cb->args[0]) {
9801                 /*
9802                  * 0 is a valid index, but not valid for args[0],
9803                  * so we need to offset by 1.
9804                  */
9805                 phy_idx = cb->args[0] - 1;
9806
9807                 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
9808                 if (!rdev) {
9809                         err = -ENOENT;
9810                         goto out_err;
9811                 }
9812         } else {
9813                 attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
9814                                   GFP_KERNEL);
9815                 if (!attrbuf) {
9816                         err = -ENOMEM;
9817                         goto out_err;
9818                 }
9819
9820                 err = nlmsg_parse_deprecated(cb->nlh,
9821                                              GENL_HDRLEN + nl80211_fam.hdrsize,
9822                                              attrbuf, nl80211_fam.maxattr,
9823                                              nl80211_policy, NULL);
9824                 if (err)
9825                         goto out_err;
9826
9827                 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
9828                 if (IS_ERR(rdev)) {
9829                         err = PTR_ERR(rdev);
9830                         goto out_err;
9831                 }
9832                 phy_idx = rdev->wiphy_idx;
9833
9834                 if (attrbuf[NL80211_ATTR_TESTDATA])
9835                         cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
9836         }
9837
9838         if (cb->args[1]) {
9839                 data = nla_data((void *)cb->args[1]);
9840                 data_len = nla_len((void *)cb->args[1]);
9841         }
9842
9843         if (!rdev->ops->testmode_dump) {
9844                 err = -EOPNOTSUPP;
9845                 goto out_err;
9846         }
9847
9848         while (1) {
9849                 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
9850                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
9851                                            NL80211_CMD_TESTMODE);
9852                 struct nlattr *tmdata;
9853
9854                 if (!hdr)
9855                         break;
9856
9857                 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
9858                         genlmsg_cancel(skb, hdr);
9859                         break;
9860                 }
9861
9862                 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA);
9863                 if (!tmdata) {
9864                         genlmsg_cancel(skb, hdr);
9865                         break;
9866                 }
9867                 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
9868                 nla_nest_end(skb, tmdata);
9869
9870                 if (err == -ENOBUFS || err == -ENOENT) {
9871                         genlmsg_cancel(skb, hdr);
9872                         break;
9873                 } else if (err) {
9874                         genlmsg_cancel(skb, hdr);
9875                         goto out_err;
9876                 }
9877
9878                 genlmsg_end(skb, hdr);
9879         }
9880
9881         err = skb->len;
9882         /* see above */
9883         cb->args[0] = phy_idx + 1;
9884  out_err:
9885         kfree(attrbuf);
9886         rtnl_unlock();
9887         return err;
9888 }
9889 #endif
9890
9891 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
9892 {
9893         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9894         struct net_device *dev = info->user_ptr[1];
9895         struct cfg80211_connect_params connect;
9896         struct wiphy *wiphy;
9897         struct cfg80211_cached_keys *connkeys = NULL;
9898         int err;
9899
9900         memset(&connect, 0, sizeof(connect));
9901
9902         if (!info->attrs[NL80211_ATTR_SSID] ||
9903             !nla_len(info->attrs[NL80211_ATTR_SSID]))
9904                 return -EINVAL;
9905
9906         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
9907                 connect.auth_type =
9908                         nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9909                 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
9910                                              NL80211_CMD_CONNECT))
9911                         return -EINVAL;
9912         } else
9913                 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
9914
9915         connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
9916
9917         if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
9918             !wiphy_ext_feature_isset(&rdev->wiphy,
9919                                      NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
9920                 return -EINVAL;
9921         connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
9922
9923         err = nl80211_crypto_settings(rdev, info, &connect.crypto,
9924                                       NL80211_MAX_NR_CIPHER_SUITES);
9925         if (err)
9926                 return err;
9927
9928         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9929             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9930                 return -EOPNOTSUPP;
9931
9932         wiphy = &rdev->wiphy;
9933
9934         connect.bg_scan_period = -1;
9935         if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
9936                 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
9937                 connect.bg_scan_period =
9938                         nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
9939         }
9940
9941         if (info->attrs[NL80211_ATTR_MAC])
9942                 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9943         else if (info->attrs[NL80211_ATTR_MAC_HINT])
9944                 connect.bssid_hint =
9945                         nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
9946         connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9947         connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9948
9949         if (info->attrs[NL80211_ATTR_IE]) {
9950                 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9951                 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9952         }
9953
9954         if (info->attrs[NL80211_ATTR_USE_MFP]) {
9955                 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
9956                 if (connect.mfp == NL80211_MFP_OPTIONAL &&
9957                     !wiphy_ext_feature_isset(&rdev->wiphy,
9958                                              NL80211_EXT_FEATURE_MFP_OPTIONAL))
9959                         return -EOPNOTSUPP;
9960         } else {
9961                 connect.mfp = NL80211_MFP_NO;
9962         }
9963
9964         if (info->attrs[NL80211_ATTR_PREV_BSSID])
9965                 connect.prev_bssid =
9966                         nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
9967
9968         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9969                 connect.channel = nl80211_get_valid_chan(
9970                         wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9971                 if (!connect.channel)
9972                         return -EINVAL;
9973         } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
9974                 connect.channel_hint = nl80211_get_valid_chan(
9975                         wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
9976                 if (!connect.channel_hint)
9977                         return -EINVAL;
9978         }
9979
9980         if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
9981                 connect.edmg.channels =
9982                       nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
9983
9984                 if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
9985                         connect.edmg.bw_config =
9986                                 nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
9987         }
9988
9989         if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
9990                 connkeys = nl80211_parse_connkeys(rdev, info, NULL);
9991                 if (IS_ERR(connkeys))
9992                         return PTR_ERR(connkeys);
9993         }
9994
9995         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
9996                 connect.flags |= ASSOC_REQ_DISABLE_HT;
9997
9998         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9999                 memcpy(&connect.ht_capa_mask,
10000                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
10001                        sizeof(connect.ht_capa_mask));
10002
10003         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
10004                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
10005                         kzfree(connkeys);
10006                         return -EINVAL;
10007                 }
10008                 memcpy(&connect.ht_capa,
10009                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
10010                        sizeof(connect.ht_capa));
10011         }
10012
10013         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
10014                 connect.flags |= ASSOC_REQ_DISABLE_VHT;
10015
10016         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
10017                 memcpy(&connect.vht_capa_mask,
10018                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
10019                        sizeof(connect.vht_capa_mask));
10020
10021         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
10022                 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
10023                         kzfree(connkeys);
10024                         return -EINVAL;
10025                 }
10026                 memcpy(&connect.vht_capa,
10027                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
10028                        sizeof(connect.vht_capa));
10029         }
10030
10031         if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
10032                 if (!((rdev->wiphy.features &
10033                         NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
10034                        (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
10035                     !wiphy_ext_feature_isset(&rdev->wiphy,
10036                                              NL80211_EXT_FEATURE_RRM)) {
10037                         kzfree(connkeys);
10038                         return -EINVAL;
10039                 }
10040                 connect.flags |= ASSOC_REQ_USE_RRM;
10041         }
10042
10043         connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
10044         if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
10045                 kzfree(connkeys);
10046                 return -EOPNOTSUPP;
10047         }
10048
10049         if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
10050                 /* bss selection makes no sense if bssid is set */
10051                 if (connect.bssid) {
10052                         kzfree(connkeys);
10053                         return -EINVAL;
10054                 }
10055
10056                 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
10057                                        wiphy, &connect.bss_select);
10058                 if (err) {
10059                         kzfree(connkeys);
10060                         return err;
10061                 }
10062         }
10063
10064         if (wiphy_ext_feature_isset(&rdev->wiphy,
10065                                     NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
10066             info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
10067             info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
10068             info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
10069             info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10070                 connect.fils_erp_username =
10071                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10072                 connect.fils_erp_username_len =
10073                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10074                 connect.fils_erp_realm =
10075                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10076                 connect.fils_erp_realm_len =
10077                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10078                 connect.fils_erp_next_seq_num =
10079                         nla_get_u16(
10080                            info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
10081                 connect.fils_erp_rrk =
10082                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10083                 connect.fils_erp_rrk_len =
10084                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10085         } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
10086                    info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
10087                    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
10088                    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10089                 kzfree(connkeys);
10090                 return -EINVAL;
10091         }
10092
10093         if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
10094                 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
10095                         kzfree(connkeys);
10096                         GENL_SET_ERR_MSG(info,
10097                                          "external auth requires connection ownership");
10098                         return -EINVAL;
10099                 }
10100                 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
10101         }
10102
10103         wdev_lock(dev->ieee80211_ptr);
10104
10105         err = cfg80211_connect(rdev, dev, &connect, connkeys,
10106                                connect.prev_bssid);
10107         if (err)
10108                 kzfree(connkeys);
10109
10110         if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
10111                 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
10112                 if (connect.bssid)
10113                         memcpy(dev->ieee80211_ptr->disconnect_bssid,
10114                                connect.bssid, ETH_ALEN);
10115                 else
10116                         memset(dev->ieee80211_ptr->disconnect_bssid,
10117                                0, ETH_ALEN);
10118         }
10119
10120         wdev_unlock(dev->ieee80211_ptr);
10121
10122         return err;
10123 }
10124
10125 static int nl80211_update_connect_params(struct sk_buff *skb,
10126                                          struct genl_info *info)
10127 {
10128         struct cfg80211_connect_params connect = {};
10129         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10130         struct net_device *dev = info->user_ptr[1];
10131         struct wireless_dev *wdev = dev->ieee80211_ptr;
10132         bool fils_sk_offload;
10133         u32 auth_type;
10134         u32 changed = 0;
10135         int ret;
10136
10137         if (!rdev->ops->update_connect_params)
10138                 return -EOPNOTSUPP;
10139
10140         if (info->attrs[NL80211_ATTR_IE]) {
10141                 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
10142                 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
10143                 changed |= UPDATE_ASSOC_IES;
10144         }
10145
10146         fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy,
10147                                                   NL80211_EXT_FEATURE_FILS_SK_OFFLOAD);
10148
10149         /*
10150          * when driver supports fils-sk offload all attributes must be
10151          * provided. So the else covers "fils-sk-not-all" and
10152          * "no-fils-sk-any".
10153          */
10154         if (fils_sk_offload &&
10155             info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
10156             info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
10157             info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
10158             info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10159                 connect.fils_erp_username =
10160                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10161                 connect.fils_erp_username_len =
10162                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
10163                 connect.fils_erp_realm =
10164                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10165                 connect.fils_erp_realm_len =
10166                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
10167                 connect.fils_erp_next_seq_num =
10168                         nla_get_u16(
10169                            info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
10170                 connect.fils_erp_rrk =
10171                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10172                 connect.fils_erp_rrk_len =
10173                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
10174                 changed |= UPDATE_FILS_ERP_INFO;
10175         } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
10176                    info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
10177                    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
10178                    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
10179                 return -EINVAL;
10180         }
10181
10182         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
10183                 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
10184                 if (!nl80211_valid_auth_type(rdev, auth_type,
10185                                              NL80211_CMD_CONNECT))
10186                         return -EINVAL;
10187
10188                 if (auth_type == NL80211_AUTHTYPE_FILS_SK &&
10189                     fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO))
10190                         return -EINVAL;
10191
10192                 connect.auth_type = auth_type;
10193                 changed |= UPDATE_AUTH_TYPE;
10194         }
10195
10196         wdev_lock(dev->ieee80211_ptr);
10197         if (!wdev->current_bss)
10198                 ret = -ENOLINK;
10199         else
10200                 ret = rdev_update_connect_params(rdev, dev, &connect, changed);
10201         wdev_unlock(dev->ieee80211_ptr);
10202
10203         return ret;
10204 }
10205
10206 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
10207 {
10208         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10209         struct net_device *dev = info->user_ptr[1];
10210         u16 reason;
10211         int ret;
10212
10213         if (dev->ieee80211_ptr->conn_owner_nlportid &&
10214             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
10215                 return -EPERM;
10216
10217         if (!info->attrs[NL80211_ATTR_REASON_CODE])
10218                 reason = WLAN_REASON_DEAUTH_LEAVING;
10219         else
10220                 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
10221
10222         if (reason == 0)
10223                 return -EINVAL;
10224
10225         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10226             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
10227                 return -EOPNOTSUPP;
10228
10229         wdev_lock(dev->ieee80211_ptr);
10230         ret = cfg80211_disconnect(rdev, dev, reason, true);
10231         wdev_unlock(dev->ieee80211_ptr);
10232         return ret;
10233 }
10234
10235 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
10236 {
10237         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10238         struct net *net;
10239         int err;
10240
10241         if (info->attrs[NL80211_ATTR_PID]) {
10242                 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
10243
10244                 net = get_net_ns_by_pid(pid);
10245         } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
10246                 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
10247
10248                 net = get_net_ns_by_fd(fd);
10249         } else {
10250                 return -EINVAL;
10251         }
10252
10253         if (IS_ERR(net))
10254                 return PTR_ERR(net);
10255
10256         err = 0;
10257
10258         /* check if anything to do */
10259         if (!net_eq(wiphy_net(&rdev->wiphy), net))
10260                 err = cfg80211_switch_netns(rdev, net);
10261
10262         put_net(net);
10263         return err;
10264 }
10265
10266 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
10267 {
10268         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10269         int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
10270                         struct cfg80211_pmksa *pmksa) = NULL;
10271         struct net_device *dev = info->user_ptr[1];
10272         struct cfg80211_pmksa pmksa;
10273
10274         memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
10275
10276         if (!info->attrs[NL80211_ATTR_PMKID])
10277                 return -EINVAL;
10278
10279         pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
10280
10281         if (info->attrs[NL80211_ATTR_MAC]) {
10282                 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
10283         } else if (info->attrs[NL80211_ATTR_SSID] &&
10284                    info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
10285                    (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
10286                     info->attrs[NL80211_ATTR_PMK])) {
10287                 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
10288                 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
10289                 pmksa.cache_id =
10290                         nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
10291         } else {
10292                 return -EINVAL;
10293         }
10294         if (info->attrs[NL80211_ATTR_PMK]) {
10295                 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
10296                 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
10297         }
10298
10299         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10300             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
10301             !(dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP &&
10302               wiphy_ext_feature_isset(&rdev->wiphy,
10303                                       NL80211_EXT_FEATURE_AP_PMKSA_CACHING)))
10304                 return -EOPNOTSUPP;
10305
10306         switch (info->genlhdr->cmd) {
10307         case NL80211_CMD_SET_PMKSA:
10308                 rdev_ops = rdev->ops->set_pmksa;
10309                 break;
10310         case NL80211_CMD_DEL_PMKSA:
10311                 rdev_ops = rdev->ops->del_pmksa;
10312                 break;
10313         default:
10314                 WARN_ON(1);
10315                 break;
10316         }
10317
10318         if (!rdev_ops)
10319                 return -EOPNOTSUPP;
10320
10321         return rdev_ops(&rdev->wiphy, dev, &pmksa);
10322 }
10323
10324 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
10325 {
10326         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10327         struct net_device *dev = info->user_ptr[1];
10328
10329         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10330             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
10331                 return -EOPNOTSUPP;
10332
10333         if (!rdev->ops->flush_pmksa)
10334                 return -EOPNOTSUPP;
10335
10336         return rdev_flush_pmksa(rdev, dev);
10337 }
10338
10339 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
10340 {
10341         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10342         struct net_device *dev = info->user_ptr[1];
10343         u8 action_code, dialog_token;
10344         u32 peer_capability = 0;
10345         u16 status_code;
10346         u8 *peer;
10347         bool initiator;
10348
10349         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
10350             !rdev->ops->tdls_mgmt)
10351                 return -EOPNOTSUPP;
10352
10353         if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
10354             !info->attrs[NL80211_ATTR_STATUS_CODE] ||
10355             !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
10356             !info->attrs[NL80211_ATTR_IE] ||
10357             !info->attrs[NL80211_ATTR_MAC])
10358                 return -EINVAL;
10359
10360         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
10361         action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
10362         status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
10363         dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
10364         initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
10365         if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
10366                 peer_capability =
10367                         nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
10368
10369         return rdev_tdls_mgmt(rdev, dev, peer, action_code,
10370                               dialog_token, status_code, peer_capability,
10371                               initiator,
10372                               nla_data(info->attrs[NL80211_ATTR_IE]),
10373                               nla_len(info->attrs[NL80211_ATTR_IE]));
10374 }
10375
10376 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
10377 {
10378         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10379         struct net_device *dev = info->user_ptr[1];
10380         enum nl80211_tdls_operation operation;
10381         u8 *peer;
10382
10383         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
10384             !rdev->ops->tdls_oper)
10385                 return -EOPNOTSUPP;
10386
10387         if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
10388             !info->attrs[NL80211_ATTR_MAC])
10389                 return -EINVAL;
10390
10391         operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
10392         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
10393
10394         return rdev_tdls_oper(rdev, dev, peer, operation);
10395 }
10396
10397 static int nl80211_remain_on_channel(struct sk_buff *skb,
10398                                      struct genl_info *info)
10399 {
10400         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10401         struct wireless_dev *wdev = info->user_ptr[1];
10402         struct cfg80211_chan_def chandef;
10403         const struct cfg80211_chan_def *compat_chandef;
10404         struct sk_buff *msg;
10405         void *hdr;
10406         u64 cookie;
10407         u32 duration;
10408         int err;
10409
10410         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
10411             !info->attrs[NL80211_ATTR_DURATION])
10412                 return -EINVAL;
10413
10414         duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
10415
10416         if (!rdev->ops->remain_on_channel ||
10417             !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
10418                 return -EOPNOTSUPP;
10419
10420         /*
10421          * We should be on that channel for at least a minimum amount of
10422          * time (10ms) but no longer than the driver supports.
10423          */
10424         if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
10425             duration > rdev->wiphy.max_remain_on_channel_duration)
10426                 return -EINVAL;
10427
10428         err = nl80211_parse_chandef(rdev, info, &chandef);
10429         if (err)
10430                 return err;
10431
10432         wdev_lock(wdev);
10433         if (!cfg80211_off_channel_oper_allowed(wdev) &&
10434             !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
10435                 compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
10436                                                              &chandef);
10437                 if (compat_chandef != &chandef) {
10438                         wdev_unlock(wdev);
10439                         return -EBUSY;
10440                 }
10441         }
10442         wdev_unlock(wdev);
10443
10444         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10445         if (!msg)
10446                 return -ENOMEM;
10447
10448         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10449                              NL80211_CMD_REMAIN_ON_CHANNEL);
10450         if (!hdr) {
10451                 err = -ENOBUFS;
10452                 goto free_msg;
10453         }
10454
10455         err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
10456                                      duration, &cookie);
10457
10458         if (err)
10459                 goto free_msg;
10460
10461         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10462                               NL80211_ATTR_PAD))
10463                 goto nla_put_failure;
10464
10465         genlmsg_end(msg, hdr);
10466
10467         return genlmsg_reply(msg, info);
10468
10469  nla_put_failure:
10470         err = -ENOBUFS;
10471  free_msg:
10472         nlmsg_free(msg);
10473         return err;
10474 }
10475
10476 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
10477                                             struct genl_info *info)
10478 {
10479         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10480         struct wireless_dev *wdev = info->user_ptr[1];
10481         u64 cookie;
10482
10483         if (!info->attrs[NL80211_ATTR_COOKIE])
10484                 return -EINVAL;
10485
10486         if (!rdev->ops->cancel_remain_on_channel)
10487                 return -EOPNOTSUPP;
10488
10489         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10490
10491         return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
10492 }
10493
10494 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
10495                                        struct genl_info *info)
10496 {
10497         struct cfg80211_bitrate_mask mask;
10498         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10499         struct net_device *dev = info->user_ptr[1];
10500         int err;
10501
10502         if (!rdev->ops->set_bitrate_mask)
10503                 return -EOPNOTSUPP;
10504
10505         err = nl80211_parse_tx_bitrate_mask(info, &mask);
10506         if (err)
10507                 return err;
10508
10509         return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
10510 }
10511
10512 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
10513 {
10514         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10515         struct wireless_dev *wdev = info->user_ptr[1];
10516         u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
10517
10518         if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
10519                 return -EINVAL;
10520
10521         if (info->attrs[NL80211_ATTR_FRAME_TYPE])
10522                 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
10523
10524         switch (wdev->iftype) {
10525         case NL80211_IFTYPE_STATION:
10526         case NL80211_IFTYPE_ADHOC:
10527         case NL80211_IFTYPE_P2P_CLIENT:
10528         case NL80211_IFTYPE_AP:
10529         case NL80211_IFTYPE_AP_VLAN:
10530         case NL80211_IFTYPE_MESH_POINT:
10531         case NL80211_IFTYPE_P2P_GO:
10532         case NL80211_IFTYPE_P2P_DEVICE:
10533                 break;
10534         case NL80211_IFTYPE_NAN:
10535         default:
10536                 return -EOPNOTSUPP;
10537         }
10538
10539         /* not much point in registering if we can't reply */
10540         if (!rdev->ops->mgmt_tx)
10541                 return -EOPNOTSUPP;
10542
10543         return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
10544                         nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
10545                         nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
10546 }
10547
10548 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
10549 {
10550         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10551         struct wireless_dev *wdev = info->user_ptr[1];
10552         struct cfg80211_chan_def chandef;
10553         int err;
10554         void *hdr = NULL;
10555         u64 cookie;
10556         struct sk_buff *msg = NULL;
10557         struct cfg80211_mgmt_tx_params params = {
10558                 .dont_wait_for_ack =
10559                         info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
10560         };
10561
10562         if (!info->attrs[NL80211_ATTR_FRAME])
10563                 return -EINVAL;
10564
10565         if (!rdev->ops->mgmt_tx)
10566                 return -EOPNOTSUPP;
10567
10568         switch (wdev->iftype) {
10569         case NL80211_IFTYPE_P2P_DEVICE:
10570                 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
10571                         return -EINVAL;
10572         case NL80211_IFTYPE_STATION:
10573         case NL80211_IFTYPE_ADHOC:
10574         case NL80211_IFTYPE_P2P_CLIENT:
10575         case NL80211_IFTYPE_AP:
10576         case NL80211_IFTYPE_AP_VLAN:
10577         case NL80211_IFTYPE_MESH_POINT:
10578         case NL80211_IFTYPE_P2P_GO:
10579                 break;
10580         case NL80211_IFTYPE_NAN:
10581         default:
10582                 return -EOPNOTSUPP;
10583         }
10584
10585         if (info->attrs[NL80211_ATTR_DURATION]) {
10586                 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
10587                         return -EINVAL;
10588                 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
10589
10590                 /*
10591                  * We should wait on the channel for at least a minimum amount
10592                  * of time (10ms) but no longer than the driver supports.
10593                  */
10594                 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
10595                     params.wait > rdev->wiphy.max_remain_on_channel_duration)
10596                         return -EINVAL;
10597         }
10598
10599         params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
10600
10601         if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
10602                 return -EINVAL;
10603
10604         params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
10605
10606         /* get the channel if any has been specified, otherwise pass NULL to
10607          * the driver. The latter will use the current one
10608          */
10609         chandef.chan = NULL;
10610         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
10611                 err = nl80211_parse_chandef(rdev, info, &chandef);
10612                 if (err)
10613                         return err;
10614         }
10615
10616         if (!chandef.chan && params.offchan)
10617                 return -EINVAL;
10618
10619         wdev_lock(wdev);
10620         if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
10621                 wdev_unlock(wdev);
10622                 return -EBUSY;
10623         }
10624         wdev_unlock(wdev);
10625
10626         params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
10627         params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
10628
10629         if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
10630                 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
10631                 int i;
10632
10633                 if (len % sizeof(u16))
10634                         return -EINVAL;
10635
10636                 params.n_csa_offsets = len / sizeof(u16);
10637                 params.csa_offsets =
10638                         nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
10639
10640                 /* check that all the offsets fit the frame */
10641                 for (i = 0; i < params.n_csa_offsets; i++) {
10642                         if (params.csa_offsets[i] >= params.len)
10643                                 return -EINVAL;
10644                 }
10645         }
10646
10647         if (!params.dont_wait_for_ack) {
10648                 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10649                 if (!msg)
10650                         return -ENOMEM;
10651
10652                 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10653                                      NL80211_CMD_FRAME);
10654                 if (!hdr) {
10655                         err = -ENOBUFS;
10656                         goto free_msg;
10657                 }
10658         }
10659
10660         params.chan = chandef.chan;
10661         err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
10662         if (err)
10663                 goto free_msg;
10664
10665         if (msg) {
10666                 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10667                                       NL80211_ATTR_PAD))
10668                         goto nla_put_failure;
10669
10670                 genlmsg_end(msg, hdr);
10671                 return genlmsg_reply(msg, info);
10672         }
10673
10674         return 0;
10675
10676  nla_put_failure:
10677         err = -ENOBUFS;
10678  free_msg:
10679         nlmsg_free(msg);
10680         return err;
10681 }
10682
10683 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
10684 {
10685         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10686         struct wireless_dev *wdev = info->user_ptr[1];
10687         u64 cookie;
10688
10689         if (!info->attrs[NL80211_ATTR_COOKIE])
10690                 return -EINVAL;
10691
10692         if (!rdev->ops->mgmt_tx_cancel_wait)
10693                 return -EOPNOTSUPP;
10694
10695         switch (wdev->iftype) {
10696         case NL80211_IFTYPE_STATION:
10697         case NL80211_IFTYPE_ADHOC:
10698         case NL80211_IFTYPE_P2P_CLIENT:
10699         case NL80211_IFTYPE_AP:
10700         case NL80211_IFTYPE_AP_VLAN:
10701         case NL80211_IFTYPE_P2P_GO:
10702         case NL80211_IFTYPE_P2P_DEVICE:
10703                 break;
10704         case NL80211_IFTYPE_NAN:
10705         default:
10706                 return -EOPNOTSUPP;
10707         }
10708
10709         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10710
10711         return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
10712 }
10713
10714 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
10715 {
10716         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10717         struct wireless_dev *wdev;
10718         struct net_device *dev = info->user_ptr[1];
10719         u8 ps_state;
10720         bool state;
10721         int err;
10722
10723         if (!info->attrs[NL80211_ATTR_PS_STATE])
10724                 return -EINVAL;
10725
10726         ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
10727
10728         wdev = dev->ieee80211_ptr;
10729
10730         if (!rdev->ops->set_power_mgmt)
10731                 return -EOPNOTSUPP;
10732
10733         state = (ps_state == NL80211_PS_ENABLED) ? true : false;
10734
10735         if (state == wdev->ps)
10736                 return 0;
10737
10738         err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
10739         if (!err)
10740                 wdev->ps = state;
10741         return err;
10742 }
10743
10744 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
10745 {
10746         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10747         enum nl80211_ps_state ps_state;
10748         struct wireless_dev *wdev;
10749         struct net_device *dev = info->user_ptr[1];
10750         struct sk_buff *msg;
10751         void *hdr;
10752         int err;
10753
10754         wdev = dev->ieee80211_ptr;
10755
10756         if (!rdev->ops->set_power_mgmt)
10757                 return -EOPNOTSUPP;
10758
10759         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10760         if (!msg)
10761                 return -ENOMEM;
10762
10763         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10764                              NL80211_CMD_GET_POWER_SAVE);
10765         if (!hdr) {
10766                 err = -ENOBUFS;
10767                 goto free_msg;
10768         }
10769
10770         if (wdev->ps)
10771                 ps_state = NL80211_PS_ENABLED;
10772         else
10773                 ps_state = NL80211_PS_DISABLED;
10774
10775         if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
10776                 goto nla_put_failure;
10777
10778         genlmsg_end(msg, hdr);
10779         return genlmsg_reply(msg, info);
10780
10781  nla_put_failure:
10782         err = -ENOBUFS;
10783  free_msg:
10784         nlmsg_free(msg);
10785         return err;
10786 }
10787
10788 static const struct nla_policy
10789 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
10790         [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
10791         [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
10792         [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
10793         [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
10794         [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
10795         [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
10796         [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
10797 };
10798
10799 static int nl80211_set_cqm_txe(struct genl_info *info,
10800                                u32 rate, u32 pkts, u32 intvl)
10801 {
10802         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10803         struct net_device *dev = info->user_ptr[1];
10804         struct wireless_dev *wdev = dev->ieee80211_ptr;
10805
10806         if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
10807                 return -EINVAL;
10808
10809         if (!rdev->ops->set_cqm_txe_config)
10810                 return -EOPNOTSUPP;
10811
10812         if (wdev->iftype != NL80211_IFTYPE_STATION &&
10813             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
10814                 return -EOPNOTSUPP;
10815
10816         return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
10817 }
10818
10819 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
10820                                     struct net_device *dev)
10821 {
10822         struct wireless_dev *wdev = dev->ieee80211_ptr;
10823         s32 last, low, high;
10824         u32 hyst;
10825         int i, n, low_index;
10826         int err;
10827
10828         /* RSSI reporting disabled? */
10829         if (!wdev->cqm_config)
10830                 return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
10831
10832         /*
10833          * Obtain current RSSI value if possible, if not and no RSSI threshold
10834          * event has been received yet, we should receive an event after a
10835          * connection is established and enough beacons received to calculate
10836          * the average.
10837          */
10838         if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
10839             rdev->ops->get_station) {
10840                 struct station_info sinfo = {};
10841                 u8 *mac_addr;
10842
10843                 mac_addr = wdev->current_bss->pub.bssid;
10844
10845                 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
10846                 if (err)
10847                         return err;
10848
10849                 cfg80211_sinfo_release_content(&sinfo);
10850                 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
10851                         wdev->cqm_config->last_rssi_event_value =
10852                                 (s8) sinfo.rx_beacon_signal_avg;
10853         }
10854
10855         last = wdev->cqm_config->last_rssi_event_value;
10856         hyst = wdev->cqm_config->rssi_hyst;
10857         n = wdev->cqm_config->n_rssi_thresholds;
10858
10859         for (i = 0; i < n; i++) {
10860                 i = array_index_nospec(i, n);
10861                 if (last < wdev->cqm_config->rssi_thresholds[i])
10862                         break;
10863         }
10864
10865         low_index = i - 1;
10866         if (low_index >= 0) {
10867                 low_index = array_index_nospec(low_index, n);
10868                 low = wdev->cqm_config->rssi_thresholds[low_index] - hyst;
10869         } else {
10870                 low = S32_MIN;
10871         }
10872         if (i < n) {
10873                 i = array_index_nospec(i, n);
10874                 high = wdev->cqm_config->rssi_thresholds[i] + hyst - 1;
10875         } else {
10876                 high = S32_MAX;
10877         }
10878
10879         return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
10880 }
10881
10882 static int nl80211_set_cqm_rssi(struct genl_info *info,
10883                                 const s32 *thresholds, int n_thresholds,
10884                                 u32 hysteresis)
10885 {
10886         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10887         struct net_device *dev = info->user_ptr[1];
10888         struct wireless_dev *wdev = dev->ieee80211_ptr;
10889         int i, err;
10890         s32 prev = S32_MIN;
10891
10892         /* Check all values negative and sorted */
10893         for (i = 0; i < n_thresholds; i++) {
10894                 if (thresholds[i] > 0 || thresholds[i] <= prev)
10895                         return -EINVAL;
10896
10897                 prev = thresholds[i];
10898         }
10899
10900         if (wdev->iftype != NL80211_IFTYPE_STATION &&
10901             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
10902                 return -EOPNOTSUPP;
10903
10904         wdev_lock(wdev);
10905         cfg80211_cqm_config_free(wdev);
10906         wdev_unlock(wdev);
10907
10908         if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
10909                 if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
10910                         return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
10911
10912                 return rdev_set_cqm_rssi_config(rdev, dev,
10913                                                 thresholds[0], hysteresis);
10914         }
10915
10916         if (!wiphy_ext_feature_isset(&rdev->wiphy,
10917                                      NL80211_EXT_FEATURE_CQM_RSSI_LIST))
10918                 return -EOPNOTSUPP;
10919
10920         if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
10921                 n_thresholds = 0;
10922
10923         wdev_lock(wdev);
10924         if (n_thresholds) {
10925                 struct cfg80211_cqm_config *cqm_config;
10926
10927                 cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
10928                                      n_thresholds * sizeof(s32), GFP_KERNEL);
10929                 if (!cqm_config) {
10930                         err = -ENOMEM;
10931                         goto unlock;
10932                 }
10933
10934                 cqm_config->rssi_hyst = hysteresis;
10935                 cqm_config->n_rssi_thresholds = n_thresholds;
10936                 memcpy(cqm_config->rssi_thresholds, thresholds,
10937                        n_thresholds * sizeof(s32));
10938
10939                 wdev->cqm_config = cqm_config;
10940         }
10941
10942         err = cfg80211_cqm_rssi_update(rdev, dev);
10943
10944 unlock:
10945         wdev_unlock(wdev);
10946
10947         return err;
10948 }
10949
10950 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
10951 {
10952         struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
10953         struct nlattr *cqm;
10954         int err;
10955
10956         cqm = info->attrs[NL80211_ATTR_CQM];
10957         if (!cqm)
10958                 return -EINVAL;
10959
10960         err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm,
10961                                           nl80211_attr_cqm_policy,
10962                                           info->extack);
10963         if (err)
10964                 return err;
10965
10966         if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
10967             attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
10968                 const s32 *thresholds =
10969                         nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
10970                 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
10971                 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
10972
10973                 if (len % 4)
10974                         return -EINVAL;
10975
10976                 return nl80211_set_cqm_rssi(info, thresholds, len / 4,
10977                                             hysteresis);
10978         }
10979
10980         if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
10981             attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
10982             attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
10983                 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
10984                 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
10985                 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
10986
10987                 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
10988         }
10989
10990         return -EINVAL;
10991 }
10992
10993 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
10994 {
10995         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10996         struct net_device *dev = info->user_ptr[1];
10997         struct ocb_setup setup = {};
10998         int err;
10999
11000         err = nl80211_parse_chandef(rdev, info, &setup.chandef);
11001         if (err)
11002                 return err;
11003
11004         return cfg80211_join_ocb(rdev, dev, &setup);
11005 }
11006
11007 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
11008 {
11009         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11010         struct net_device *dev = info->user_ptr[1];
11011
11012         return cfg80211_leave_ocb(rdev, dev);
11013 }
11014
11015 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
11016 {
11017         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11018         struct net_device *dev = info->user_ptr[1];
11019         struct mesh_config cfg;
11020         struct mesh_setup setup;
11021         int err;
11022
11023         /* start with default */
11024         memcpy(&cfg, &default_mesh_config, sizeof(cfg));
11025         memcpy(&setup, &default_mesh_setup, sizeof(setup));
11026
11027         if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
11028                 /* and parse parameters if given */
11029                 err = nl80211_parse_mesh_config(info, &cfg, NULL);
11030                 if (err)
11031                         return err;
11032         }
11033
11034         if (!info->attrs[NL80211_ATTR_MESH_ID] ||
11035             !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
11036                 return -EINVAL;
11037
11038         setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
11039         setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
11040
11041         if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
11042             !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
11043                             nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
11044                         return -EINVAL;
11045
11046         if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
11047                 setup.beacon_interval =
11048                         nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
11049
11050                 err = cfg80211_validate_beacon_int(rdev,
11051                                                    NL80211_IFTYPE_MESH_POINT,
11052                                                    setup.beacon_interval);
11053                 if (err)
11054                         return err;
11055         }
11056
11057         if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
11058                 setup.dtim_period =
11059                         nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
11060                 if (setup.dtim_period < 1 || setup.dtim_period > 100)
11061                         return -EINVAL;
11062         }
11063
11064         if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
11065                 /* parse additional setup parameters if given */
11066                 err = nl80211_parse_mesh_setup(info, &setup);
11067                 if (err)
11068                         return err;
11069         }
11070
11071         if (setup.user_mpm)
11072                 cfg.auto_open_plinks = false;
11073
11074         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
11075                 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
11076                 if (err)
11077                         return err;
11078         } else {
11079                 /* __cfg80211_join_mesh() will sort it out */
11080                 setup.chandef.chan = NULL;
11081         }
11082
11083         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
11084                 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
11085                 int n_rates =
11086                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
11087                 struct ieee80211_supported_band *sband;
11088
11089                 if (!setup.chandef.chan)
11090                         return -EINVAL;
11091
11092                 sband = rdev->wiphy.bands[setup.chandef.chan->band];
11093
11094                 err = ieee80211_get_ratemask(sband, rates, n_rates,
11095                                              &setup.basic_rates);
11096                 if (err)
11097                         return err;
11098         }
11099
11100         if (info->attrs[NL80211_ATTR_TX_RATES]) {
11101                 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
11102                 if (err)
11103                         return err;
11104
11105                 if (!setup.chandef.chan)
11106                         return -EINVAL;
11107
11108                 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
11109                                               &setup.beacon_rate);
11110                 if (err)
11111                         return err;
11112         }
11113
11114         setup.userspace_handles_dfs =
11115                 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
11116
11117         if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
11118                 int r = validate_pae_over_nl80211(rdev, info);
11119
11120                 if (r < 0)
11121                         return r;
11122
11123                 setup.control_port_over_nl80211 = true;
11124         }
11125
11126         wdev_lock(dev->ieee80211_ptr);
11127         err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
11128         if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
11129                 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
11130         wdev_unlock(dev->ieee80211_ptr);
11131
11132         return err;
11133 }
11134
11135 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
11136 {
11137         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11138         struct net_device *dev = info->user_ptr[1];
11139
11140         return cfg80211_leave_mesh(rdev, dev);
11141 }
11142
11143 #ifdef CONFIG_PM
11144 static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
11145                                         struct cfg80211_registered_device *rdev)
11146 {
11147         struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
11148         struct nlattr *nl_pats, *nl_pat;
11149         int i, pat_len;
11150
11151         if (!wowlan->n_patterns)
11152                 return 0;
11153
11154         nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
11155         if (!nl_pats)
11156                 return -ENOBUFS;
11157
11158         for (i = 0; i < wowlan->n_patterns; i++) {
11159                 nl_pat = nla_nest_start_noflag(msg, i + 1);
11160                 if (!nl_pat)
11161                         return -ENOBUFS;
11162                 pat_len = wowlan->patterns[i].pattern_len;
11163                 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
11164                             wowlan->patterns[i].mask) ||
11165                     nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
11166                             wowlan->patterns[i].pattern) ||
11167                     nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
11168                                 wowlan->patterns[i].pkt_offset))
11169                         return -ENOBUFS;
11170                 nla_nest_end(msg, nl_pat);
11171         }
11172         nla_nest_end(msg, nl_pats);
11173
11174         return 0;
11175 }
11176
11177 static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
11178                                    struct cfg80211_wowlan_tcp *tcp)
11179 {
11180         struct nlattr *nl_tcp;
11181
11182         if (!tcp)
11183                 return 0;
11184
11185         nl_tcp = nla_nest_start_noflag(msg,
11186                                        NL80211_WOWLAN_TRIG_TCP_CONNECTION);
11187         if (!nl_tcp)
11188                 return -ENOBUFS;
11189
11190         if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
11191             nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
11192             nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
11193             nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
11194             nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
11195             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
11196                     tcp->payload_len, tcp->payload) ||
11197             nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
11198                         tcp->data_interval) ||
11199             nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
11200                     tcp->wake_len, tcp->wake_data) ||
11201             nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
11202                     DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
11203                 return -ENOBUFS;
11204
11205         if (tcp->payload_seq.len &&
11206             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
11207                     sizeof(tcp->payload_seq), &tcp->payload_seq))
11208                 return -ENOBUFS;
11209
11210         if (tcp->payload_tok.len &&
11211             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
11212                     sizeof(tcp->payload_tok) + tcp->tokens_size,
11213                     &tcp->payload_tok))
11214                 return -ENOBUFS;
11215
11216         nla_nest_end(msg, nl_tcp);
11217
11218         return 0;
11219 }
11220
11221 static int nl80211_send_wowlan_nd(struct sk_buff *msg,
11222                                   struct cfg80211_sched_scan_request *req)
11223 {
11224         struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
11225         int i;
11226
11227         if (!req)
11228                 return 0;
11229
11230         nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
11231         if (!nd)
11232                 return -ENOBUFS;
11233
11234         if (req->n_scan_plans == 1 &&
11235             nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
11236                         req->scan_plans[0].interval * 1000))
11237                 return -ENOBUFS;
11238
11239         if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
11240                 return -ENOBUFS;
11241
11242         if (req->relative_rssi_set) {
11243                 struct nl80211_bss_select_rssi_adjust rssi_adjust;
11244
11245                 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
11246                                req->relative_rssi))
11247                         return -ENOBUFS;
11248
11249                 rssi_adjust.band = req->rssi_adjust.band;
11250                 rssi_adjust.delta = req->rssi_adjust.delta;
11251                 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
11252                             sizeof(rssi_adjust), &rssi_adjust))
11253                         return -ENOBUFS;
11254         }
11255
11256         freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
11257         if (!freqs)
11258                 return -ENOBUFS;
11259
11260         for (i = 0; i < req->n_channels; i++) {
11261                 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
11262                         return -ENOBUFS;
11263         }
11264
11265         nla_nest_end(msg, freqs);
11266
11267         if (req->n_match_sets) {
11268                 matches = nla_nest_start_noflag(msg,
11269                                                 NL80211_ATTR_SCHED_SCAN_MATCH);
11270                 if (!matches)
11271                         return -ENOBUFS;
11272
11273                 for (i = 0; i < req->n_match_sets; i++) {
11274                         match = nla_nest_start_noflag(msg, i);
11275                         if (!match)
11276                                 return -ENOBUFS;
11277
11278                         if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
11279                                     req->match_sets[i].ssid.ssid_len,
11280                                     req->match_sets[i].ssid.ssid))
11281                                 return -ENOBUFS;
11282                         nla_nest_end(msg, match);
11283                 }
11284                 nla_nest_end(msg, matches);
11285         }
11286
11287         scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
11288         if (!scan_plans)
11289                 return -ENOBUFS;
11290
11291         for (i = 0; i < req->n_scan_plans; i++) {
11292                 scan_plan = nla_nest_start_noflag(msg, i + 1);
11293                 if (!scan_plan)
11294                         return -ENOBUFS;
11295
11296                 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
11297                                 req->scan_plans[i].interval) ||
11298                     (req->scan_plans[i].iterations &&
11299                      nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
11300                                  req->scan_plans[i].iterations)))
11301                         return -ENOBUFS;
11302                 nla_nest_end(msg, scan_plan);
11303         }
11304         nla_nest_end(msg, scan_plans);
11305
11306         nla_nest_end(msg, nd);
11307
11308         return 0;
11309 }
11310
11311 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
11312 {
11313         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11314         struct sk_buff *msg;
11315         void *hdr;
11316         u32 size = NLMSG_DEFAULT_SIZE;
11317
11318         if (!rdev->wiphy.wowlan)
11319                 return -EOPNOTSUPP;
11320
11321         if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
11322                 /* adjust size to have room for all the data */
11323                 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
11324                         rdev->wiphy.wowlan_config->tcp->payload_len +
11325                         rdev->wiphy.wowlan_config->tcp->wake_len +
11326                         rdev->wiphy.wowlan_config->tcp->wake_len / 8;
11327         }
11328
11329         msg = nlmsg_new(size, GFP_KERNEL);
11330         if (!msg)
11331                 return -ENOMEM;
11332
11333         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11334                              NL80211_CMD_GET_WOWLAN);
11335         if (!hdr)
11336                 goto nla_put_failure;
11337
11338         if (rdev->wiphy.wowlan_config) {
11339                 struct nlattr *nl_wowlan;
11340
11341                 nl_wowlan = nla_nest_start_noflag(msg,
11342                                                   NL80211_ATTR_WOWLAN_TRIGGERS);
11343                 if (!nl_wowlan)
11344                         goto nla_put_failure;
11345
11346                 if ((rdev->wiphy.wowlan_config->any &&
11347                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
11348                     (rdev->wiphy.wowlan_config->disconnect &&
11349                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
11350                     (rdev->wiphy.wowlan_config->magic_pkt &&
11351                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
11352                     (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
11353                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
11354                     (rdev->wiphy.wowlan_config->eap_identity_req &&
11355                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
11356                     (rdev->wiphy.wowlan_config->four_way_handshake &&
11357                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
11358                     (rdev->wiphy.wowlan_config->rfkill_release &&
11359                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
11360                         goto nla_put_failure;
11361
11362                 if (nl80211_send_wowlan_patterns(msg, rdev))
11363                         goto nla_put_failure;
11364
11365                 if (nl80211_send_wowlan_tcp(msg,
11366                                             rdev->wiphy.wowlan_config->tcp))
11367                         goto nla_put_failure;
11368
11369                 if (nl80211_send_wowlan_nd(
11370                             msg,
11371                             rdev->wiphy.wowlan_config->nd_config))
11372                         goto nla_put_failure;
11373
11374                 nla_nest_end(msg, nl_wowlan);
11375         }
11376
11377         genlmsg_end(msg, hdr);
11378         return genlmsg_reply(msg, info);
11379
11380 nla_put_failure:
11381         nlmsg_free(msg);
11382         return -ENOBUFS;
11383 }
11384
11385 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
11386                                     struct nlattr *attr,
11387                                     struct cfg80211_wowlan *trig)
11388 {
11389         struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
11390         struct cfg80211_wowlan_tcp *cfg;
11391         struct nl80211_wowlan_tcp_data_token *tok = NULL;
11392         struct nl80211_wowlan_tcp_data_seq *seq = NULL;
11393         u32 size;
11394         u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
11395         int err, port;
11396
11397         if (!rdev->wiphy.wowlan->tcp)
11398                 return -EINVAL;
11399
11400         err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr,
11401                                           nl80211_wowlan_tcp_policy, NULL);
11402         if (err)
11403                 return err;
11404
11405         if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
11406             !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
11407             !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
11408             !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
11409             !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
11410             !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
11411             !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
11412             !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
11413                 return -EINVAL;
11414
11415         data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
11416         if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
11417                 return -EINVAL;
11418
11419         if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
11420                         rdev->wiphy.wowlan->tcp->data_interval_max ||
11421             nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
11422                 return -EINVAL;
11423
11424         wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
11425         if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
11426                 return -EINVAL;
11427
11428         wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
11429         if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
11430                 return -EINVAL;
11431
11432         if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
11433                 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
11434
11435                 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
11436                 tokens_size = tokln - sizeof(*tok);
11437
11438                 if (!tok->len || tokens_size % tok->len)
11439                         return -EINVAL;
11440                 if (!rdev->wiphy.wowlan->tcp->tok)
11441                         return -EINVAL;
11442                 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
11443                         return -EINVAL;
11444                 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
11445                         return -EINVAL;
11446                 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
11447                         return -EINVAL;
11448                 if (tok->offset + tok->len > data_size)
11449                         return -EINVAL;
11450         }
11451
11452         if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
11453                 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
11454                 if (!rdev->wiphy.wowlan->tcp->seq)
11455                         return -EINVAL;
11456                 if (seq->len == 0 || seq->len > 4)
11457                         return -EINVAL;
11458                 if (seq->len + seq->offset > data_size)
11459                         return -EINVAL;
11460         }
11461
11462         size = sizeof(*cfg);
11463         size += data_size;
11464         size += wake_size + wake_mask_size;
11465         size += tokens_size;
11466
11467         cfg = kzalloc(size, GFP_KERNEL);
11468         if (!cfg)
11469                 return -ENOMEM;
11470         cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
11471         cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
11472         memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
11473                ETH_ALEN);
11474         if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
11475                 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
11476         else
11477                 port = 0;
11478 #ifdef CONFIG_INET
11479         /* allocate a socket and port for it and use it */
11480         err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
11481                             IPPROTO_TCP, &cfg->sock, 1);
11482         if (err) {
11483                 kfree(cfg);
11484                 return err;
11485         }
11486         if (inet_csk_get_port(cfg->sock->sk, port)) {
11487                 sock_release(cfg->sock);
11488                 kfree(cfg);
11489                 return -EADDRINUSE;
11490         }
11491         cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
11492 #else
11493         if (!port) {
11494                 kfree(cfg);
11495                 return -EINVAL;
11496         }
11497         cfg->src_port = port;
11498 #endif
11499
11500         cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
11501         cfg->payload_len = data_size;
11502         cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
11503         memcpy((void *)cfg->payload,
11504                nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
11505                data_size);
11506         if (seq)
11507                 cfg->payload_seq = *seq;
11508         cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
11509         cfg->wake_len = wake_size;
11510         cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
11511         memcpy((void *)cfg->wake_data,
11512                nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
11513                wake_size);
11514         cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
11515                          data_size + wake_size;
11516         memcpy((void *)cfg->wake_mask,
11517                nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
11518                wake_mask_size);
11519         if (tok) {
11520                 cfg->tokens_size = tokens_size;
11521                 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
11522         }
11523
11524         trig->tcp = cfg;
11525
11526         return 0;
11527 }
11528
11529 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
11530                                    const struct wiphy_wowlan_support *wowlan,
11531                                    struct nlattr *attr,
11532                                    struct cfg80211_wowlan *trig)
11533 {
11534         struct nlattr **tb;
11535         int err;
11536
11537         tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
11538         if (!tb)
11539                 return -ENOMEM;
11540
11541         if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
11542                 err = -EOPNOTSUPP;
11543                 goto out;
11544         }
11545
11546         err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr,
11547                                           nl80211_policy, NULL);
11548         if (err)
11549                 goto out;
11550
11551         trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
11552                                                    wowlan->max_nd_match_sets);
11553         err = PTR_ERR_OR_ZERO(trig->nd_config);
11554         if (err)
11555                 trig->nd_config = NULL;
11556
11557 out:
11558         kfree(tb);
11559         return err;
11560 }
11561
11562 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
11563 {
11564         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11565         struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
11566         struct cfg80211_wowlan new_triggers = {};
11567         struct cfg80211_wowlan *ntrig;
11568         const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
11569         int err, i;
11570         bool prev_enabled = rdev->wiphy.wowlan_config;
11571         bool regular = false;
11572
11573         if (!wowlan)
11574                 return -EOPNOTSUPP;
11575
11576         if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
11577                 cfg80211_rdev_free_wowlan(rdev);
11578                 rdev->wiphy.wowlan_config = NULL;
11579                 goto set_wakeup;
11580         }
11581
11582         err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG,
11583                                           info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
11584                                           nl80211_wowlan_policy, info->extack);
11585         if (err)
11586                 return err;
11587
11588         if (tb[NL80211_WOWLAN_TRIG_ANY]) {
11589                 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
11590                         return -EINVAL;
11591                 new_triggers.any = true;
11592         }
11593
11594         if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
11595                 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
11596                         return -EINVAL;
11597                 new_triggers.disconnect = true;
11598                 regular = true;
11599         }
11600
11601         if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
11602                 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
11603                         return -EINVAL;
11604                 new_triggers.magic_pkt = true;
11605                 regular = true;
11606         }
11607
11608         if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
11609                 return -EINVAL;
11610
11611         if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
11612                 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
11613                         return -EINVAL;
11614                 new_triggers.gtk_rekey_failure = true;
11615                 regular = true;
11616         }
11617
11618         if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
11619                 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
11620                         return -EINVAL;
11621                 new_triggers.eap_identity_req = true;
11622                 regular = true;
11623         }
11624
11625         if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
11626                 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
11627                         return -EINVAL;
11628                 new_triggers.four_way_handshake = true;
11629                 regular = true;
11630         }
11631
11632         if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
11633                 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
11634                         return -EINVAL;
11635                 new_triggers.rfkill_release = true;
11636                 regular = true;
11637         }
11638
11639         if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
11640                 struct nlattr *pat;
11641                 int n_patterns = 0;
11642                 int rem, pat_len, mask_len, pkt_offset;
11643                 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
11644
11645                 regular = true;
11646
11647                 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
11648                                     rem)
11649                         n_patterns++;
11650                 if (n_patterns > wowlan->n_patterns)
11651                         return -EINVAL;
11652
11653                 new_triggers.patterns = kcalloc(n_patterns,
11654                                                 sizeof(new_triggers.patterns[0]),
11655                                                 GFP_KERNEL);
11656                 if (!new_triggers.patterns)
11657                         return -ENOMEM;
11658
11659                 new_triggers.n_patterns = n_patterns;
11660                 i = 0;
11661
11662                 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
11663                                     rem) {
11664                         u8 *mask_pat;
11665
11666                         err = nla_parse_nested_deprecated(pat_tb,
11667                                                           MAX_NL80211_PKTPAT,
11668                                                           pat,
11669                                                           nl80211_packet_pattern_policy,
11670                                                           info->extack);
11671                         if (err)
11672                                 goto error;
11673
11674                         err = -EINVAL;
11675                         if (!pat_tb[NL80211_PKTPAT_MASK] ||
11676                             !pat_tb[NL80211_PKTPAT_PATTERN])
11677                                 goto error;
11678                         pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
11679                         mask_len = DIV_ROUND_UP(pat_len, 8);
11680                         if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
11681                                 goto error;
11682                         if (pat_len > wowlan->pattern_max_len ||
11683                             pat_len < wowlan->pattern_min_len)
11684                                 goto error;
11685
11686                         if (!pat_tb[NL80211_PKTPAT_OFFSET])
11687                                 pkt_offset = 0;
11688                         else
11689                                 pkt_offset = nla_get_u32(
11690                                         pat_tb[NL80211_PKTPAT_OFFSET]);
11691                         if (pkt_offset > wowlan->max_pkt_offset)
11692                                 goto error;
11693                         new_triggers.patterns[i].pkt_offset = pkt_offset;
11694
11695                         mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
11696                         if (!mask_pat) {
11697                                 err = -ENOMEM;
11698                                 goto error;
11699                         }
11700                         new_triggers.patterns[i].mask = mask_pat;
11701                         memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
11702                                mask_len);
11703                         mask_pat += mask_len;
11704                         new_triggers.patterns[i].pattern = mask_pat;
11705                         new_triggers.patterns[i].pattern_len = pat_len;
11706                         memcpy(mask_pat,
11707                                nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
11708                                pat_len);
11709                         i++;
11710                 }
11711         }
11712
11713         if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
11714                 regular = true;
11715                 err = nl80211_parse_wowlan_tcp(
11716                         rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
11717                         &new_triggers);
11718                 if (err)
11719                         goto error;
11720         }
11721
11722         if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
11723                 regular = true;
11724                 err = nl80211_parse_wowlan_nd(
11725                         rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
11726                         &new_triggers);
11727                 if (err)
11728                         goto error;
11729         }
11730
11731         /* The 'any' trigger means the device continues operating more or less
11732          * as in its normal operation mode and wakes up the host on most of the
11733          * normal interrupts (like packet RX, ...)
11734          * It therefore makes little sense to combine with the more constrained
11735          * wakeup trigger modes.
11736          */
11737         if (new_triggers.any && regular) {
11738                 err = -EINVAL;
11739                 goto error;
11740         }
11741
11742         ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
11743         if (!ntrig) {
11744                 err = -ENOMEM;
11745                 goto error;
11746         }
11747         cfg80211_rdev_free_wowlan(rdev);
11748         rdev->wiphy.wowlan_config = ntrig;
11749
11750  set_wakeup:
11751         if (rdev->ops->set_wakeup &&
11752             prev_enabled != !!rdev->wiphy.wowlan_config)
11753                 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
11754
11755         return 0;
11756  error:
11757         for (i = 0; i < new_triggers.n_patterns; i++)
11758                 kfree(new_triggers.patterns[i].mask);
11759         kfree(new_triggers.patterns);
11760         if (new_triggers.tcp && new_triggers.tcp->sock)
11761                 sock_release(new_triggers.tcp->sock);
11762         kfree(new_triggers.tcp);
11763         kfree(new_triggers.nd_config);
11764         return err;
11765 }
11766 #endif
11767
11768 static int nl80211_send_coalesce_rules(struct sk_buff *msg,
11769                                        struct cfg80211_registered_device *rdev)
11770 {
11771         struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
11772         int i, j, pat_len;
11773         struct cfg80211_coalesce_rules *rule;
11774
11775         if (!rdev->coalesce->n_rules)
11776                 return 0;
11777
11778         nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE);
11779         if (!nl_rules)
11780                 return -ENOBUFS;
11781
11782         for (i = 0; i < rdev->coalesce->n_rules; i++) {
11783                 nl_rule = nla_nest_start_noflag(msg, i + 1);
11784                 if (!nl_rule)
11785                         return -ENOBUFS;
11786
11787                 rule = &rdev->coalesce->rules[i];
11788                 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
11789                                 rule->delay))
11790                         return -ENOBUFS;
11791
11792                 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
11793                                 rule->condition))
11794                         return -ENOBUFS;
11795
11796                 nl_pats = nla_nest_start_noflag(msg,
11797                                                 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
11798                 if (!nl_pats)
11799                         return -ENOBUFS;
11800
11801                 for (j = 0; j < rule->n_patterns; j++) {
11802                         nl_pat = nla_nest_start_noflag(msg, j + 1);
11803                         if (!nl_pat)
11804                                 return -ENOBUFS;
11805                         pat_len = rule->patterns[j].pattern_len;
11806                         if (nla_put(msg, NL80211_PKTPAT_MASK,
11807                                     DIV_ROUND_UP(pat_len, 8),
11808                                     rule->patterns[j].mask) ||
11809                             nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
11810                                     rule->patterns[j].pattern) ||
11811                             nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
11812                                         rule->patterns[j].pkt_offset))
11813                                 return -ENOBUFS;
11814                         nla_nest_end(msg, nl_pat);
11815                 }
11816                 nla_nest_end(msg, nl_pats);
11817                 nla_nest_end(msg, nl_rule);
11818         }
11819         nla_nest_end(msg, nl_rules);
11820
11821         return 0;
11822 }
11823
11824 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
11825 {
11826         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11827         struct sk_buff *msg;
11828         void *hdr;
11829
11830         if (!rdev->wiphy.coalesce)
11831                 return -EOPNOTSUPP;
11832
11833         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11834         if (!msg)
11835                 return -ENOMEM;
11836
11837         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11838                              NL80211_CMD_GET_COALESCE);
11839         if (!hdr)
11840                 goto nla_put_failure;
11841
11842         if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
11843                 goto nla_put_failure;
11844
11845         genlmsg_end(msg, hdr);
11846         return genlmsg_reply(msg, info);
11847
11848 nla_put_failure:
11849         nlmsg_free(msg);
11850         return -ENOBUFS;
11851 }
11852
11853 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
11854 {
11855         struct cfg80211_coalesce *coalesce = rdev->coalesce;
11856         int i, j;
11857         struct cfg80211_coalesce_rules *rule;
11858
11859         if (!coalesce)
11860                 return;
11861
11862         for (i = 0; i < coalesce->n_rules; i++) {
11863                 rule = &coalesce->rules[i];
11864                 for (j = 0; j < rule->n_patterns; j++)
11865                         kfree(rule->patterns[j].mask);
11866                 kfree(rule->patterns);
11867         }
11868         kfree(coalesce->rules);
11869         kfree(coalesce);
11870         rdev->coalesce = NULL;
11871 }
11872
11873 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
11874                                        struct nlattr *rule,
11875                                        struct cfg80211_coalesce_rules *new_rule)
11876 {
11877         int err, i;
11878         const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
11879         struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
11880         int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
11881         struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
11882
11883         err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX,
11884                                           rule, nl80211_coalesce_policy, NULL);
11885         if (err)
11886                 return err;
11887
11888         if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
11889                 new_rule->delay =
11890                         nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
11891         if (new_rule->delay > coalesce->max_delay)
11892                 return -EINVAL;
11893
11894         if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
11895                 new_rule->condition =
11896                         nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
11897
11898         if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
11899                 return -EINVAL;
11900
11901         nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
11902                             rem)
11903                 n_patterns++;
11904         if (n_patterns > coalesce->n_patterns)
11905                 return -EINVAL;
11906
11907         new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
11908                                      GFP_KERNEL);
11909         if (!new_rule->patterns)
11910                 return -ENOMEM;
11911
11912         new_rule->n_patterns = n_patterns;
11913         i = 0;
11914
11915         nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
11916                             rem) {
11917                 u8 *mask_pat;
11918
11919                 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT,
11920                                                   pat,
11921                                                   nl80211_packet_pattern_policy,
11922                                                   NULL);
11923                 if (err)
11924                         return err;
11925
11926                 if (!pat_tb[NL80211_PKTPAT_MASK] ||
11927                     !pat_tb[NL80211_PKTPAT_PATTERN])
11928                         return -EINVAL;
11929                 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
11930                 mask_len = DIV_ROUND_UP(pat_len, 8);
11931                 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
11932                         return -EINVAL;
11933                 if (pat_len > coalesce->pattern_max_len ||
11934                     pat_len < coalesce->pattern_min_len)
11935                         return -EINVAL;
11936
11937                 if (!pat_tb[NL80211_PKTPAT_OFFSET])
11938                         pkt_offset = 0;
11939                 else
11940                         pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
11941                 if (pkt_offset > coalesce->max_pkt_offset)
11942                         return -EINVAL;
11943                 new_rule->patterns[i].pkt_offset = pkt_offset;
11944
11945                 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
11946                 if (!mask_pat)
11947                         return -ENOMEM;
11948
11949                 new_rule->patterns[i].mask = mask_pat;
11950                 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
11951                        mask_len);
11952
11953                 mask_pat += mask_len;
11954                 new_rule->patterns[i].pattern = mask_pat;
11955                 new_rule->patterns[i].pattern_len = pat_len;
11956                 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
11957                        pat_len);
11958                 i++;
11959         }
11960
11961         return 0;
11962 }
11963
11964 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
11965 {
11966         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11967         const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
11968         struct cfg80211_coalesce new_coalesce = {};
11969         struct cfg80211_coalesce *n_coalesce;
11970         int err, rem_rule, n_rules = 0, i, j;
11971         struct nlattr *rule;
11972         struct cfg80211_coalesce_rules *tmp_rule;
11973
11974         if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
11975                 return -EOPNOTSUPP;
11976
11977         if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
11978                 cfg80211_rdev_free_coalesce(rdev);
11979                 rdev_set_coalesce(rdev, NULL);
11980                 return 0;
11981         }
11982
11983         nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
11984                             rem_rule)
11985                 n_rules++;
11986         if (n_rules > coalesce->n_rules)
11987                 return -EINVAL;
11988
11989         new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
11990                                      GFP_KERNEL);
11991         if (!new_coalesce.rules)
11992                 return -ENOMEM;
11993
11994         new_coalesce.n_rules = n_rules;
11995         i = 0;
11996
11997         nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
11998                             rem_rule) {
11999                 err = nl80211_parse_coalesce_rule(rdev, rule,
12000                                                   &new_coalesce.rules[i]);
12001                 if (err)
12002                         goto error;
12003
12004                 i++;
12005         }
12006
12007         err = rdev_set_coalesce(rdev, &new_coalesce);
12008         if (err)
12009                 goto error;
12010
12011         n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
12012         if (!n_coalesce) {
12013                 err = -ENOMEM;
12014                 goto error;
12015         }
12016         cfg80211_rdev_free_coalesce(rdev);
12017         rdev->coalesce = n_coalesce;
12018
12019         return 0;
12020 error:
12021         for (i = 0; i < new_coalesce.n_rules; i++) {
12022                 tmp_rule = &new_coalesce.rules[i];
12023                 for (j = 0; j < tmp_rule->n_patterns; j++)
12024                         kfree(tmp_rule->patterns[j].mask);
12025                 kfree(tmp_rule->patterns);
12026         }
12027         kfree(new_coalesce.rules);
12028
12029         return err;
12030 }
12031
12032 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
12033 {
12034         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12035         struct net_device *dev = info->user_ptr[1];
12036         struct wireless_dev *wdev = dev->ieee80211_ptr;
12037         struct nlattr *tb[NUM_NL80211_REKEY_DATA];
12038         struct cfg80211_gtk_rekey_data rekey_data = {};
12039         int err;
12040
12041         if (!info->attrs[NL80211_ATTR_REKEY_DATA])
12042                 return -EINVAL;
12043
12044         err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA,
12045                                           info->attrs[NL80211_ATTR_REKEY_DATA],
12046                                           nl80211_rekey_policy, info->extack);
12047         if (err)
12048                 return err;
12049
12050         if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
12051             !tb[NL80211_REKEY_DATA_KCK])
12052                 return -EINVAL;
12053         if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
12054                 return -ERANGE;
12055         if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
12056                 return -ERANGE;
12057         if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
12058                 return -ERANGE;
12059
12060         rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
12061         rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
12062         rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
12063
12064         wdev_lock(wdev);
12065         if (!wdev->current_bss) {
12066                 err = -ENOTCONN;
12067                 goto out;
12068         }
12069
12070         if (!rdev->ops->set_rekey_data) {
12071                 err = -EOPNOTSUPP;
12072                 goto out;
12073         }
12074
12075         err = rdev_set_rekey_data(rdev, dev, &rekey_data);
12076  out:
12077         wdev_unlock(wdev);
12078         return err;
12079 }
12080
12081 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
12082                                              struct genl_info *info)
12083 {
12084         struct net_device *dev = info->user_ptr[1];
12085         struct wireless_dev *wdev = dev->ieee80211_ptr;
12086
12087         if (wdev->iftype != NL80211_IFTYPE_AP &&
12088             wdev->iftype != NL80211_IFTYPE_P2P_GO)
12089                 return -EINVAL;
12090
12091         if (wdev->ap_unexpected_nlportid)
12092                 return -EBUSY;
12093
12094         wdev->ap_unexpected_nlportid = info->snd_portid;
12095         return 0;
12096 }
12097
12098 static int nl80211_probe_client(struct sk_buff *skb,
12099                                 struct genl_info *info)
12100 {
12101         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12102         struct net_device *dev = info->user_ptr[1];
12103         struct wireless_dev *wdev = dev->ieee80211_ptr;
12104         struct sk_buff *msg;
12105         void *hdr;
12106         const u8 *addr;
12107         u64 cookie;
12108         int err;
12109
12110         if (wdev->iftype != NL80211_IFTYPE_AP &&
12111             wdev->iftype != NL80211_IFTYPE_P2P_GO)
12112                 return -EOPNOTSUPP;
12113
12114         if (!info->attrs[NL80211_ATTR_MAC])
12115                 return -EINVAL;
12116
12117         if (!rdev->ops->probe_client)
12118                 return -EOPNOTSUPP;
12119
12120         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12121         if (!msg)
12122                 return -ENOMEM;
12123
12124         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12125                              NL80211_CMD_PROBE_CLIENT);
12126         if (!hdr) {
12127                 err = -ENOBUFS;
12128                 goto free_msg;
12129         }
12130
12131         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
12132
12133         err = rdev_probe_client(rdev, dev, addr, &cookie);
12134         if (err)
12135                 goto free_msg;
12136
12137         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
12138                               NL80211_ATTR_PAD))
12139                 goto nla_put_failure;
12140
12141         genlmsg_end(msg, hdr);
12142
12143         return genlmsg_reply(msg, info);
12144
12145  nla_put_failure:
12146         err = -ENOBUFS;
12147  free_msg:
12148         nlmsg_free(msg);
12149         return err;
12150 }
12151
12152 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
12153 {
12154         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12155         struct cfg80211_beacon_registration *reg, *nreg;
12156         int rv;
12157
12158         if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
12159                 return -EOPNOTSUPP;
12160
12161         nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
12162         if (!nreg)
12163                 return -ENOMEM;
12164
12165         /* First, check if already registered. */
12166         spin_lock_bh(&rdev->beacon_registrations_lock);
12167         list_for_each_entry(reg, &rdev->beacon_registrations, list) {
12168                 if (reg->nlportid == info->snd_portid) {
12169                         rv = -EALREADY;
12170                         goto out_err;
12171                 }
12172         }
12173         /* Add it to the list */
12174         nreg->nlportid = info->snd_portid;
12175         list_add(&nreg->list, &rdev->beacon_registrations);
12176
12177         spin_unlock_bh(&rdev->beacon_registrations_lock);
12178
12179         return 0;
12180 out_err:
12181         spin_unlock_bh(&rdev->beacon_registrations_lock);
12182         kfree(nreg);
12183         return rv;
12184 }
12185
12186 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
12187 {
12188         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12189         struct wireless_dev *wdev = info->user_ptr[1];
12190         int err;
12191
12192         if (!rdev->ops->start_p2p_device)
12193                 return -EOPNOTSUPP;
12194
12195         if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
12196                 return -EOPNOTSUPP;
12197
12198         if (wdev_running(wdev))
12199                 return 0;
12200
12201         if (rfkill_blocked(rdev->rfkill))
12202                 return -ERFKILL;
12203
12204         err = rdev_start_p2p_device(rdev, wdev);
12205         if (err)
12206                 return err;
12207
12208         wdev->is_running = true;
12209         rdev->opencount++;
12210
12211         return 0;
12212 }
12213
12214 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
12215 {
12216         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12217         struct wireless_dev *wdev = info->user_ptr[1];
12218
12219         if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
12220                 return -EOPNOTSUPP;
12221
12222         if (!rdev->ops->stop_p2p_device)
12223                 return -EOPNOTSUPP;
12224
12225         cfg80211_stop_p2p_device(rdev, wdev);
12226
12227         return 0;
12228 }
12229
12230 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
12231 {
12232         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12233         struct wireless_dev *wdev = info->user_ptr[1];
12234         struct cfg80211_nan_conf conf = {};
12235         int err;
12236
12237         if (wdev->iftype != NL80211_IFTYPE_NAN)
12238                 return -EOPNOTSUPP;
12239
12240         if (wdev_running(wdev))
12241                 return -EEXIST;
12242
12243         if (rfkill_blocked(rdev->rfkill))
12244                 return -ERFKILL;
12245
12246         if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
12247                 return -EINVAL;
12248
12249         conf.master_pref =
12250                 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
12251
12252         if (info->attrs[NL80211_ATTR_BANDS]) {
12253                 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
12254
12255                 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
12256                         return -EOPNOTSUPP;
12257
12258                 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
12259                         return -EINVAL;
12260
12261                 conf.bands = bands;
12262         }
12263
12264         err = rdev_start_nan(rdev, wdev, &conf);
12265         if (err)
12266                 return err;
12267
12268         wdev->is_running = true;
12269         rdev->opencount++;
12270
12271         return 0;
12272 }
12273
12274 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
12275 {
12276         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12277         struct wireless_dev *wdev = info->user_ptr[1];
12278
12279         if (wdev->iftype != NL80211_IFTYPE_NAN)
12280                 return -EOPNOTSUPP;
12281
12282         cfg80211_stop_nan(rdev, wdev);
12283
12284         return 0;
12285 }
12286
12287 static int validate_nan_filter(struct nlattr *filter_attr)
12288 {
12289         struct nlattr *attr;
12290         int len = 0, n_entries = 0, rem;
12291
12292         nla_for_each_nested(attr, filter_attr, rem) {
12293                 len += nla_len(attr);
12294                 n_entries++;
12295         }
12296
12297         if (len >= U8_MAX)
12298                 return -EINVAL;
12299
12300         return n_entries;
12301 }
12302
12303 static int handle_nan_filter(struct nlattr *attr_filter,
12304                              struct cfg80211_nan_func *func,
12305                              bool tx)
12306 {
12307         struct nlattr *attr;
12308         int n_entries, rem, i;
12309         struct cfg80211_nan_func_filter *filter;
12310
12311         n_entries = validate_nan_filter(attr_filter);
12312         if (n_entries < 0)
12313                 return n_entries;
12314
12315         BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
12316
12317         filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
12318         if (!filter)
12319                 return -ENOMEM;
12320
12321         i = 0;
12322         nla_for_each_nested(attr, attr_filter, rem) {
12323                 filter[i].filter = nla_memdup(attr, GFP_KERNEL);
12324                 if (!filter[i].filter)
12325                         goto err;
12326
12327                 filter[i].len = nla_len(attr);
12328                 i++;
12329         }
12330         if (tx) {
12331                 func->num_tx_filters = n_entries;
12332                 func->tx_filters = filter;
12333         } else {
12334                 func->num_rx_filters = n_entries;
12335                 func->rx_filters = filter;
12336         }
12337
12338         return 0;
12339
12340 err:
12341         i = 0;
12342         nla_for_each_nested(attr, attr_filter, rem) {
12343                 kfree(filter[i].filter);
12344                 i++;
12345         }
12346         kfree(filter);
12347         return -ENOMEM;
12348 }
12349
12350 static int nl80211_nan_add_func(struct sk_buff *skb,
12351                                 struct genl_info *info)
12352 {
12353         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12354         struct wireless_dev *wdev = info->user_ptr[1];
12355         struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
12356         struct cfg80211_nan_func *func;
12357         struct sk_buff *msg = NULL;
12358         void *hdr = NULL;
12359         int err = 0;
12360
12361         if (wdev->iftype != NL80211_IFTYPE_NAN)
12362                 return -EOPNOTSUPP;
12363
12364         if (!wdev_running(wdev))
12365                 return -ENOTCONN;
12366
12367         if (!info->attrs[NL80211_ATTR_NAN_FUNC])
12368                 return -EINVAL;
12369
12370         err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX,
12371                                           info->attrs[NL80211_ATTR_NAN_FUNC],
12372                                           nl80211_nan_func_policy,
12373                                           info->extack);
12374         if (err)
12375                 return err;
12376
12377         func = kzalloc(sizeof(*func), GFP_KERNEL);
12378         if (!func)
12379                 return -ENOMEM;
12380
12381         func->cookie = cfg80211_assign_cookie(rdev);
12382
12383         if (!tb[NL80211_NAN_FUNC_TYPE] ||
12384             nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
12385                 err = -EINVAL;
12386                 goto out;
12387         }
12388
12389
12390         func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
12391
12392         if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
12393                 err = -EINVAL;
12394                 goto out;
12395         }
12396
12397         memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
12398                sizeof(func->service_id));
12399
12400         func->close_range =
12401                 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
12402
12403         if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
12404                 func->serv_spec_info_len =
12405                         nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
12406                 func->serv_spec_info =
12407                         kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
12408                                 func->serv_spec_info_len,
12409                                 GFP_KERNEL);
12410                 if (!func->serv_spec_info) {
12411                         err = -ENOMEM;
12412                         goto out;
12413                 }
12414         }
12415
12416         if (tb[NL80211_NAN_FUNC_TTL])
12417                 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
12418
12419         switch (func->type) {
12420         case NL80211_NAN_FUNC_PUBLISH:
12421                 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
12422                         err = -EINVAL;
12423                         goto out;
12424                 }
12425
12426                 func->publish_type =
12427                         nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
12428                 func->publish_bcast =
12429                         nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
12430
12431                 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
12432                         func->publish_bcast) {
12433                         err = -EINVAL;
12434                         goto out;
12435                 }
12436                 break;
12437         case NL80211_NAN_FUNC_SUBSCRIBE:
12438                 func->subscribe_active =
12439                         nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
12440                 break;
12441         case NL80211_NAN_FUNC_FOLLOW_UP:
12442                 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
12443                     !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
12444                     !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
12445                         err = -EINVAL;
12446                         goto out;
12447                 }
12448
12449                 func->followup_id =
12450                         nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
12451                 func->followup_reqid =
12452                         nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
12453                 memcpy(func->followup_dest.addr,
12454                        nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
12455                        sizeof(func->followup_dest.addr));
12456                 if (func->ttl) {
12457                         err = -EINVAL;
12458                         goto out;
12459                 }
12460                 break;
12461         default:
12462                 err = -EINVAL;
12463                 goto out;
12464         }
12465
12466         if (tb[NL80211_NAN_FUNC_SRF]) {
12467                 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
12468
12469                 err = nla_parse_nested_deprecated(srf_tb,
12470                                                   NL80211_NAN_SRF_ATTR_MAX,
12471                                                   tb[NL80211_NAN_FUNC_SRF],
12472                                                   nl80211_nan_srf_policy,
12473                                                   info->extack);
12474                 if (err)
12475                         goto out;
12476
12477                 func->srf_include =
12478                         nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
12479
12480                 if (srf_tb[NL80211_NAN_SRF_BF]) {
12481                         if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
12482                             !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
12483                                 err = -EINVAL;
12484                                 goto out;
12485                         }
12486
12487                         func->srf_bf_len =
12488                                 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
12489                         func->srf_bf =
12490                                 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
12491                                         func->srf_bf_len, GFP_KERNEL);
12492                         if (!func->srf_bf) {
12493                                 err = -ENOMEM;
12494                                 goto out;
12495                         }
12496
12497                         func->srf_bf_idx =
12498                                 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
12499                 } else {
12500                         struct nlattr *attr, *mac_attr =
12501                                 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
12502                         int n_entries, rem, i = 0;
12503
12504                         if (!mac_attr) {
12505                                 err = -EINVAL;
12506                                 goto out;
12507                         }
12508
12509                         n_entries = validate_acl_mac_addrs(mac_attr);
12510                         if (n_entries <= 0) {
12511                                 err = -EINVAL;
12512                                 goto out;
12513                         }
12514
12515                         func->srf_num_macs = n_entries;
12516                         func->srf_macs =
12517                                 kcalloc(n_entries, sizeof(*func->srf_macs),
12518                                         GFP_KERNEL);
12519                         if (!func->srf_macs) {
12520                                 err = -ENOMEM;
12521                                 goto out;
12522                         }
12523
12524                         nla_for_each_nested(attr, mac_attr, rem)
12525                                 memcpy(func->srf_macs[i++].addr, nla_data(attr),
12526                                        sizeof(*func->srf_macs));
12527                 }
12528         }
12529
12530         if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
12531                 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
12532                                         func, true);
12533                 if (err)
12534                         goto out;
12535         }
12536
12537         if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
12538                 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
12539                                         func, false);
12540                 if (err)
12541                         goto out;
12542         }
12543
12544         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12545         if (!msg) {
12546                 err = -ENOMEM;
12547                 goto out;
12548         }
12549
12550         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12551                              NL80211_CMD_ADD_NAN_FUNCTION);
12552         /* This can't really happen - we just allocated 4KB */
12553         if (WARN_ON(!hdr)) {
12554                 err = -ENOMEM;
12555                 goto out;
12556         }
12557
12558         err = rdev_add_nan_func(rdev, wdev, func);
12559 out:
12560         if (err < 0) {
12561                 cfg80211_free_nan_func(func);
12562                 nlmsg_free(msg);
12563                 return err;
12564         }
12565
12566         /* propagate the instance id and cookie to userspace  */
12567         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
12568                               NL80211_ATTR_PAD))
12569                 goto nla_put_failure;
12570
12571         func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
12572         if (!func_attr)
12573                 goto nla_put_failure;
12574
12575         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
12576                        func->instance_id))
12577                 goto nla_put_failure;
12578
12579         nla_nest_end(msg, func_attr);
12580
12581         genlmsg_end(msg, hdr);
12582         return genlmsg_reply(msg, info);
12583
12584 nla_put_failure:
12585         nlmsg_free(msg);
12586         return -ENOBUFS;
12587 }
12588
12589 static int nl80211_nan_del_func(struct sk_buff *skb,
12590                                struct genl_info *info)
12591 {
12592         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12593         struct wireless_dev *wdev = info->user_ptr[1];
12594         u64 cookie;
12595
12596         if (wdev->iftype != NL80211_IFTYPE_NAN)
12597                 return -EOPNOTSUPP;
12598
12599         if (!wdev_running(wdev))
12600                 return -ENOTCONN;
12601
12602         if (!info->attrs[NL80211_ATTR_COOKIE])
12603                 return -EINVAL;
12604
12605         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
12606
12607         rdev_del_nan_func(rdev, wdev, cookie);
12608
12609         return 0;
12610 }
12611
12612 static int nl80211_nan_change_config(struct sk_buff *skb,
12613                                      struct genl_info *info)
12614 {
12615         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12616         struct wireless_dev *wdev = info->user_ptr[1];
12617         struct cfg80211_nan_conf conf = {};
12618         u32 changed = 0;
12619
12620         if (wdev->iftype != NL80211_IFTYPE_NAN)
12621                 return -EOPNOTSUPP;
12622
12623         if (!wdev_running(wdev))
12624                 return -ENOTCONN;
12625
12626         if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
12627                 conf.master_pref =
12628                         nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
12629                 if (conf.master_pref <= 1 || conf.master_pref == 255)
12630                         return -EINVAL;
12631
12632                 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
12633         }
12634
12635         if (info->attrs[NL80211_ATTR_BANDS]) {
12636                 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
12637
12638                 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
12639                         return -EOPNOTSUPP;
12640
12641                 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
12642                         return -EINVAL;
12643
12644                 conf.bands = bands;
12645                 changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
12646         }
12647
12648         if (!changed)
12649                 return -EINVAL;
12650
12651         return rdev_nan_change_conf(rdev, wdev, &conf, changed);
12652 }
12653
12654 void cfg80211_nan_match(struct wireless_dev *wdev,
12655                         struct cfg80211_nan_match_params *match, gfp_t gfp)
12656 {
12657         struct wiphy *wiphy = wdev->wiphy;
12658         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12659         struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
12660         struct sk_buff *msg;
12661         void *hdr;
12662
12663         if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
12664                 return;
12665
12666         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
12667         if (!msg)
12668                 return;
12669
12670         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
12671         if (!hdr) {
12672                 nlmsg_free(msg);
12673                 return;
12674         }
12675
12676         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12677             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12678                                          wdev->netdev->ifindex)) ||
12679             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12680                               NL80211_ATTR_PAD))
12681                 goto nla_put_failure;
12682
12683         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
12684                               NL80211_ATTR_PAD) ||
12685             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
12686                 goto nla_put_failure;
12687
12688         match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH);
12689         if (!match_attr)
12690                 goto nla_put_failure;
12691
12692         local_func_attr = nla_nest_start_noflag(msg,
12693                                                 NL80211_NAN_MATCH_FUNC_LOCAL);
12694         if (!local_func_attr)
12695                 goto nla_put_failure;
12696
12697         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
12698                 goto nla_put_failure;
12699
12700         nla_nest_end(msg, local_func_attr);
12701
12702         peer_func_attr = nla_nest_start_noflag(msg,
12703                                                NL80211_NAN_MATCH_FUNC_PEER);
12704         if (!peer_func_attr)
12705                 goto nla_put_failure;
12706
12707         if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
12708             nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
12709                 goto nla_put_failure;
12710
12711         if (match->info && match->info_len &&
12712             nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
12713                     match->info))
12714                 goto nla_put_failure;
12715
12716         nla_nest_end(msg, peer_func_attr);
12717         nla_nest_end(msg, match_attr);
12718         genlmsg_end(msg, hdr);
12719
12720         if (!wdev->owner_nlportid)
12721                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
12722                                         msg, 0, NL80211_MCGRP_NAN, gfp);
12723         else
12724                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
12725                                 wdev->owner_nlportid);
12726
12727         return;
12728
12729 nla_put_failure:
12730         nlmsg_free(msg);
12731 }
12732 EXPORT_SYMBOL(cfg80211_nan_match);
12733
12734 void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
12735                                   u8 inst_id,
12736                                   enum nl80211_nan_func_term_reason reason,
12737                                   u64 cookie, gfp_t gfp)
12738 {
12739         struct wiphy *wiphy = wdev->wiphy;
12740         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12741         struct sk_buff *msg;
12742         struct nlattr *func_attr;
12743         void *hdr;
12744
12745         if (WARN_ON(!inst_id))
12746                 return;
12747
12748         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
12749         if (!msg)
12750                 return;
12751
12752         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
12753         if (!hdr) {
12754                 nlmsg_free(msg);
12755                 return;
12756         }
12757
12758         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12759             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12760                                          wdev->netdev->ifindex)) ||
12761             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12762                               NL80211_ATTR_PAD))
12763                 goto nla_put_failure;
12764
12765         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
12766                               NL80211_ATTR_PAD))
12767                 goto nla_put_failure;
12768
12769         func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
12770         if (!func_attr)
12771                 goto nla_put_failure;
12772
12773         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
12774             nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
12775                 goto nla_put_failure;
12776
12777         nla_nest_end(msg, func_attr);
12778         genlmsg_end(msg, hdr);
12779
12780         if (!wdev->owner_nlportid)
12781                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
12782                                         msg, 0, NL80211_MCGRP_NAN, gfp);
12783         else
12784                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
12785                                 wdev->owner_nlportid);
12786
12787         return;
12788
12789 nla_put_failure:
12790         nlmsg_free(msg);
12791 }
12792 EXPORT_SYMBOL(cfg80211_nan_func_terminated);
12793
12794 static int nl80211_get_protocol_features(struct sk_buff *skb,
12795                                          struct genl_info *info)
12796 {
12797         void *hdr;
12798         struct sk_buff *msg;
12799
12800         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12801         if (!msg)
12802                 return -ENOMEM;
12803
12804         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12805                              NL80211_CMD_GET_PROTOCOL_FEATURES);
12806         if (!hdr)
12807                 goto nla_put_failure;
12808
12809         if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
12810                         NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
12811                 goto nla_put_failure;
12812
12813         genlmsg_end(msg, hdr);
12814         return genlmsg_reply(msg, info);
12815
12816  nla_put_failure:
12817         kfree_skb(msg);
12818         return -ENOBUFS;
12819 }
12820
12821 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
12822 {
12823         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12824         struct cfg80211_update_ft_ies_params ft_params;
12825         struct net_device *dev = info->user_ptr[1];
12826
12827         if (!rdev->ops->update_ft_ies)
12828                 return -EOPNOTSUPP;
12829
12830         if (!info->attrs[NL80211_ATTR_MDID] ||
12831             !info->attrs[NL80211_ATTR_IE])
12832                 return -EINVAL;
12833
12834         memset(&ft_params, 0, sizeof(ft_params));
12835         ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
12836         ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
12837         ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
12838
12839         return rdev_update_ft_ies(rdev, dev, &ft_params);
12840 }
12841
12842 static int nl80211_crit_protocol_start(struct sk_buff *skb,
12843                                        struct genl_info *info)
12844 {
12845         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12846         struct wireless_dev *wdev = info->user_ptr[1];
12847         enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
12848         u16 duration;
12849         int ret;
12850
12851         if (!rdev->ops->crit_proto_start)
12852                 return -EOPNOTSUPP;
12853
12854         if (WARN_ON(!rdev->ops->crit_proto_stop))
12855                 return -EINVAL;
12856
12857         if (rdev->crit_proto_nlportid)
12858                 return -EBUSY;
12859
12860         /* determine protocol if provided */
12861         if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
12862                 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
12863
12864         if (proto >= NUM_NL80211_CRIT_PROTO)
12865                 return -EINVAL;
12866
12867         /* timeout must be provided */
12868         if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
12869                 return -EINVAL;
12870
12871         duration =
12872                 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
12873
12874         if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
12875                 return -ERANGE;
12876
12877         ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
12878         if (!ret)
12879                 rdev->crit_proto_nlportid = info->snd_portid;
12880
12881         return ret;
12882 }
12883
12884 static int nl80211_crit_protocol_stop(struct sk_buff *skb,
12885                                       struct genl_info *info)
12886 {
12887         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12888         struct wireless_dev *wdev = info->user_ptr[1];
12889
12890         if (!rdev->ops->crit_proto_stop)
12891                 return -EOPNOTSUPP;
12892
12893         if (rdev->crit_proto_nlportid) {
12894                 rdev->crit_proto_nlportid = 0;
12895                 rdev_crit_proto_stop(rdev, wdev);
12896         }
12897         return 0;
12898 }
12899
12900 static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd,
12901                                        struct nlattr *attr,
12902                                        struct netlink_ext_ack *extack)
12903 {
12904         if (vcmd->policy == VENDOR_CMD_RAW_DATA) {
12905                 if (attr->nla_type & NLA_F_NESTED) {
12906                         NL_SET_ERR_MSG_ATTR(extack, attr,
12907                                             "unexpected nested data");
12908                         return -EINVAL;
12909                 }
12910
12911                 return 0;
12912         }
12913
12914         if (!(attr->nla_type & NLA_F_NESTED)) {
12915                 NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data");
12916                 return -EINVAL;
12917         }
12918
12919         return nl80211_validate_nested(attr, vcmd->maxattr, vcmd->policy,
12920                                        extack);
12921 }
12922
12923 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
12924 {
12925         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12926         struct wireless_dev *wdev =
12927                 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
12928         int i, err;
12929         u32 vid, subcmd;
12930
12931         if (!rdev->wiphy.vendor_commands)
12932                 return -EOPNOTSUPP;
12933
12934         if (IS_ERR(wdev)) {
12935                 err = PTR_ERR(wdev);
12936                 if (err != -EINVAL)
12937                         return err;
12938                 wdev = NULL;
12939         } else if (wdev->wiphy != &rdev->wiphy) {
12940                 return -EINVAL;
12941         }
12942
12943         if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
12944             !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
12945                 return -EINVAL;
12946
12947         vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
12948         subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
12949         for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
12950                 const struct wiphy_vendor_command *vcmd;
12951                 void *data = NULL;
12952                 int len = 0;
12953
12954                 vcmd = &rdev->wiphy.vendor_commands[i];
12955
12956                 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
12957                         continue;
12958
12959                 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
12960                                    WIPHY_VENDOR_CMD_NEED_NETDEV)) {
12961                         if (!wdev)
12962                                 return -EINVAL;
12963                         if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
12964                             !wdev->netdev)
12965                                 return -EINVAL;
12966
12967                         if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
12968                                 if (!wdev_running(wdev))
12969                                         return -ENETDOWN;
12970                         }
12971                 } else {
12972                         wdev = NULL;
12973                 }
12974
12975                 if (!vcmd->doit)
12976                         return -EOPNOTSUPP;
12977
12978                 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
12979                         data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
12980                         len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
12981
12982                         err = nl80211_vendor_check_policy(vcmd,
12983                                         info->attrs[NL80211_ATTR_VENDOR_DATA],
12984                                         info->extack);
12985                         if (err)
12986                                 return err;
12987                 }
12988
12989                 rdev->cur_cmd_info = info;
12990                 err = vcmd->doit(&rdev->wiphy, wdev, data, len);
12991                 rdev->cur_cmd_info = NULL;
12992                 return err;
12993         }
12994
12995         return -EOPNOTSUPP;
12996 }
12997
12998 static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
12999                                        struct netlink_callback *cb,
13000                                        struct cfg80211_registered_device **rdev,
13001                                        struct wireless_dev **wdev)
13002 {
13003         struct nlattr **attrbuf;
13004         u32 vid, subcmd;
13005         unsigned int i;
13006         int vcmd_idx = -1;
13007         int err;
13008         void *data = NULL;
13009         unsigned int data_len = 0;
13010
13011         if (cb->args[0]) {
13012                 /* subtract the 1 again here */
13013                 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
13014                 struct wireless_dev *tmp;
13015
13016                 if (!wiphy)
13017                         return -ENODEV;
13018                 *rdev = wiphy_to_rdev(wiphy);
13019                 *wdev = NULL;
13020
13021                 if (cb->args[1]) {
13022                         list_for_each_entry(tmp, &wiphy->wdev_list, list) {
13023                                 if (tmp->identifier == cb->args[1] - 1) {
13024                                         *wdev = tmp;
13025                                         break;
13026                                 }
13027                         }
13028                 }
13029
13030                 /* keep rtnl locked in successful case */
13031                 return 0;
13032         }
13033
13034         attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
13035         if (!attrbuf)
13036                 return -ENOMEM;
13037
13038         err = nlmsg_parse_deprecated(cb->nlh,
13039                                      GENL_HDRLEN + nl80211_fam.hdrsize,
13040                                      attrbuf, nl80211_fam.maxattr,
13041                                      nl80211_policy, NULL);
13042         if (err)
13043                 goto out;
13044
13045         if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
13046             !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) {
13047                 err = -EINVAL;
13048                 goto out;
13049         }
13050
13051         *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
13052         if (IS_ERR(*wdev))
13053                 *wdev = NULL;
13054
13055         *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
13056         if (IS_ERR(*rdev)) {
13057                 err = PTR_ERR(*rdev);
13058                 goto out;
13059         }
13060
13061         vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
13062         subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
13063
13064         for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
13065                 const struct wiphy_vendor_command *vcmd;
13066
13067                 vcmd = &(*rdev)->wiphy.vendor_commands[i];
13068
13069                 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
13070                         continue;
13071
13072                 if (!vcmd->dumpit) {
13073                         err = -EOPNOTSUPP;
13074                         goto out;
13075                 }
13076
13077                 vcmd_idx = i;
13078                 break;
13079         }
13080
13081         if (vcmd_idx < 0) {
13082                 err = -EOPNOTSUPP;
13083                 goto out;
13084         }
13085
13086         if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
13087                 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
13088                 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
13089
13090                 err = nl80211_vendor_check_policy(
13091                                 &(*rdev)->wiphy.vendor_commands[vcmd_idx],
13092                                 attrbuf[NL80211_ATTR_VENDOR_DATA],
13093                                 cb->extack);
13094                 if (err)
13095                         goto out;
13096         }
13097
13098         /* 0 is the first index - add 1 to parse only once */
13099         cb->args[0] = (*rdev)->wiphy_idx + 1;
13100         /* add 1 to know if it was NULL */
13101         cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
13102         cb->args[2] = vcmd_idx;
13103         cb->args[3] = (unsigned long)data;
13104         cb->args[4] = data_len;
13105
13106         /* keep rtnl locked in successful case */
13107         err = 0;
13108 out:
13109         kfree(attrbuf);
13110         return err;
13111 }
13112
13113 static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
13114                                    struct netlink_callback *cb)
13115 {
13116         struct cfg80211_registered_device *rdev;
13117         struct wireless_dev *wdev;
13118         unsigned int vcmd_idx;
13119         const struct wiphy_vendor_command *vcmd;
13120         void *data;
13121         int data_len;
13122         int err;
13123         struct nlattr *vendor_data;
13124
13125         rtnl_lock();
13126         err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
13127         if (err)
13128                 goto out;
13129
13130         vcmd_idx = cb->args[2];
13131         data = (void *)cb->args[3];
13132         data_len = cb->args[4];
13133         vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
13134
13135         if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
13136                            WIPHY_VENDOR_CMD_NEED_NETDEV)) {
13137                 if (!wdev) {
13138                         err = -EINVAL;
13139                         goto out;
13140                 }
13141                 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
13142                     !wdev->netdev) {
13143                         err = -EINVAL;
13144                         goto out;
13145                 }
13146
13147                 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
13148                         if (!wdev_running(wdev)) {
13149                                 err = -ENETDOWN;
13150                                 goto out;
13151                         }
13152                 }
13153         }
13154
13155         while (1) {
13156                 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
13157                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
13158                                            NL80211_CMD_VENDOR);
13159                 if (!hdr)
13160                         break;
13161
13162                 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13163                     (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
13164                                                wdev_id(wdev),
13165                                                NL80211_ATTR_PAD))) {
13166                         genlmsg_cancel(skb, hdr);
13167                         break;
13168                 }
13169
13170                 vendor_data = nla_nest_start_noflag(skb,
13171                                                     NL80211_ATTR_VENDOR_DATA);
13172                 if (!vendor_data) {
13173                         genlmsg_cancel(skb, hdr);
13174                         break;
13175                 }
13176
13177                 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
13178                                    (unsigned long *)&cb->args[5]);
13179                 nla_nest_end(skb, vendor_data);
13180
13181                 if (err == -ENOBUFS || err == -ENOENT) {
13182                         genlmsg_cancel(skb, hdr);
13183                         break;
13184                 } else if (err) {
13185                         genlmsg_cancel(skb, hdr);
13186                         goto out;
13187                 }
13188
13189                 genlmsg_end(skb, hdr);
13190         }
13191
13192         err = skb->len;
13193  out:
13194         rtnl_unlock();
13195         return err;
13196 }
13197
13198 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
13199                                            enum nl80211_commands cmd,
13200                                            enum nl80211_attrs attr,
13201                                            int approxlen)
13202 {
13203         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13204
13205         if (WARN_ON(!rdev->cur_cmd_info))
13206                 return NULL;
13207
13208         return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
13209                                            rdev->cur_cmd_info->snd_portid,
13210                                            rdev->cur_cmd_info->snd_seq,
13211                                            cmd, attr, NULL, GFP_KERNEL);
13212 }
13213 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
13214
13215 int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
13216 {
13217         struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
13218         void *hdr = ((void **)skb->cb)[1];
13219         struct nlattr *data = ((void **)skb->cb)[2];
13220
13221         /* clear CB data for netlink core to own from now on */
13222         memset(skb->cb, 0, sizeof(skb->cb));
13223
13224         if (WARN_ON(!rdev->cur_cmd_info)) {
13225                 kfree_skb(skb);
13226                 return -EINVAL;
13227         }
13228
13229         nla_nest_end(skb, data);
13230         genlmsg_end(skb, hdr);
13231         return genlmsg_reply(skb, rdev->cur_cmd_info);
13232 }
13233 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
13234
13235 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy)
13236 {
13237         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13238
13239         if (WARN_ON(!rdev->cur_cmd_info))
13240                 return 0;
13241
13242         return rdev->cur_cmd_info->snd_portid;
13243 }
13244 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender);
13245
13246 static int nl80211_set_qos_map(struct sk_buff *skb,
13247                                struct genl_info *info)
13248 {
13249         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13250         struct cfg80211_qos_map *qos_map = NULL;
13251         struct net_device *dev = info->user_ptr[1];
13252         u8 *pos, len, num_des, des_len, des;
13253         int ret;
13254
13255         if (!rdev->ops->set_qos_map)
13256                 return -EOPNOTSUPP;
13257
13258         if (info->attrs[NL80211_ATTR_QOS_MAP]) {
13259                 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
13260                 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
13261
13262                 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
13263                     len > IEEE80211_QOS_MAP_LEN_MAX)
13264                         return -EINVAL;
13265
13266                 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
13267                 if (!qos_map)
13268                         return -ENOMEM;
13269
13270                 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
13271                 if (num_des) {
13272                         des_len = num_des *
13273                                 sizeof(struct cfg80211_dscp_exception);
13274                         memcpy(qos_map->dscp_exception, pos, des_len);
13275                         qos_map->num_des = num_des;
13276                         for (des = 0; des < num_des; des++) {
13277                                 if (qos_map->dscp_exception[des].up > 7) {
13278                                         kfree(qos_map);
13279                                         return -EINVAL;
13280                                 }
13281                         }
13282                         pos += des_len;
13283                 }
13284                 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
13285         }
13286
13287         wdev_lock(dev->ieee80211_ptr);
13288         ret = nl80211_key_allowed(dev->ieee80211_ptr);
13289         if (!ret)
13290                 ret = rdev_set_qos_map(rdev, dev, qos_map);
13291         wdev_unlock(dev->ieee80211_ptr);
13292
13293         kfree(qos_map);
13294         return ret;
13295 }
13296
13297 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
13298 {
13299         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13300         struct net_device *dev = info->user_ptr[1];
13301         struct wireless_dev *wdev = dev->ieee80211_ptr;
13302         const u8 *peer;
13303         u8 tsid, up;
13304         u16 admitted_time = 0;
13305         int err;
13306
13307         if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
13308                 return -EOPNOTSUPP;
13309
13310         if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
13311             !info->attrs[NL80211_ATTR_USER_PRIO])
13312                 return -EINVAL;
13313
13314         tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
13315         up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
13316
13317         /* WMM uses TIDs 0-7 even for TSPEC */
13318         if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
13319                 /* TODO: handle 802.11 TSPEC/admission control
13320                  * need more attributes for that (e.g. BA session requirement);
13321                  * change the WMM adminssion test above to allow both then
13322                  */
13323                 return -EINVAL;
13324         }
13325
13326         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
13327
13328         if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
13329                 admitted_time =
13330                         nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
13331                 if (!admitted_time)
13332                         return -EINVAL;
13333         }
13334
13335         wdev_lock(wdev);
13336         switch (wdev->iftype) {
13337         case NL80211_IFTYPE_STATION:
13338         case NL80211_IFTYPE_P2P_CLIENT:
13339                 if (wdev->current_bss)
13340                         break;
13341                 err = -ENOTCONN;
13342                 goto out;
13343         default:
13344                 err = -EOPNOTSUPP;
13345                 goto out;
13346         }
13347
13348         err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
13349
13350  out:
13351         wdev_unlock(wdev);
13352         return err;
13353 }
13354
13355 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
13356 {
13357         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13358         struct net_device *dev = info->user_ptr[1];
13359         struct wireless_dev *wdev = dev->ieee80211_ptr;
13360         const u8 *peer;
13361         u8 tsid;
13362         int err;
13363
13364         if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
13365                 return -EINVAL;
13366
13367         tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
13368         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
13369
13370         wdev_lock(wdev);
13371         err = rdev_del_tx_ts(rdev, dev, tsid, peer);
13372         wdev_unlock(wdev);
13373
13374         return err;
13375 }
13376
13377 static int nl80211_tdls_channel_switch(struct sk_buff *skb,
13378                                        struct genl_info *info)
13379 {
13380         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13381         struct net_device *dev = info->user_ptr[1];
13382         struct wireless_dev *wdev = dev->ieee80211_ptr;
13383         struct cfg80211_chan_def chandef = {};
13384         const u8 *addr;
13385         u8 oper_class;
13386         int err;
13387
13388         if (!rdev->ops->tdls_channel_switch ||
13389             !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
13390                 return -EOPNOTSUPP;
13391
13392         switch (dev->ieee80211_ptr->iftype) {
13393         case NL80211_IFTYPE_STATION:
13394         case NL80211_IFTYPE_P2P_CLIENT:
13395                 break;
13396         default:
13397                 return -EOPNOTSUPP;
13398         }
13399
13400         if (!info->attrs[NL80211_ATTR_MAC] ||
13401             !info->attrs[NL80211_ATTR_OPER_CLASS])
13402                 return -EINVAL;
13403
13404         err = nl80211_parse_chandef(rdev, info, &chandef);
13405         if (err)
13406                 return err;
13407
13408         /*
13409          * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
13410          * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
13411          * specification is not defined for them.
13412          */
13413         if (chandef.chan->band == NL80211_BAND_2GHZ &&
13414             chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
13415             chandef.width != NL80211_CHAN_WIDTH_20)
13416                 return -EINVAL;
13417
13418         /* we will be active on the TDLS link */
13419         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
13420                                            wdev->iftype))
13421                 return -EINVAL;
13422
13423         /* don't allow switching to DFS channels */
13424         if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
13425                 return -EINVAL;
13426
13427         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
13428         oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
13429
13430         wdev_lock(wdev);
13431         err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
13432         wdev_unlock(wdev);
13433
13434         return err;
13435 }
13436
13437 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
13438                                               struct genl_info *info)
13439 {
13440         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13441         struct net_device *dev = info->user_ptr[1];
13442         struct wireless_dev *wdev = dev->ieee80211_ptr;
13443         const u8 *addr;
13444
13445         if (!rdev->ops->tdls_channel_switch ||
13446             !rdev->ops->tdls_cancel_channel_switch ||
13447             !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
13448                 return -EOPNOTSUPP;
13449
13450         switch (dev->ieee80211_ptr->iftype) {
13451         case NL80211_IFTYPE_STATION:
13452         case NL80211_IFTYPE_P2P_CLIENT:
13453                 break;
13454         default:
13455                 return -EOPNOTSUPP;
13456         }
13457
13458         if (!info->attrs[NL80211_ATTR_MAC])
13459                 return -EINVAL;
13460
13461         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
13462
13463         wdev_lock(wdev);
13464         rdev_tdls_cancel_channel_switch(rdev, dev, addr);
13465         wdev_unlock(wdev);
13466
13467         return 0;
13468 }
13469
13470 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
13471                                             struct genl_info *info)
13472 {
13473         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13474         struct net_device *dev = info->user_ptr[1];
13475         struct wireless_dev *wdev = dev->ieee80211_ptr;
13476         const struct nlattr *nla;
13477         bool enabled;
13478
13479         if (!rdev->ops->set_multicast_to_unicast)
13480                 return -EOPNOTSUPP;
13481
13482         if (wdev->iftype != NL80211_IFTYPE_AP &&
13483             wdev->iftype != NL80211_IFTYPE_P2P_GO)
13484                 return -EOPNOTSUPP;
13485
13486         nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
13487         enabled = nla_get_flag(nla);
13488
13489         return rdev_set_multicast_to_unicast(rdev, dev, enabled);
13490 }
13491
13492 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
13493 {
13494         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13495         struct net_device *dev = info->user_ptr[1];
13496         struct wireless_dev *wdev = dev->ieee80211_ptr;
13497         struct cfg80211_pmk_conf pmk_conf = {};
13498         int ret;
13499
13500         if (wdev->iftype != NL80211_IFTYPE_STATION &&
13501             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
13502                 return -EOPNOTSUPP;
13503
13504         if (!wiphy_ext_feature_isset(&rdev->wiphy,
13505                                      NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
13506                 return -EOPNOTSUPP;
13507
13508         if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
13509                 return -EINVAL;
13510
13511         wdev_lock(wdev);
13512         if (!wdev->current_bss) {
13513                 ret = -ENOTCONN;
13514                 goto out;
13515         }
13516
13517         pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
13518         if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) {
13519                 ret = -EINVAL;
13520                 goto out;
13521         }
13522
13523         pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
13524         pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
13525         if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
13526             pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
13527                 ret = -EINVAL;
13528                 goto out;
13529         }
13530
13531         if (info->attrs[NL80211_ATTR_PMKR0_NAME]) {
13532                 int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]);
13533
13534                 if (r0_name_len != WLAN_PMK_NAME_LEN) {
13535                         ret = -EINVAL;
13536                         goto out;
13537                 }
13538
13539                 pmk_conf.pmk_r0_name =
13540                         nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
13541         }
13542
13543         ret = rdev_set_pmk(rdev, dev, &pmk_conf);
13544 out:
13545         wdev_unlock(wdev);
13546         return ret;
13547 }
13548
13549 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
13550 {
13551         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13552         struct net_device *dev = info->user_ptr[1];
13553         struct wireless_dev *wdev = dev->ieee80211_ptr;
13554         const u8 *aa;
13555         int ret;
13556
13557         if (wdev->iftype != NL80211_IFTYPE_STATION &&
13558             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
13559                 return -EOPNOTSUPP;
13560
13561         if (!wiphy_ext_feature_isset(&rdev->wiphy,
13562                                      NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
13563                 return -EOPNOTSUPP;
13564
13565         if (!info->attrs[NL80211_ATTR_MAC])
13566                 return -EINVAL;
13567
13568         wdev_lock(wdev);
13569         aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
13570         ret = rdev_del_pmk(rdev, dev, aa);
13571         wdev_unlock(wdev);
13572
13573         return ret;
13574 }
13575
13576 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
13577 {
13578         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13579         struct net_device *dev = info->user_ptr[1];
13580         struct cfg80211_external_auth_params params;
13581
13582         if (!rdev->ops->external_auth)
13583                 return -EOPNOTSUPP;
13584
13585         if (!info->attrs[NL80211_ATTR_SSID] &&
13586             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
13587             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
13588                 return -EINVAL;
13589
13590         if (!info->attrs[NL80211_ATTR_BSSID])
13591                 return -EINVAL;
13592
13593         if (!info->attrs[NL80211_ATTR_STATUS_CODE])
13594                 return -EINVAL;
13595
13596         memset(&params, 0, sizeof(params));
13597
13598         if (info->attrs[NL80211_ATTR_SSID]) {
13599                 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
13600                 if (params.ssid.ssid_len == 0 ||
13601                     params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN)
13602                         return -EINVAL;
13603                 memcpy(params.ssid.ssid,
13604                        nla_data(info->attrs[NL80211_ATTR_SSID]),
13605                        params.ssid.ssid_len);
13606         }
13607
13608         memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
13609                ETH_ALEN);
13610
13611         params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
13612
13613         if (info->attrs[NL80211_ATTR_PMKID])
13614                 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
13615
13616         return rdev_external_auth(rdev, dev, &params);
13617 }
13618
13619 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
13620 {
13621         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13622         struct net_device *dev = info->user_ptr[1];
13623         struct wireless_dev *wdev = dev->ieee80211_ptr;
13624         const u8 *buf;
13625         size_t len;
13626         u8 *dest;
13627         u16 proto;
13628         bool noencrypt;
13629         int err;
13630
13631         if (!wiphy_ext_feature_isset(&rdev->wiphy,
13632                                      NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
13633                 return -EOPNOTSUPP;
13634
13635         if (!rdev->ops->tx_control_port)
13636                 return -EOPNOTSUPP;
13637
13638         if (!info->attrs[NL80211_ATTR_FRAME] ||
13639             !info->attrs[NL80211_ATTR_MAC] ||
13640             !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
13641                 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
13642                 return -EINVAL;
13643         }
13644
13645         wdev_lock(wdev);
13646
13647         switch (wdev->iftype) {
13648         case NL80211_IFTYPE_AP:
13649         case NL80211_IFTYPE_P2P_GO:
13650         case NL80211_IFTYPE_MESH_POINT:
13651                 break;
13652         case NL80211_IFTYPE_ADHOC:
13653         case NL80211_IFTYPE_STATION:
13654         case NL80211_IFTYPE_P2P_CLIENT:
13655                 if (wdev->current_bss)
13656                         break;
13657                 err = -ENOTCONN;
13658                 goto out;
13659         default:
13660                 err = -EOPNOTSUPP;
13661                 goto out;
13662         }
13663
13664         wdev_unlock(wdev);
13665
13666         buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
13667         len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
13668         dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
13669         proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
13670         noencrypt =
13671                 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);
13672
13673         return rdev_tx_control_port(rdev, dev, buf, len,
13674                                     dest, cpu_to_be16(proto), noencrypt);
13675
13676  out:
13677         wdev_unlock(wdev);
13678         return err;
13679 }
13680
13681 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb,
13682                                            struct genl_info *info)
13683 {
13684         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13685         struct net_device *dev = info->user_ptr[1];
13686         struct wireless_dev *wdev = dev->ieee80211_ptr;
13687         struct cfg80211_ftm_responder_stats ftm_stats = {};
13688         struct sk_buff *msg;
13689         void *hdr;
13690         struct nlattr *ftm_stats_attr;
13691         int err;
13692
13693         if (wdev->iftype != NL80211_IFTYPE_AP || !wdev->beacon_interval)
13694                 return -EOPNOTSUPP;
13695
13696         err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats);
13697         if (err)
13698                 return err;
13699
13700         if (!ftm_stats.filled)
13701                 return -ENODATA;
13702
13703         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13704         if (!msg)
13705                 return -ENOMEM;
13706
13707         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
13708                              NL80211_CMD_GET_FTM_RESPONDER_STATS);
13709         if (!hdr)
13710                 goto nla_put_failure;
13711
13712         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
13713                 goto nla_put_failure;
13714
13715         ftm_stats_attr = nla_nest_start_noflag(msg,
13716                                                NL80211_ATTR_FTM_RESPONDER_STATS);
13717         if (!ftm_stats_attr)
13718                 goto nla_put_failure;
13719
13720 #define SET_FTM(field, name, type)                                       \
13721         do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
13722             nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name,            \
13723                              ftm_stats.field))                           \
13724                 goto nla_put_failure; } while (0)
13725 #define SET_FTM_U64(field, name)                                         \
13726         do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
13727             nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name,           \
13728                               ftm_stats.field, NL80211_FTM_STATS_PAD))   \
13729                 goto nla_put_failure; } while (0)
13730
13731         SET_FTM(success_num, SUCCESS_NUM, u32);
13732         SET_FTM(partial_num, PARTIAL_NUM, u32);
13733         SET_FTM(failed_num, FAILED_NUM, u32);
13734         SET_FTM(asap_num, ASAP_NUM, u32);
13735         SET_FTM(non_asap_num, NON_ASAP_NUM, u32);
13736         SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC);
13737         SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32);
13738         SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32);
13739         SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32);
13740 #undef SET_FTM
13741
13742         nla_nest_end(msg, ftm_stats_attr);
13743
13744         genlmsg_end(msg, hdr);
13745         return genlmsg_reply(msg, info);
13746
13747 nla_put_failure:
13748         nlmsg_free(msg);
13749         return -ENOBUFS;
13750 }
13751
13752 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info)
13753 {
13754         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13755         struct cfg80211_update_owe_info owe_info;
13756         struct net_device *dev = info->user_ptr[1];
13757
13758         if (!rdev->ops->update_owe_info)
13759                 return -EOPNOTSUPP;
13760
13761         if (!info->attrs[NL80211_ATTR_STATUS_CODE] ||
13762             !info->attrs[NL80211_ATTR_MAC])
13763                 return -EINVAL;
13764
13765         memset(&owe_info, 0, sizeof(owe_info));
13766         owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
13767         nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN);
13768
13769         if (info->attrs[NL80211_ATTR_IE]) {
13770                 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
13771                 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
13772         }
13773
13774         return rdev_update_owe_info(rdev, dev, &owe_info);
13775 }
13776
13777 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info)
13778 {
13779         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13780         struct net_device *dev = info->user_ptr[1];
13781         struct wireless_dev *wdev = dev->ieee80211_ptr;
13782         struct station_info sinfo = {};
13783         const u8 *buf;
13784         size_t len;
13785         u8 *dest;
13786         int err;
13787
13788         if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station)
13789                 return -EOPNOTSUPP;
13790
13791         if (!info->attrs[NL80211_ATTR_MAC] ||
13792             !info->attrs[NL80211_ATTR_FRAME]) {
13793                 GENL_SET_ERR_MSG(info, "Frame or MAC missing");
13794                 return -EINVAL;
13795         }
13796
13797         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
13798                 return -EOPNOTSUPP;
13799
13800         dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
13801         buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
13802         len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
13803
13804         if (len < sizeof(struct ethhdr))
13805                 return -EINVAL;
13806
13807         if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) ||
13808             !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr))
13809                 return -EINVAL;
13810
13811         err = rdev_get_station(rdev, dev, dest, &sinfo);
13812         if (err)
13813                 return err;
13814
13815         cfg80211_sinfo_release_content(&sinfo);
13816
13817         return rdev_probe_mesh_link(rdev, dev, dest, buf, len);
13818 }
13819
13820 #define NL80211_FLAG_NEED_WIPHY         0x01
13821 #define NL80211_FLAG_NEED_NETDEV        0x02
13822 #define NL80211_FLAG_NEED_RTNL          0x04
13823 #define NL80211_FLAG_CHECK_NETDEV_UP    0x08
13824 #define NL80211_FLAG_NEED_NETDEV_UP     (NL80211_FLAG_NEED_NETDEV |\
13825                                          NL80211_FLAG_CHECK_NETDEV_UP)
13826 #define NL80211_FLAG_NEED_WDEV          0x10
13827 /* If a netdev is associated, it must be UP, P2P must be started */
13828 #define NL80211_FLAG_NEED_WDEV_UP       (NL80211_FLAG_NEED_WDEV |\
13829                                          NL80211_FLAG_CHECK_NETDEV_UP)
13830 #define NL80211_FLAG_CLEAR_SKB          0x20
13831
13832 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
13833                             struct genl_info *info)
13834 {
13835         struct cfg80211_registered_device *rdev;
13836         struct wireless_dev *wdev;
13837         struct net_device *dev;
13838         bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
13839
13840         if (rtnl)
13841                 rtnl_lock();
13842
13843         if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
13844                 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
13845                 if (IS_ERR(rdev)) {
13846                         if (rtnl)
13847                                 rtnl_unlock();
13848                         return PTR_ERR(rdev);
13849                 }
13850                 info->user_ptr[0] = rdev;
13851         } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
13852                    ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
13853                 ASSERT_RTNL();
13854
13855                 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
13856                                                   info->attrs);
13857                 if (IS_ERR(wdev)) {
13858                         if (rtnl)
13859                                 rtnl_unlock();
13860                         return PTR_ERR(wdev);
13861                 }
13862
13863                 dev = wdev->netdev;
13864                 rdev = wiphy_to_rdev(wdev->wiphy);
13865
13866                 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
13867                         if (!dev) {
13868                                 if (rtnl)
13869                                         rtnl_unlock();
13870                                 return -EINVAL;
13871                         }
13872
13873                         info->user_ptr[1] = dev;
13874                 } else {
13875                         info->user_ptr[1] = wdev;
13876                 }
13877
13878                 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
13879                     !wdev_running(wdev)) {
13880                         if (rtnl)
13881                                 rtnl_unlock();
13882                         return -ENETDOWN;
13883                 }
13884
13885                 if (dev)
13886                         dev_hold(dev);
13887
13888                 info->user_ptr[0] = rdev;
13889         }
13890
13891         return 0;
13892 }
13893
13894 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
13895                               struct genl_info *info)
13896 {
13897         if (info->user_ptr[1]) {
13898                 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
13899                         struct wireless_dev *wdev = info->user_ptr[1];
13900
13901                         if (wdev->netdev)
13902                                 dev_put(wdev->netdev);
13903                 } else {
13904                         dev_put(info->user_ptr[1]);
13905                 }
13906         }
13907
13908         if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
13909                 rtnl_unlock();
13910
13911         /* If needed, clear the netlink message payload from the SKB
13912          * as it might contain key data that shouldn't stick around on
13913          * the heap after the SKB is freed. The netlink message header
13914          * is still needed for further processing, so leave it intact.
13915          */
13916         if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
13917                 struct nlmsghdr *nlh = nlmsg_hdr(skb);
13918
13919                 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
13920         }
13921 }
13922
13923 static const struct genl_ops nl80211_ops[] = {
13924         {
13925                 .cmd = NL80211_CMD_GET_WIPHY,
13926                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13927                 .doit = nl80211_get_wiphy,
13928                 .dumpit = nl80211_dump_wiphy,
13929                 .done = nl80211_dump_wiphy_done,
13930                 /* can be retrieved by unprivileged users */
13931                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13932                                   NL80211_FLAG_NEED_RTNL,
13933         },
13934         {
13935                 .cmd = NL80211_CMD_SET_WIPHY,
13936                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13937                 .doit = nl80211_set_wiphy,
13938                 .flags = GENL_UNS_ADMIN_PERM,
13939                 .internal_flags = NL80211_FLAG_NEED_RTNL,
13940         },
13941         {
13942                 .cmd = NL80211_CMD_GET_INTERFACE,
13943                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13944                 .doit = nl80211_get_interface,
13945                 .dumpit = nl80211_dump_interface,
13946                 /* can be retrieved by unprivileged users */
13947                 .internal_flags = NL80211_FLAG_NEED_WDEV |
13948                                   NL80211_FLAG_NEED_RTNL,
13949         },
13950         {
13951                 .cmd = NL80211_CMD_SET_INTERFACE,
13952                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13953                 .doit = nl80211_set_interface,
13954                 .flags = GENL_UNS_ADMIN_PERM,
13955                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13956                                   NL80211_FLAG_NEED_RTNL,
13957         },
13958         {
13959                 .cmd = NL80211_CMD_NEW_INTERFACE,
13960                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13961                 .doit = nl80211_new_interface,
13962                 .flags = GENL_UNS_ADMIN_PERM,
13963                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13964                                   NL80211_FLAG_NEED_RTNL,
13965         },
13966         {
13967                 .cmd = NL80211_CMD_DEL_INTERFACE,
13968                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13969                 .doit = nl80211_del_interface,
13970                 .flags = GENL_UNS_ADMIN_PERM,
13971                 .internal_flags = NL80211_FLAG_NEED_WDEV |
13972                                   NL80211_FLAG_NEED_RTNL,
13973         },
13974         {
13975                 .cmd = NL80211_CMD_GET_KEY,
13976                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13977                 .doit = nl80211_get_key,
13978                 .flags = GENL_UNS_ADMIN_PERM,
13979                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13980                                   NL80211_FLAG_NEED_RTNL,
13981         },
13982         {
13983                 .cmd = NL80211_CMD_SET_KEY,
13984                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13985                 .doit = nl80211_set_key,
13986                 .flags = GENL_UNS_ADMIN_PERM,
13987                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13988                                   NL80211_FLAG_NEED_RTNL |
13989                                   NL80211_FLAG_CLEAR_SKB,
13990         },
13991         {
13992                 .cmd = NL80211_CMD_NEW_KEY,
13993                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13994                 .doit = nl80211_new_key,
13995                 .flags = GENL_UNS_ADMIN_PERM,
13996                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13997                                   NL80211_FLAG_NEED_RTNL |
13998                                   NL80211_FLAG_CLEAR_SKB,
13999         },
14000         {
14001                 .cmd = NL80211_CMD_DEL_KEY,
14002                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14003                 .doit = nl80211_del_key,
14004                 .flags = GENL_UNS_ADMIN_PERM,
14005                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14006                                   NL80211_FLAG_NEED_RTNL,
14007         },
14008         {
14009                 .cmd = NL80211_CMD_SET_BEACON,
14010                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14011                 .flags = GENL_UNS_ADMIN_PERM,
14012                 .doit = nl80211_set_beacon,
14013                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14014                                   NL80211_FLAG_NEED_RTNL,
14015         },
14016         {
14017                 .cmd = NL80211_CMD_START_AP,
14018                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14019                 .flags = GENL_UNS_ADMIN_PERM,
14020                 .doit = nl80211_start_ap,
14021                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14022                                   NL80211_FLAG_NEED_RTNL,
14023         },
14024         {
14025                 .cmd = NL80211_CMD_STOP_AP,
14026                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14027                 .flags = GENL_UNS_ADMIN_PERM,
14028                 .doit = nl80211_stop_ap,
14029                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14030                                   NL80211_FLAG_NEED_RTNL,
14031         },
14032         {
14033                 .cmd = NL80211_CMD_GET_STATION,
14034                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14035                 .doit = nl80211_get_station,
14036                 .dumpit = nl80211_dump_station,
14037                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14038                                   NL80211_FLAG_NEED_RTNL,
14039         },
14040         {
14041                 .cmd = NL80211_CMD_SET_STATION,
14042                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14043                 .doit = nl80211_set_station,
14044                 .flags = GENL_UNS_ADMIN_PERM,
14045                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14046                                   NL80211_FLAG_NEED_RTNL,
14047         },
14048         {
14049                 .cmd = NL80211_CMD_NEW_STATION,
14050                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14051                 .doit = nl80211_new_station,
14052                 .flags = GENL_UNS_ADMIN_PERM,
14053                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14054                                   NL80211_FLAG_NEED_RTNL,
14055         },
14056         {
14057                 .cmd = NL80211_CMD_DEL_STATION,
14058                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14059                 .doit = nl80211_del_station,
14060                 .flags = GENL_UNS_ADMIN_PERM,
14061                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14062                                   NL80211_FLAG_NEED_RTNL,
14063         },
14064         {
14065                 .cmd = NL80211_CMD_GET_MPATH,
14066                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14067                 .doit = nl80211_get_mpath,
14068                 .dumpit = nl80211_dump_mpath,
14069                 .flags = GENL_UNS_ADMIN_PERM,
14070                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14071                                   NL80211_FLAG_NEED_RTNL,
14072         },
14073         {
14074                 .cmd = NL80211_CMD_GET_MPP,
14075                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14076                 .doit = nl80211_get_mpp,
14077                 .dumpit = nl80211_dump_mpp,
14078                 .flags = GENL_UNS_ADMIN_PERM,
14079                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14080                                   NL80211_FLAG_NEED_RTNL,
14081         },
14082         {
14083                 .cmd = NL80211_CMD_SET_MPATH,
14084                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14085                 .doit = nl80211_set_mpath,
14086                 .flags = GENL_UNS_ADMIN_PERM,
14087                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14088                                   NL80211_FLAG_NEED_RTNL,
14089         },
14090         {
14091                 .cmd = NL80211_CMD_NEW_MPATH,
14092                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14093                 .doit = nl80211_new_mpath,
14094                 .flags = GENL_UNS_ADMIN_PERM,
14095                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14096                                   NL80211_FLAG_NEED_RTNL,
14097         },
14098         {
14099                 .cmd = NL80211_CMD_DEL_MPATH,
14100                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14101                 .doit = nl80211_del_mpath,
14102                 .flags = GENL_UNS_ADMIN_PERM,
14103                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14104                                   NL80211_FLAG_NEED_RTNL,
14105         },
14106         {
14107                 .cmd = NL80211_CMD_SET_BSS,
14108                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14109                 .doit = nl80211_set_bss,
14110                 .flags = GENL_UNS_ADMIN_PERM,
14111                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14112                                   NL80211_FLAG_NEED_RTNL,
14113         },
14114         {
14115                 .cmd = NL80211_CMD_GET_REG,
14116                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14117                 .doit = nl80211_get_reg_do,
14118                 .dumpit = nl80211_get_reg_dump,
14119                 .internal_flags = NL80211_FLAG_NEED_RTNL,
14120                 /* can be retrieved by unprivileged users */
14121         },
14122 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
14123         {
14124                 .cmd = NL80211_CMD_SET_REG,
14125                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14126                 .doit = nl80211_set_reg,
14127                 .flags = GENL_ADMIN_PERM,
14128                 .internal_flags = NL80211_FLAG_NEED_RTNL,
14129         },
14130 #endif
14131         {
14132                 .cmd = NL80211_CMD_REQ_SET_REG,
14133                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14134                 .doit = nl80211_req_set_reg,
14135                 .flags = GENL_ADMIN_PERM,
14136         },
14137         {
14138                 .cmd = NL80211_CMD_RELOAD_REGDB,
14139                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14140                 .doit = nl80211_reload_regdb,
14141                 .flags = GENL_ADMIN_PERM,
14142         },
14143         {
14144                 .cmd = NL80211_CMD_GET_MESH_CONFIG,
14145                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14146                 .doit = nl80211_get_mesh_config,
14147                 /* can be retrieved by unprivileged users */
14148                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14149                                   NL80211_FLAG_NEED_RTNL,
14150         },
14151         {
14152                 .cmd = NL80211_CMD_SET_MESH_CONFIG,
14153                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14154                 .doit = nl80211_update_mesh_config,
14155                 .flags = GENL_UNS_ADMIN_PERM,
14156                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14157                                   NL80211_FLAG_NEED_RTNL,
14158         },
14159         {
14160                 .cmd = NL80211_CMD_TRIGGER_SCAN,
14161                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14162                 .doit = nl80211_trigger_scan,
14163                 .flags = GENL_UNS_ADMIN_PERM,
14164                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14165                                   NL80211_FLAG_NEED_RTNL,
14166         },
14167         {
14168                 .cmd = NL80211_CMD_ABORT_SCAN,
14169                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14170                 .doit = nl80211_abort_scan,
14171                 .flags = GENL_UNS_ADMIN_PERM,
14172                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14173                                   NL80211_FLAG_NEED_RTNL,
14174         },
14175         {
14176                 .cmd = NL80211_CMD_GET_SCAN,
14177                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14178                 .dumpit = nl80211_dump_scan,
14179         },
14180         {
14181                 .cmd = NL80211_CMD_START_SCHED_SCAN,
14182                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14183                 .doit = nl80211_start_sched_scan,
14184                 .flags = GENL_UNS_ADMIN_PERM,
14185                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14186                                   NL80211_FLAG_NEED_RTNL,
14187         },
14188         {
14189                 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
14190                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14191                 .doit = nl80211_stop_sched_scan,
14192                 .flags = GENL_UNS_ADMIN_PERM,
14193                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14194                                   NL80211_FLAG_NEED_RTNL,
14195         },
14196         {
14197                 .cmd = NL80211_CMD_AUTHENTICATE,
14198                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14199                 .doit = nl80211_authenticate,
14200                 .flags = GENL_UNS_ADMIN_PERM,
14201                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14202                                   NL80211_FLAG_NEED_RTNL |
14203                                   NL80211_FLAG_CLEAR_SKB,
14204         },
14205         {
14206                 .cmd = NL80211_CMD_ASSOCIATE,
14207                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14208                 .doit = nl80211_associate,
14209                 .flags = GENL_UNS_ADMIN_PERM,
14210                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14211                                   NL80211_FLAG_NEED_RTNL |
14212                                   NL80211_FLAG_CLEAR_SKB,
14213         },
14214         {
14215                 .cmd = NL80211_CMD_DEAUTHENTICATE,
14216                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14217                 .doit = nl80211_deauthenticate,
14218                 .flags = GENL_UNS_ADMIN_PERM,
14219                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14220                                   NL80211_FLAG_NEED_RTNL,
14221         },
14222         {
14223                 .cmd = NL80211_CMD_DISASSOCIATE,
14224                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14225                 .doit = nl80211_disassociate,
14226                 .flags = GENL_UNS_ADMIN_PERM,
14227                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14228                                   NL80211_FLAG_NEED_RTNL,
14229         },
14230         {
14231                 .cmd = NL80211_CMD_JOIN_IBSS,
14232                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14233                 .doit = nl80211_join_ibss,
14234                 .flags = GENL_UNS_ADMIN_PERM,
14235                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14236                                   NL80211_FLAG_NEED_RTNL,
14237         },
14238         {
14239                 .cmd = NL80211_CMD_LEAVE_IBSS,
14240                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14241                 .doit = nl80211_leave_ibss,
14242                 .flags = GENL_UNS_ADMIN_PERM,
14243                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14244                                   NL80211_FLAG_NEED_RTNL,
14245         },
14246 #ifdef CONFIG_NL80211_TESTMODE
14247         {
14248                 .cmd = NL80211_CMD_TESTMODE,
14249                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14250                 .doit = nl80211_testmode_do,
14251                 .dumpit = nl80211_testmode_dump,
14252                 .flags = GENL_UNS_ADMIN_PERM,
14253                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14254                                   NL80211_FLAG_NEED_RTNL,
14255         },
14256 #endif
14257         {
14258                 .cmd = NL80211_CMD_CONNECT,
14259                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14260                 .doit = nl80211_connect,
14261                 .flags = GENL_UNS_ADMIN_PERM,
14262                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14263                                   NL80211_FLAG_NEED_RTNL |
14264                                   NL80211_FLAG_CLEAR_SKB,
14265         },
14266         {
14267                 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
14268                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14269                 .doit = nl80211_update_connect_params,
14270                 .flags = GENL_ADMIN_PERM,
14271                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14272                                   NL80211_FLAG_NEED_RTNL |
14273                                   NL80211_FLAG_CLEAR_SKB,
14274         },
14275         {
14276                 .cmd = NL80211_CMD_DISCONNECT,
14277                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14278                 .doit = nl80211_disconnect,
14279                 .flags = GENL_UNS_ADMIN_PERM,
14280                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14281                                   NL80211_FLAG_NEED_RTNL,
14282         },
14283         {
14284                 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
14285                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14286                 .doit = nl80211_wiphy_netns,
14287                 .flags = GENL_UNS_ADMIN_PERM,
14288                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14289                                   NL80211_FLAG_NEED_RTNL,
14290         },
14291         {
14292                 .cmd = NL80211_CMD_GET_SURVEY,
14293                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14294                 .dumpit = nl80211_dump_survey,
14295         },
14296         {
14297                 .cmd = NL80211_CMD_SET_PMKSA,
14298                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14299                 .doit = nl80211_setdel_pmksa,
14300                 .flags = GENL_UNS_ADMIN_PERM,
14301                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14302                                   NL80211_FLAG_NEED_RTNL |
14303                                   NL80211_FLAG_CLEAR_SKB,
14304         },
14305         {
14306                 .cmd = NL80211_CMD_DEL_PMKSA,
14307                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14308                 .doit = nl80211_setdel_pmksa,
14309                 .flags = GENL_UNS_ADMIN_PERM,
14310                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14311                                   NL80211_FLAG_NEED_RTNL,
14312         },
14313         {
14314                 .cmd = NL80211_CMD_FLUSH_PMKSA,
14315                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14316                 .doit = nl80211_flush_pmksa,
14317                 .flags = GENL_UNS_ADMIN_PERM,
14318                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14319                                   NL80211_FLAG_NEED_RTNL,
14320         },
14321         {
14322                 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
14323                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14324                 .doit = nl80211_remain_on_channel,
14325                 .flags = GENL_UNS_ADMIN_PERM,
14326                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14327                                   NL80211_FLAG_NEED_RTNL,
14328         },
14329         {
14330                 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
14331                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14332                 .doit = nl80211_cancel_remain_on_channel,
14333                 .flags = GENL_UNS_ADMIN_PERM,
14334                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14335                                   NL80211_FLAG_NEED_RTNL,
14336         },
14337         {
14338                 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
14339                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14340                 .doit = nl80211_set_tx_bitrate_mask,
14341                 .flags = GENL_UNS_ADMIN_PERM,
14342                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14343                                   NL80211_FLAG_NEED_RTNL,
14344         },
14345         {
14346                 .cmd = NL80211_CMD_REGISTER_FRAME,
14347                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14348                 .doit = nl80211_register_mgmt,
14349                 .flags = GENL_UNS_ADMIN_PERM,
14350                 .internal_flags = NL80211_FLAG_NEED_WDEV |
14351                                   NL80211_FLAG_NEED_RTNL,
14352         },
14353         {
14354                 .cmd = NL80211_CMD_FRAME,
14355                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14356                 .doit = nl80211_tx_mgmt,
14357                 .flags = GENL_UNS_ADMIN_PERM,
14358                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14359                                   NL80211_FLAG_NEED_RTNL,
14360         },
14361         {
14362                 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
14363                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14364                 .doit = nl80211_tx_mgmt_cancel_wait,
14365                 .flags = GENL_UNS_ADMIN_PERM,
14366                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14367                                   NL80211_FLAG_NEED_RTNL,
14368         },
14369         {
14370                 .cmd = NL80211_CMD_SET_POWER_SAVE,
14371                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14372                 .doit = nl80211_set_power_save,
14373                 .flags = GENL_UNS_ADMIN_PERM,
14374                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14375                                   NL80211_FLAG_NEED_RTNL,
14376         },
14377         {
14378                 .cmd = NL80211_CMD_GET_POWER_SAVE,
14379                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14380                 .doit = nl80211_get_power_save,
14381                 /* can be retrieved by unprivileged users */
14382                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14383                                   NL80211_FLAG_NEED_RTNL,
14384         },
14385         {
14386                 .cmd = NL80211_CMD_SET_CQM,
14387                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14388                 .doit = nl80211_set_cqm,
14389                 .flags = GENL_UNS_ADMIN_PERM,
14390                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14391                                   NL80211_FLAG_NEED_RTNL,
14392         },
14393         {
14394                 .cmd = NL80211_CMD_SET_CHANNEL,
14395                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14396                 .doit = nl80211_set_channel,
14397                 .flags = GENL_UNS_ADMIN_PERM,
14398                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14399                                   NL80211_FLAG_NEED_RTNL,
14400         },
14401         {
14402                 .cmd = NL80211_CMD_SET_WDS_PEER,
14403                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14404                 .doit = nl80211_set_wds_peer,
14405                 .flags = GENL_UNS_ADMIN_PERM,
14406                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14407                                   NL80211_FLAG_NEED_RTNL,
14408         },
14409         {
14410                 .cmd = NL80211_CMD_JOIN_MESH,
14411                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14412                 .doit = nl80211_join_mesh,
14413                 .flags = GENL_UNS_ADMIN_PERM,
14414                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14415                                   NL80211_FLAG_NEED_RTNL,
14416         },
14417         {
14418                 .cmd = NL80211_CMD_LEAVE_MESH,
14419                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14420                 .doit = nl80211_leave_mesh,
14421                 .flags = GENL_UNS_ADMIN_PERM,
14422                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14423                                   NL80211_FLAG_NEED_RTNL,
14424         },
14425         {
14426                 .cmd = NL80211_CMD_JOIN_OCB,
14427                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14428                 .doit = nl80211_join_ocb,
14429                 .flags = GENL_UNS_ADMIN_PERM,
14430                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14431                                   NL80211_FLAG_NEED_RTNL,
14432         },
14433         {
14434                 .cmd = NL80211_CMD_LEAVE_OCB,
14435                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14436                 .doit = nl80211_leave_ocb,
14437                 .flags = GENL_UNS_ADMIN_PERM,
14438                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14439                                   NL80211_FLAG_NEED_RTNL,
14440         },
14441 #ifdef CONFIG_PM
14442         {
14443                 .cmd = NL80211_CMD_GET_WOWLAN,
14444                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14445                 .doit = nl80211_get_wowlan,
14446                 /* can be retrieved by unprivileged users */
14447                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14448                                   NL80211_FLAG_NEED_RTNL,
14449         },
14450         {
14451                 .cmd = NL80211_CMD_SET_WOWLAN,
14452                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14453                 .doit = nl80211_set_wowlan,
14454                 .flags = GENL_UNS_ADMIN_PERM,
14455                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14456                                   NL80211_FLAG_NEED_RTNL,
14457         },
14458 #endif
14459         {
14460                 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
14461                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14462                 .doit = nl80211_set_rekey_data,
14463                 .flags = GENL_UNS_ADMIN_PERM,
14464                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14465                                   NL80211_FLAG_NEED_RTNL |
14466                                   NL80211_FLAG_CLEAR_SKB,
14467         },
14468         {
14469                 .cmd = NL80211_CMD_TDLS_MGMT,
14470                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14471                 .doit = nl80211_tdls_mgmt,
14472                 .flags = GENL_UNS_ADMIN_PERM,
14473                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14474                                   NL80211_FLAG_NEED_RTNL,
14475         },
14476         {
14477                 .cmd = NL80211_CMD_TDLS_OPER,
14478                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14479                 .doit = nl80211_tdls_oper,
14480                 .flags = GENL_UNS_ADMIN_PERM,
14481                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14482                                   NL80211_FLAG_NEED_RTNL,
14483         },
14484         {
14485                 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
14486                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14487                 .doit = nl80211_register_unexpected_frame,
14488                 .flags = GENL_UNS_ADMIN_PERM,
14489                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14490                                   NL80211_FLAG_NEED_RTNL,
14491         },
14492         {
14493                 .cmd = NL80211_CMD_PROBE_CLIENT,
14494                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14495                 .doit = nl80211_probe_client,
14496                 .flags = GENL_UNS_ADMIN_PERM,
14497                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14498                                   NL80211_FLAG_NEED_RTNL,
14499         },
14500         {
14501                 .cmd = NL80211_CMD_REGISTER_BEACONS,
14502                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14503                 .doit = nl80211_register_beacons,
14504                 .flags = GENL_UNS_ADMIN_PERM,
14505                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14506                                   NL80211_FLAG_NEED_RTNL,
14507         },
14508         {
14509                 .cmd = NL80211_CMD_SET_NOACK_MAP,
14510                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14511                 .doit = nl80211_set_noack_map,
14512                 .flags = GENL_UNS_ADMIN_PERM,
14513                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14514                                   NL80211_FLAG_NEED_RTNL,
14515         },
14516         {
14517                 .cmd = NL80211_CMD_START_P2P_DEVICE,
14518                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14519                 .doit = nl80211_start_p2p_device,
14520                 .flags = GENL_UNS_ADMIN_PERM,
14521                 .internal_flags = NL80211_FLAG_NEED_WDEV |
14522                                   NL80211_FLAG_NEED_RTNL,
14523         },
14524         {
14525                 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
14526                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14527                 .doit = nl80211_stop_p2p_device,
14528                 .flags = GENL_UNS_ADMIN_PERM,
14529                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14530                                   NL80211_FLAG_NEED_RTNL,
14531         },
14532         {
14533                 .cmd = NL80211_CMD_START_NAN,
14534                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14535                 .doit = nl80211_start_nan,
14536                 .flags = GENL_ADMIN_PERM,
14537                 .internal_flags = NL80211_FLAG_NEED_WDEV |
14538                                   NL80211_FLAG_NEED_RTNL,
14539         },
14540         {
14541                 .cmd = NL80211_CMD_STOP_NAN,
14542                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14543                 .doit = nl80211_stop_nan,
14544                 .flags = GENL_ADMIN_PERM,
14545                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14546                                   NL80211_FLAG_NEED_RTNL,
14547         },
14548         {
14549                 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
14550                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14551                 .doit = nl80211_nan_add_func,
14552                 .flags = GENL_ADMIN_PERM,
14553                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14554                                   NL80211_FLAG_NEED_RTNL,
14555         },
14556         {
14557                 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
14558                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14559                 .doit = nl80211_nan_del_func,
14560                 .flags = GENL_ADMIN_PERM,
14561                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14562                                   NL80211_FLAG_NEED_RTNL,
14563         },
14564         {
14565                 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
14566                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14567                 .doit = nl80211_nan_change_config,
14568                 .flags = GENL_ADMIN_PERM,
14569                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14570                                   NL80211_FLAG_NEED_RTNL,
14571         },
14572         {
14573                 .cmd = NL80211_CMD_SET_MCAST_RATE,
14574                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14575                 .doit = nl80211_set_mcast_rate,
14576                 .flags = GENL_UNS_ADMIN_PERM,
14577                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14578                                   NL80211_FLAG_NEED_RTNL,
14579         },
14580         {
14581                 .cmd = NL80211_CMD_SET_MAC_ACL,
14582                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14583                 .doit = nl80211_set_mac_acl,
14584                 .flags = GENL_UNS_ADMIN_PERM,
14585                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14586                                   NL80211_FLAG_NEED_RTNL,
14587         },
14588         {
14589                 .cmd = NL80211_CMD_RADAR_DETECT,
14590                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14591                 .doit = nl80211_start_radar_detection,
14592                 .flags = GENL_UNS_ADMIN_PERM,
14593                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14594                                   NL80211_FLAG_NEED_RTNL,
14595         },
14596         {
14597                 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
14598                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14599                 .doit = nl80211_get_protocol_features,
14600         },
14601         {
14602                 .cmd = NL80211_CMD_UPDATE_FT_IES,
14603                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14604                 .doit = nl80211_update_ft_ies,
14605                 .flags = GENL_UNS_ADMIN_PERM,
14606                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14607                                   NL80211_FLAG_NEED_RTNL,
14608         },
14609         {
14610                 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
14611                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14612                 .doit = nl80211_crit_protocol_start,
14613                 .flags = GENL_UNS_ADMIN_PERM,
14614                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14615                                   NL80211_FLAG_NEED_RTNL,
14616         },
14617         {
14618                 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
14619                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14620                 .doit = nl80211_crit_protocol_stop,
14621                 .flags = GENL_UNS_ADMIN_PERM,
14622                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14623                                   NL80211_FLAG_NEED_RTNL,
14624         },
14625         {
14626                 .cmd = NL80211_CMD_GET_COALESCE,
14627                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14628                 .doit = nl80211_get_coalesce,
14629                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14630                                   NL80211_FLAG_NEED_RTNL,
14631         },
14632         {
14633                 .cmd = NL80211_CMD_SET_COALESCE,
14634                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14635                 .doit = nl80211_set_coalesce,
14636                 .flags = GENL_UNS_ADMIN_PERM,
14637                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14638                                   NL80211_FLAG_NEED_RTNL,
14639         },
14640         {
14641                 .cmd = NL80211_CMD_CHANNEL_SWITCH,
14642                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14643                 .doit = nl80211_channel_switch,
14644                 .flags = GENL_UNS_ADMIN_PERM,
14645                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14646                                   NL80211_FLAG_NEED_RTNL,
14647         },
14648         {
14649                 .cmd = NL80211_CMD_VENDOR,
14650                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14651                 .doit = nl80211_vendor_cmd,
14652                 .dumpit = nl80211_vendor_cmd_dump,
14653                 .flags = GENL_UNS_ADMIN_PERM,
14654                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14655                                   NL80211_FLAG_NEED_RTNL |
14656                                   NL80211_FLAG_CLEAR_SKB,
14657         },
14658         {
14659                 .cmd = NL80211_CMD_SET_QOS_MAP,
14660                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14661                 .doit = nl80211_set_qos_map,
14662                 .flags = GENL_UNS_ADMIN_PERM,
14663                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14664                                   NL80211_FLAG_NEED_RTNL,
14665         },
14666         {
14667                 .cmd = NL80211_CMD_ADD_TX_TS,
14668                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14669                 .doit = nl80211_add_tx_ts,
14670                 .flags = GENL_UNS_ADMIN_PERM,
14671                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14672                                   NL80211_FLAG_NEED_RTNL,
14673         },
14674         {
14675                 .cmd = NL80211_CMD_DEL_TX_TS,
14676                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14677                 .doit = nl80211_del_tx_ts,
14678                 .flags = GENL_UNS_ADMIN_PERM,
14679                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14680                                   NL80211_FLAG_NEED_RTNL,
14681         },
14682         {
14683                 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
14684                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14685                 .doit = nl80211_tdls_channel_switch,
14686                 .flags = GENL_UNS_ADMIN_PERM,
14687                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14688                                   NL80211_FLAG_NEED_RTNL,
14689         },
14690         {
14691                 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
14692                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14693                 .doit = nl80211_tdls_cancel_channel_switch,
14694                 .flags = GENL_UNS_ADMIN_PERM,
14695                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14696                                   NL80211_FLAG_NEED_RTNL,
14697         },
14698         {
14699                 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
14700                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14701                 .doit = nl80211_set_multicast_to_unicast,
14702                 .flags = GENL_UNS_ADMIN_PERM,
14703                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14704                                   NL80211_FLAG_NEED_RTNL,
14705         },
14706         {
14707                 .cmd = NL80211_CMD_SET_PMK,
14708                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14709                 .doit = nl80211_set_pmk,
14710                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14711                                   NL80211_FLAG_NEED_RTNL |
14712                                   NL80211_FLAG_CLEAR_SKB,
14713         },
14714         {
14715                 .cmd = NL80211_CMD_DEL_PMK,
14716                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14717                 .doit = nl80211_del_pmk,
14718                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14719                                   NL80211_FLAG_NEED_RTNL,
14720         },
14721         {
14722                 .cmd = NL80211_CMD_EXTERNAL_AUTH,
14723                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14724                 .doit = nl80211_external_auth,
14725                 .flags = GENL_ADMIN_PERM,
14726                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14727                                   NL80211_FLAG_NEED_RTNL,
14728         },
14729         {
14730                 .cmd = NL80211_CMD_CONTROL_PORT_FRAME,
14731                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14732                 .doit = nl80211_tx_control_port,
14733                 .flags = GENL_UNS_ADMIN_PERM,
14734                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14735                                   NL80211_FLAG_NEED_RTNL,
14736         },
14737         {
14738                 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS,
14739                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14740                 .doit = nl80211_get_ftm_responder_stats,
14741                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14742                                   NL80211_FLAG_NEED_RTNL,
14743         },
14744         {
14745                 .cmd = NL80211_CMD_PEER_MEASUREMENT_START,
14746                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14747                 .doit = nl80211_pmsr_start,
14748                 .flags = GENL_UNS_ADMIN_PERM,
14749                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14750                                   NL80211_FLAG_NEED_RTNL,
14751         },
14752         {
14753                 .cmd = NL80211_CMD_NOTIFY_RADAR,
14754                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14755                 .doit = nl80211_notify_radar_detection,
14756                 .flags = GENL_UNS_ADMIN_PERM,
14757                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14758                                   NL80211_FLAG_NEED_RTNL,
14759         },
14760         {
14761                 .cmd = NL80211_CMD_UPDATE_OWE_INFO,
14762                 .doit = nl80211_update_owe_info,
14763                 .flags = GENL_ADMIN_PERM,
14764                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14765                                   NL80211_FLAG_NEED_RTNL,
14766         },
14767         {
14768                 .cmd = NL80211_CMD_PROBE_MESH_LINK,
14769                 .doit = nl80211_probe_mesh_link,
14770                 .flags = GENL_UNS_ADMIN_PERM,
14771                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14772                                   NL80211_FLAG_NEED_RTNL,
14773         },
14774 };
14775
14776 static struct genl_family nl80211_fam __ro_after_init = {
14777         .name = NL80211_GENL_NAME,      /* have users key off the name instead */
14778         .hdrsize = 0,                   /* no private header */
14779         .version = 1,                   /* no particular meaning now */
14780         .maxattr = NL80211_ATTR_MAX,
14781         .policy = nl80211_policy,
14782         .netnsok = true,
14783         .pre_doit = nl80211_pre_doit,
14784         .post_doit = nl80211_post_doit,
14785         .module = THIS_MODULE,
14786         .ops = nl80211_ops,
14787         .n_ops = ARRAY_SIZE(nl80211_ops),
14788         .mcgrps = nl80211_mcgrps,
14789         .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
14790         .parallel_ops = true,
14791 };
14792
14793 /* notification functions */
14794
14795 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
14796                           enum nl80211_commands cmd)
14797 {
14798         struct sk_buff *msg;
14799         struct nl80211_dump_wiphy_state state = {};
14800
14801         WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
14802                 cmd != NL80211_CMD_DEL_WIPHY);
14803
14804         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14805         if (!msg)
14806                 return;
14807
14808         if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
14809                 nlmsg_free(msg);
14810                 return;
14811         }
14812
14813         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14814                                 NL80211_MCGRP_CONFIG, GFP_KERNEL);
14815 }
14816
14817 void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
14818                                 struct wireless_dev *wdev,
14819                                 enum nl80211_commands cmd)
14820 {
14821         struct sk_buff *msg;
14822
14823         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14824         if (!msg)
14825                 return;
14826
14827         if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) {
14828                 nlmsg_free(msg);
14829                 return;
14830         }
14831
14832         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14833                                 NL80211_MCGRP_CONFIG, GFP_KERNEL);
14834 }
14835
14836 static int nl80211_add_scan_req(struct sk_buff *msg,
14837                                 struct cfg80211_registered_device *rdev)
14838 {
14839         struct cfg80211_scan_request *req = rdev->scan_req;
14840         struct nlattr *nest;
14841         int i;
14842
14843         if (WARN_ON(!req))
14844                 return 0;
14845
14846         nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS);
14847         if (!nest)
14848                 goto nla_put_failure;
14849         for (i = 0; i < req->n_ssids; i++) {
14850                 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
14851                         goto nla_put_failure;
14852         }
14853         nla_nest_end(msg, nest);
14854
14855         nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
14856         if (!nest)
14857                 goto nla_put_failure;
14858         for (i = 0; i < req->n_channels; i++) {
14859                 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
14860                         goto nla_put_failure;
14861         }
14862         nla_nest_end(msg, nest);
14863
14864         if (req->ie &&
14865             nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
14866                 goto nla_put_failure;
14867
14868         if (req->flags &&
14869             nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
14870                 goto nla_put_failure;
14871
14872         if (req->info.scan_start_tsf &&
14873             (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
14874                                req->info.scan_start_tsf, NL80211_BSS_PAD) ||
14875              nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
14876                      req->info.tsf_bssid)))
14877                 goto nla_put_failure;
14878
14879         return 0;
14880  nla_put_failure:
14881         return -ENOBUFS;
14882 }
14883
14884 static int nl80211_prep_scan_msg(struct sk_buff *msg,
14885                                  struct cfg80211_registered_device *rdev,
14886                                  struct wireless_dev *wdev,
14887                                  u32 portid, u32 seq, int flags,
14888                                  u32 cmd)
14889 {
14890         void *hdr;
14891
14892         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
14893         if (!hdr)
14894                 return -1;
14895
14896         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14897             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14898                                          wdev->netdev->ifindex)) ||
14899             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14900                               NL80211_ATTR_PAD))
14901                 goto nla_put_failure;
14902
14903         /* ignore errors and send incomplete event anyway */
14904         nl80211_add_scan_req(msg, rdev);
14905
14906         genlmsg_end(msg, hdr);
14907         return 0;
14908
14909  nla_put_failure:
14910         genlmsg_cancel(msg, hdr);
14911         return -EMSGSIZE;
14912 }
14913
14914 static int
14915 nl80211_prep_sched_scan_msg(struct sk_buff *msg,
14916                             struct cfg80211_sched_scan_request *req, u32 cmd)
14917 {
14918         void *hdr;
14919
14920         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14921         if (!hdr)
14922                 return -1;
14923
14924         if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
14925                         wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
14926             nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
14927             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
14928                               NL80211_ATTR_PAD))
14929                 goto nla_put_failure;
14930
14931         genlmsg_end(msg, hdr);
14932         return 0;
14933
14934  nla_put_failure:
14935         genlmsg_cancel(msg, hdr);
14936         return -EMSGSIZE;
14937 }
14938
14939 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
14940                              struct wireless_dev *wdev)
14941 {
14942         struct sk_buff *msg;
14943
14944         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14945         if (!msg)
14946                 return;
14947
14948         if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
14949                                   NL80211_CMD_TRIGGER_SCAN) < 0) {
14950                 nlmsg_free(msg);
14951                 return;
14952         }
14953
14954         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14955                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
14956 }
14957
14958 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
14959                                        struct wireless_dev *wdev, bool aborted)
14960 {
14961         struct sk_buff *msg;
14962
14963         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14964         if (!msg)
14965                 return NULL;
14966
14967         if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
14968                                   aborted ? NL80211_CMD_SCAN_ABORTED :
14969                                             NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
14970                 nlmsg_free(msg);
14971                 return NULL;
14972         }
14973
14974         return msg;
14975 }
14976
14977 /* send message created by nl80211_build_scan_msg() */
14978 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
14979                            struct sk_buff *msg)
14980 {
14981         if (!msg)
14982                 return;
14983
14984         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14985                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
14986 }
14987
14988 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
14989 {
14990         struct sk_buff *msg;
14991
14992         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14993         if (!msg)
14994                 return;
14995
14996         if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
14997                 nlmsg_free(msg);
14998                 return;
14999         }
15000
15001         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
15002                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
15003 }
15004
15005 static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
15006                                           struct regulatory_request *request)
15007 {
15008         /* Userspace can always count this one always being set */
15009         if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
15010                 goto nla_put_failure;
15011
15012         if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
15013                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15014                                NL80211_REGDOM_TYPE_WORLD))
15015                         goto nla_put_failure;
15016         } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
15017                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15018                                NL80211_REGDOM_TYPE_CUSTOM_WORLD))
15019                         goto nla_put_failure;
15020         } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
15021                    request->intersect) {
15022                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15023                                NL80211_REGDOM_TYPE_INTERSECTION))
15024                         goto nla_put_failure;
15025         } else {
15026                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
15027                                NL80211_REGDOM_TYPE_COUNTRY) ||
15028                     nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
15029                                    request->alpha2))
15030                         goto nla_put_failure;
15031         }
15032
15033         if (request->wiphy_idx != WIPHY_IDX_INVALID) {
15034                 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
15035
15036                 if (wiphy &&
15037                     nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
15038                         goto nla_put_failure;
15039
15040                 if (wiphy &&
15041                     wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
15042                     nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
15043                         goto nla_put_failure;
15044         }
15045
15046         return true;
15047
15048 nla_put_failure:
15049         return false;
15050 }
15051
15052 /*
15053  * This can happen on global regulatory changes or device specific settings
15054  * based on custom regulatory domains.
15055  */
15056 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
15057                                      struct regulatory_request *request)
15058 {
15059         struct sk_buff *msg;
15060         void *hdr;
15061
15062         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15063         if (!msg)
15064                 return;
15065
15066         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
15067         if (!hdr)
15068                 goto nla_put_failure;
15069
15070         if (!nl80211_reg_change_event_fill(msg, request))
15071                 goto nla_put_failure;
15072
15073         genlmsg_end(msg, hdr);
15074
15075         rcu_read_lock();
15076         genlmsg_multicast_allns(&nl80211_fam, msg, 0,
15077                                 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
15078         rcu_read_unlock();
15079
15080         return;
15081
15082 nla_put_failure:
15083         nlmsg_free(msg);
15084 }
15085
15086 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
15087                                     struct net_device *netdev,
15088                                     const u8 *buf, size_t len,
15089                                     enum nl80211_commands cmd, gfp_t gfp,
15090                                     int uapsd_queues, const u8 *req_ies,
15091                                     size_t req_ies_len)
15092 {
15093         struct sk_buff *msg;
15094         void *hdr;
15095
15096         msg = nlmsg_new(100 + len + req_ies_len, gfp);
15097         if (!msg)
15098                 return;
15099
15100         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15101         if (!hdr) {
15102                 nlmsg_free(msg);
15103                 return;
15104         }
15105
15106         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15107             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15108             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15109             (req_ies &&
15110              nla_put(msg, NL80211_ATTR_REQ_IE, req_ies_len, req_ies)))
15111                 goto nla_put_failure;
15112
15113         if (uapsd_queues >= 0) {
15114                 struct nlattr *nla_wmm =
15115                         nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME);
15116                 if (!nla_wmm)
15117                         goto nla_put_failure;
15118
15119                 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
15120                                uapsd_queues))
15121                         goto nla_put_failure;
15122
15123                 nla_nest_end(msg, nla_wmm);
15124         }
15125
15126         genlmsg_end(msg, hdr);
15127
15128         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15129                                 NL80211_MCGRP_MLME, gfp);
15130         return;
15131
15132  nla_put_failure:
15133         nlmsg_free(msg);
15134 }
15135
15136 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
15137                           struct net_device *netdev, const u8 *buf,
15138                           size_t len, gfp_t gfp)
15139 {
15140         nl80211_send_mlme_event(rdev, netdev, buf, len,
15141                                 NL80211_CMD_AUTHENTICATE, gfp, -1, NULL, 0);
15142 }
15143
15144 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
15145                            struct net_device *netdev, const u8 *buf,
15146                            size_t len, gfp_t gfp, int uapsd_queues,
15147                            const u8 *req_ies, size_t req_ies_len)
15148 {
15149         nl80211_send_mlme_event(rdev, netdev, buf, len,
15150                                 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues,
15151                                 req_ies, req_ies_len);
15152 }
15153
15154 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
15155                          struct net_device *netdev, const u8 *buf,
15156                          size_t len, gfp_t gfp)
15157 {
15158         nl80211_send_mlme_event(rdev, netdev, buf, len,
15159                                 NL80211_CMD_DEAUTHENTICATE, gfp, -1, NULL, 0);
15160 }
15161
15162 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
15163                            struct net_device *netdev, const u8 *buf,
15164                            size_t len, gfp_t gfp)
15165 {
15166         nl80211_send_mlme_event(rdev, netdev, buf, len,
15167                                 NL80211_CMD_DISASSOCIATE, gfp, -1, NULL, 0);
15168 }
15169
15170 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
15171                                   size_t len)
15172 {
15173         struct wireless_dev *wdev = dev->ieee80211_ptr;
15174         struct wiphy *wiphy = wdev->wiphy;
15175         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15176         const struct ieee80211_mgmt *mgmt = (void *)buf;
15177         u32 cmd;
15178
15179         if (WARN_ON(len < 2))
15180                 return;
15181
15182         if (ieee80211_is_deauth(mgmt->frame_control))
15183                 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
15184         else
15185                 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
15186
15187         trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
15188         nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1,
15189                                 NULL, 0);
15190 }
15191 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
15192
15193 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
15194                                       struct net_device *netdev, int cmd,
15195                                       const u8 *addr, gfp_t gfp)
15196 {
15197         struct sk_buff *msg;
15198         void *hdr;
15199
15200         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15201         if (!msg)
15202                 return;
15203
15204         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15205         if (!hdr) {
15206                 nlmsg_free(msg);
15207                 return;
15208         }
15209
15210         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15211             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15212             nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
15213             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
15214                 goto nla_put_failure;
15215
15216         genlmsg_end(msg, hdr);
15217
15218         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15219                                 NL80211_MCGRP_MLME, gfp);
15220         return;
15221
15222  nla_put_failure:
15223         nlmsg_free(msg);
15224 }
15225
15226 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
15227                                struct net_device *netdev, const u8 *addr,
15228                                gfp_t gfp)
15229 {
15230         nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
15231                                   addr, gfp);
15232 }
15233
15234 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
15235                                 struct net_device *netdev, const u8 *addr,
15236                                 gfp_t gfp)
15237 {
15238         nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
15239                                   addr, gfp);
15240 }
15241
15242 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
15243                                  struct net_device *netdev,
15244                                  struct cfg80211_connect_resp_params *cr,
15245                                  gfp_t gfp)
15246 {
15247         struct sk_buff *msg;
15248         void *hdr;
15249
15250         msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
15251                         cr->fils.kek_len + cr->fils.pmk_len +
15252                         (cr->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
15253         if (!msg)
15254                 return;
15255
15256         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
15257         if (!hdr) {
15258                 nlmsg_free(msg);
15259                 return;
15260         }
15261
15262         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15263             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15264             (cr->bssid &&
15265              nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
15266             nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
15267                         cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
15268                         cr->status) ||
15269             (cr->status < 0 &&
15270              (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
15271               nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
15272                           cr->timeout_reason))) ||
15273             (cr->req_ie &&
15274              nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
15275             (cr->resp_ie &&
15276              nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
15277                      cr->resp_ie)) ||
15278             (cr->fils.update_erp_next_seq_num &&
15279              nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
15280                          cr->fils.erp_next_seq_num)) ||
15281             (cr->status == WLAN_STATUS_SUCCESS &&
15282              ((cr->fils.kek &&
15283                nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
15284                        cr->fils.kek)) ||
15285               (cr->fils.pmk &&
15286                nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
15287               (cr->fils.pmkid &&
15288                nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
15289                 goto nla_put_failure;
15290
15291         genlmsg_end(msg, hdr);
15292
15293         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15294                                 NL80211_MCGRP_MLME, gfp);
15295         return;
15296
15297  nla_put_failure:
15298         nlmsg_free(msg);
15299 }
15300
15301 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
15302                          struct net_device *netdev,
15303                          struct cfg80211_roam_info *info, gfp_t gfp)
15304 {
15305         struct sk_buff *msg;
15306         void *hdr;
15307         const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
15308
15309         msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
15310                         info->fils.kek_len + info->fils.pmk_len +
15311                         (info->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
15312         if (!msg)
15313                 return;
15314
15315         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
15316         if (!hdr) {
15317                 nlmsg_free(msg);
15318                 return;
15319         }
15320
15321         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15322             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15323             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
15324             (info->req_ie &&
15325              nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
15326                      info->req_ie)) ||
15327             (info->resp_ie &&
15328              nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
15329                      info->resp_ie)) ||
15330             (info->fils.update_erp_next_seq_num &&
15331              nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
15332                          info->fils.erp_next_seq_num)) ||
15333             (info->fils.kek &&
15334              nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
15335                      info->fils.kek)) ||
15336             (info->fils.pmk &&
15337              nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
15338             (info->fils.pmkid &&
15339              nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
15340                 goto nla_put_failure;
15341
15342         genlmsg_end(msg, hdr);
15343
15344         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15345                                 NL80211_MCGRP_MLME, gfp);
15346         return;
15347
15348  nla_put_failure:
15349         nlmsg_free(msg);
15350 }
15351
15352 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
15353                                   struct net_device *netdev, const u8 *bssid)
15354 {
15355         struct sk_buff *msg;
15356         void *hdr;
15357
15358         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15359         if (!msg)
15360                 return;
15361
15362         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
15363         if (!hdr) {
15364                 nlmsg_free(msg);
15365                 return;
15366         }
15367
15368         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15369             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15370             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
15371                 goto nla_put_failure;
15372
15373         genlmsg_end(msg, hdr);
15374
15375         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15376                                 NL80211_MCGRP_MLME, GFP_KERNEL);
15377         return;
15378
15379  nla_put_failure:
15380         nlmsg_free(msg);
15381 }
15382
15383 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
15384                                struct net_device *netdev, u16 reason,
15385                                const u8 *ie, size_t ie_len, bool from_ap)
15386 {
15387         struct sk_buff *msg;
15388         void *hdr;
15389
15390         msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
15391         if (!msg)
15392                 return;
15393
15394         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
15395         if (!hdr) {
15396                 nlmsg_free(msg);
15397                 return;
15398         }
15399
15400         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15401             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15402             (reason &&
15403              nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
15404             (from_ap &&
15405              nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
15406             (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
15407                 goto nla_put_failure;
15408
15409         genlmsg_end(msg, hdr);
15410
15411         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15412                                 NL80211_MCGRP_MLME, GFP_KERNEL);
15413         return;
15414
15415  nla_put_failure:
15416         nlmsg_free(msg);
15417 }
15418
15419 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
15420                              struct net_device *netdev, const u8 *bssid,
15421                              gfp_t gfp)
15422 {
15423         struct sk_buff *msg;
15424         void *hdr;
15425
15426         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15427         if (!msg)
15428                 return;
15429
15430         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
15431         if (!hdr) {
15432                 nlmsg_free(msg);
15433                 return;
15434         }
15435
15436         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15437             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15438             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
15439                 goto nla_put_failure;
15440
15441         genlmsg_end(msg, hdr);
15442
15443         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15444                                 NL80211_MCGRP_MLME, gfp);
15445         return;
15446
15447  nla_put_failure:
15448         nlmsg_free(msg);
15449 }
15450
15451 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
15452                                         const u8 *ie, u8 ie_len,
15453                                         int sig_dbm, gfp_t gfp)
15454 {
15455         struct wireless_dev *wdev = dev->ieee80211_ptr;
15456         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15457         struct sk_buff *msg;
15458         void *hdr;
15459
15460         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
15461                 return;
15462
15463         trace_cfg80211_notify_new_peer_candidate(dev, addr);
15464
15465         msg = nlmsg_new(100 + ie_len, gfp);
15466         if (!msg)
15467                 return;
15468
15469         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
15470         if (!hdr) {
15471                 nlmsg_free(msg);
15472                 return;
15473         }
15474
15475         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15476             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15477             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
15478             (ie_len && ie &&
15479              nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) ||
15480             (sig_dbm &&
15481              nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)))
15482                 goto nla_put_failure;
15483
15484         genlmsg_end(msg, hdr);
15485
15486         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15487                                 NL80211_MCGRP_MLME, gfp);
15488         return;
15489
15490  nla_put_failure:
15491         nlmsg_free(msg);
15492 }
15493 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
15494
15495 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
15496                                  struct net_device *netdev, const u8 *addr,
15497                                  enum nl80211_key_type key_type, int key_id,
15498                                  const u8 *tsc, gfp_t gfp)
15499 {
15500         struct sk_buff *msg;
15501         void *hdr;
15502
15503         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15504         if (!msg)
15505                 return;
15506
15507         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
15508         if (!hdr) {
15509                 nlmsg_free(msg);
15510                 return;
15511         }
15512
15513         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15514             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15515             (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
15516             nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
15517             (key_id != -1 &&
15518              nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
15519             (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
15520                 goto nla_put_failure;
15521
15522         genlmsg_end(msg, hdr);
15523
15524         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15525                                 NL80211_MCGRP_MLME, gfp);
15526         return;
15527
15528  nla_put_failure:
15529         nlmsg_free(msg);
15530 }
15531
15532 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
15533                                     struct ieee80211_channel *channel_before,
15534                                     struct ieee80211_channel *channel_after)
15535 {
15536         struct sk_buff *msg;
15537         void *hdr;
15538         struct nlattr *nl_freq;
15539
15540         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
15541         if (!msg)
15542                 return;
15543
15544         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
15545         if (!hdr) {
15546                 nlmsg_free(msg);
15547                 return;
15548         }
15549
15550         /*
15551          * Since we are applying the beacon hint to a wiphy we know its
15552          * wiphy_idx is valid
15553          */
15554         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
15555                 goto nla_put_failure;
15556
15557         /* Before */
15558         nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE);
15559         if (!nl_freq)
15560                 goto nla_put_failure;
15561
15562         if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
15563                 goto nla_put_failure;
15564         nla_nest_end(msg, nl_freq);
15565
15566         /* After */
15567         nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER);
15568         if (!nl_freq)
15569                 goto nla_put_failure;
15570
15571         if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
15572                 goto nla_put_failure;
15573         nla_nest_end(msg, nl_freq);
15574
15575         genlmsg_end(msg, hdr);
15576
15577         rcu_read_lock();
15578         genlmsg_multicast_allns(&nl80211_fam, msg, 0,
15579                                 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
15580         rcu_read_unlock();
15581
15582         return;
15583
15584 nla_put_failure:
15585         nlmsg_free(msg);
15586 }
15587
15588 static void nl80211_send_remain_on_chan_event(
15589         int cmd, struct cfg80211_registered_device *rdev,
15590         struct wireless_dev *wdev, u64 cookie,
15591         struct ieee80211_channel *chan,
15592         unsigned int duration, gfp_t gfp)
15593 {
15594         struct sk_buff *msg;
15595         void *hdr;
15596
15597         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15598         if (!msg)
15599                 return;
15600
15601         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15602         if (!hdr) {
15603                 nlmsg_free(msg);
15604                 return;
15605         }
15606
15607         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15608             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15609                                          wdev->netdev->ifindex)) ||
15610             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15611                               NL80211_ATTR_PAD) ||
15612             nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
15613             nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
15614                         NL80211_CHAN_NO_HT) ||
15615             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
15616                               NL80211_ATTR_PAD))
15617                 goto nla_put_failure;
15618
15619         if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
15620             nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
15621                 goto nla_put_failure;
15622
15623         genlmsg_end(msg, hdr);
15624
15625         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15626                                 NL80211_MCGRP_MLME, gfp);
15627         return;
15628
15629  nla_put_failure:
15630         nlmsg_free(msg);
15631 }
15632
15633 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
15634                                struct ieee80211_channel *chan,
15635                                unsigned int duration, gfp_t gfp)
15636 {
15637         struct wiphy *wiphy = wdev->wiphy;
15638         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15639
15640         trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
15641         nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
15642                                           rdev, wdev, cookie, chan,
15643                                           duration, gfp);
15644 }
15645 EXPORT_SYMBOL(cfg80211_ready_on_channel);
15646
15647 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
15648                                         struct ieee80211_channel *chan,
15649                                         gfp_t gfp)
15650 {
15651         struct wiphy *wiphy = wdev->wiphy;
15652         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15653
15654         trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
15655         nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
15656                                           rdev, wdev, cookie, chan, 0, gfp);
15657 }
15658 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
15659
15660 void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie,
15661                                         struct ieee80211_channel *chan,
15662                                         gfp_t gfp)
15663 {
15664         struct wiphy *wiphy = wdev->wiphy;
15665         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15666
15667         trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan);
15668         nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL,
15669                                           rdev, wdev, cookie, chan, 0, gfp);
15670 }
15671 EXPORT_SYMBOL(cfg80211_tx_mgmt_expired);
15672
15673 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
15674                       struct station_info *sinfo, gfp_t gfp)
15675 {
15676         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15677         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15678         struct sk_buff *msg;
15679
15680         trace_cfg80211_new_sta(dev, mac_addr, sinfo);
15681
15682         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15683         if (!msg)
15684                 return;
15685
15686         if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
15687                                  rdev, dev, mac_addr, sinfo) < 0) {
15688                 nlmsg_free(msg);
15689                 return;
15690         }
15691
15692         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15693                                 NL80211_MCGRP_MLME, gfp);
15694 }
15695 EXPORT_SYMBOL(cfg80211_new_sta);
15696
15697 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
15698                             struct station_info *sinfo, gfp_t gfp)
15699 {
15700         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15701         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15702         struct sk_buff *msg;
15703         struct station_info empty_sinfo = {};
15704
15705         if (!sinfo)
15706                 sinfo = &empty_sinfo;
15707
15708         trace_cfg80211_del_sta(dev, mac_addr);
15709
15710         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15711         if (!msg) {
15712                 cfg80211_sinfo_release_content(sinfo);
15713                 return;
15714         }
15715
15716         if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
15717                                  rdev, dev, mac_addr, sinfo) < 0) {
15718                 nlmsg_free(msg);
15719                 return;
15720         }
15721
15722         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15723                                 NL80211_MCGRP_MLME, gfp);
15724 }
15725 EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
15726
15727 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
15728                           enum nl80211_connect_failed_reason reason,
15729                           gfp_t gfp)
15730 {
15731         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15732         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15733         struct sk_buff *msg;
15734         void *hdr;
15735
15736         msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
15737         if (!msg)
15738                 return;
15739
15740         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
15741         if (!hdr) {
15742                 nlmsg_free(msg);
15743                 return;
15744         }
15745
15746         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15747             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
15748             nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
15749                 goto nla_put_failure;
15750
15751         genlmsg_end(msg, hdr);
15752
15753         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15754                                 NL80211_MCGRP_MLME, gfp);
15755         return;
15756
15757  nla_put_failure:
15758         nlmsg_free(msg);
15759 }
15760 EXPORT_SYMBOL(cfg80211_conn_failed);
15761
15762 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
15763                                        const u8 *addr, gfp_t gfp)
15764 {
15765         struct wireless_dev *wdev = dev->ieee80211_ptr;
15766         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15767         struct sk_buff *msg;
15768         void *hdr;
15769         u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
15770
15771         if (!nlportid)
15772                 return false;
15773
15774         msg = nlmsg_new(100, gfp);
15775         if (!msg)
15776                 return true;
15777
15778         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15779         if (!hdr) {
15780                 nlmsg_free(msg);
15781                 return true;
15782         }
15783
15784         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15785             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15786             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
15787                 goto nla_put_failure;
15788
15789         genlmsg_end(msg, hdr);
15790         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15791         return true;
15792
15793  nla_put_failure:
15794         nlmsg_free(msg);
15795         return true;
15796 }
15797
15798 bool cfg80211_rx_spurious_frame(struct net_device *dev,
15799                                 const u8 *addr, gfp_t gfp)
15800 {
15801         struct wireless_dev *wdev = dev->ieee80211_ptr;
15802         bool ret;
15803
15804         trace_cfg80211_rx_spurious_frame(dev, addr);
15805
15806         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
15807                     wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
15808                 trace_cfg80211_return_bool(false);
15809                 return false;
15810         }
15811         ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
15812                                          addr, gfp);
15813         trace_cfg80211_return_bool(ret);
15814         return ret;
15815 }
15816 EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
15817
15818 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
15819                                         const u8 *addr, gfp_t gfp)
15820 {
15821         struct wireless_dev *wdev = dev->ieee80211_ptr;
15822         bool ret;
15823
15824         trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
15825
15826         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
15827                     wdev->iftype != NL80211_IFTYPE_P2P_GO &&
15828                     wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
15829                 trace_cfg80211_return_bool(false);
15830                 return false;
15831         }
15832         ret = __nl80211_unexpected_frame(dev,
15833                                          NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
15834                                          addr, gfp);
15835         trace_cfg80211_return_bool(ret);
15836         return ret;
15837 }
15838 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
15839
15840 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
15841                       struct wireless_dev *wdev, u32 nlportid,
15842                       int freq, int sig_dbm,
15843                       const u8 *buf, size_t len, u32 flags, gfp_t gfp)
15844 {
15845         struct net_device *netdev = wdev->netdev;
15846         struct sk_buff *msg;
15847         void *hdr;
15848
15849         msg = nlmsg_new(100 + len, gfp);
15850         if (!msg)
15851                 return -ENOMEM;
15852
15853         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
15854         if (!hdr) {
15855                 nlmsg_free(msg);
15856                 return -ENOMEM;
15857         }
15858
15859         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15860             (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15861                                         netdev->ifindex)) ||
15862             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15863                               NL80211_ATTR_PAD) ||
15864             nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
15865             (sig_dbm &&
15866              nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
15867             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15868             (flags &&
15869              nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
15870                 goto nla_put_failure;
15871
15872         genlmsg_end(msg, hdr);
15873
15874         return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15875
15876  nla_put_failure:
15877         nlmsg_free(msg);
15878         return -ENOBUFS;
15879 }
15880
15881 void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
15882                              const u8 *buf, size_t len, bool ack, gfp_t gfp)
15883 {
15884         struct wiphy *wiphy = wdev->wiphy;
15885         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15886         struct net_device *netdev = wdev->netdev;
15887         struct sk_buff *msg;
15888         void *hdr;
15889
15890         trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
15891
15892         msg = nlmsg_new(100 + len, gfp);
15893         if (!msg)
15894                 return;
15895
15896         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
15897         if (!hdr) {
15898                 nlmsg_free(msg);
15899                 return;
15900         }
15901
15902         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15903             (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15904                                    netdev->ifindex)) ||
15905             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15906                               NL80211_ATTR_PAD) ||
15907             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15908             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
15909                               NL80211_ATTR_PAD) ||
15910             (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
15911                 goto nla_put_failure;
15912
15913         genlmsg_end(msg, hdr);
15914
15915         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15916                                 NL80211_MCGRP_MLME, gfp);
15917         return;
15918
15919  nla_put_failure:
15920         nlmsg_free(msg);
15921 }
15922 EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
15923
15924 static int __nl80211_rx_control_port(struct net_device *dev,
15925                                      struct sk_buff *skb,
15926                                      bool unencrypted, gfp_t gfp)
15927 {
15928         struct wireless_dev *wdev = dev->ieee80211_ptr;
15929         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15930         struct ethhdr *ehdr = eth_hdr(skb);
15931         const u8 *addr = ehdr->h_source;
15932         u16 proto = be16_to_cpu(skb->protocol);
15933         struct sk_buff *msg;
15934         void *hdr;
15935         struct nlattr *frame;
15936
15937         u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);
15938
15939         if (!nlportid)
15940                 return -ENOENT;
15941
15942         msg = nlmsg_new(100 + skb->len, gfp);
15943         if (!msg)
15944                 return -ENOMEM;
15945
15946         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
15947         if (!hdr) {
15948                 nlmsg_free(msg);
15949                 return -ENOBUFS;
15950         }
15951
15952         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15953             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15954             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15955                               NL80211_ATTR_PAD) ||
15956             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
15957             nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
15958             (unencrypted && nla_put_flag(msg,
15959                                          NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
15960                 goto nla_put_failure;
15961
15962         frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len);
15963         if (!frame)
15964                 goto nla_put_failure;
15965
15966         skb_copy_bits(skb, 0, nla_data(frame), skb->len);
15967         genlmsg_end(msg, hdr);
15968
15969         return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15970
15971  nla_put_failure:
15972         nlmsg_free(msg);
15973         return -ENOBUFS;
15974 }
15975
15976 bool cfg80211_rx_control_port(struct net_device *dev,
15977                               struct sk_buff *skb, bool unencrypted)
15978 {
15979         int ret;
15980
15981         trace_cfg80211_rx_control_port(dev, skb, unencrypted);
15982         ret = __nl80211_rx_control_port(dev, skb, unencrypted, GFP_ATOMIC);
15983         trace_cfg80211_return_bool(ret == 0);
15984         return ret == 0;
15985 }
15986 EXPORT_SYMBOL(cfg80211_rx_control_port);
15987
15988 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
15989                                             const char *mac, gfp_t gfp)
15990 {
15991         struct wireless_dev *wdev = dev->ieee80211_ptr;
15992         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15993         struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15994         void **cb;
15995
15996         if (!msg)
15997                 return NULL;
15998
15999         cb = (void **)msg->cb;
16000
16001         cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
16002         if (!cb[0]) {
16003                 nlmsg_free(msg);
16004                 return NULL;
16005         }
16006
16007         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16008             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
16009                 goto nla_put_failure;
16010
16011         if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
16012                 goto nla_put_failure;
16013
16014         cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM);
16015         if (!cb[1])
16016                 goto nla_put_failure;
16017
16018         cb[2] = rdev;
16019
16020         return msg;
16021  nla_put_failure:
16022         nlmsg_free(msg);
16023         return NULL;
16024 }
16025
16026 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
16027 {
16028         void **cb = (void **)msg->cb;
16029         struct cfg80211_registered_device *rdev = cb[2];
16030
16031         nla_nest_end(msg, cb[1]);
16032         genlmsg_end(msg, cb[0]);
16033
16034         memset(msg->cb, 0, sizeof(msg->cb));
16035
16036         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16037                                 NL80211_MCGRP_MLME, gfp);
16038 }
16039
16040 void cfg80211_cqm_rssi_notify(struct net_device *dev,
16041                               enum nl80211_cqm_rssi_threshold_event rssi_event,
16042                               s32 rssi_level, gfp_t gfp)
16043 {
16044         struct sk_buff *msg;
16045         struct wireless_dev *wdev = dev->ieee80211_ptr;
16046         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16047
16048         trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
16049
16050         if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
16051                     rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
16052                 return;
16053
16054         if (wdev->cqm_config) {
16055                 wdev->cqm_config->last_rssi_event_value = rssi_level;
16056
16057                 cfg80211_cqm_rssi_update(rdev, dev);
16058
16059                 if (rssi_level == 0)
16060                         rssi_level = wdev->cqm_config->last_rssi_event_value;
16061         }
16062
16063         msg = cfg80211_prepare_cqm(dev, NULL, gfp);
16064         if (!msg)
16065                 return;
16066
16067         if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
16068                         rssi_event))
16069                 goto nla_put_failure;
16070
16071         if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
16072                                       rssi_level))
16073                 goto nla_put_failure;
16074
16075         cfg80211_send_cqm(msg, gfp);
16076
16077         return;
16078
16079  nla_put_failure:
16080         nlmsg_free(msg);
16081 }
16082 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
16083
16084 void cfg80211_cqm_txe_notify(struct net_device *dev,
16085                              const u8 *peer, u32 num_packets,
16086                              u32 rate, u32 intvl, gfp_t gfp)
16087 {
16088         struct sk_buff *msg;
16089
16090         msg = cfg80211_prepare_cqm(dev, peer, gfp);
16091         if (!msg)
16092                 return;
16093
16094         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
16095                 goto nla_put_failure;
16096
16097         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
16098                 goto nla_put_failure;
16099
16100         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
16101                 goto nla_put_failure;
16102
16103         cfg80211_send_cqm(msg, gfp);
16104         return;
16105
16106  nla_put_failure:
16107         nlmsg_free(msg);
16108 }
16109 EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
16110
16111 void cfg80211_cqm_pktloss_notify(struct net_device *dev,
16112                                  const u8 *peer, u32 num_packets, gfp_t gfp)
16113 {
16114         struct sk_buff *msg;
16115
16116         trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
16117
16118         msg = cfg80211_prepare_cqm(dev, peer, gfp);
16119         if (!msg)
16120                 return;
16121
16122         if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
16123                 goto nla_put_failure;
16124
16125         cfg80211_send_cqm(msg, gfp);
16126         return;
16127
16128  nla_put_failure:
16129         nlmsg_free(msg);
16130 }
16131 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
16132
16133 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
16134 {
16135         struct sk_buff *msg;
16136
16137         msg = cfg80211_prepare_cqm(dev, NULL, gfp);
16138         if (!msg)
16139                 return;
16140
16141         if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
16142                 goto nla_put_failure;
16143
16144         cfg80211_send_cqm(msg, gfp);
16145         return;
16146
16147  nla_put_failure:
16148         nlmsg_free(msg);
16149 }
16150 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
16151
16152 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
16153                                      struct net_device *netdev, const u8 *bssid,
16154                                      const u8 *replay_ctr, gfp_t gfp)
16155 {
16156         struct sk_buff *msg;
16157         struct nlattr *rekey_attr;
16158         void *hdr;
16159
16160         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16161         if (!msg)
16162                 return;
16163
16164         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
16165         if (!hdr) {
16166                 nlmsg_free(msg);
16167                 return;
16168         }
16169
16170         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16171             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16172             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
16173                 goto nla_put_failure;
16174
16175         rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA);
16176         if (!rekey_attr)
16177                 goto nla_put_failure;
16178
16179         if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
16180                     NL80211_REPLAY_CTR_LEN, replay_ctr))
16181                 goto nla_put_failure;
16182
16183         nla_nest_end(msg, rekey_attr);
16184
16185         genlmsg_end(msg, hdr);
16186
16187         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16188                                 NL80211_MCGRP_MLME, gfp);
16189         return;
16190
16191  nla_put_failure:
16192         nlmsg_free(msg);
16193 }
16194
16195 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
16196                                const u8 *replay_ctr, gfp_t gfp)
16197 {
16198         struct wireless_dev *wdev = dev->ieee80211_ptr;
16199         struct wiphy *wiphy = wdev->wiphy;
16200         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16201
16202         trace_cfg80211_gtk_rekey_notify(dev, bssid);
16203         nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
16204 }
16205 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
16206
16207 static void
16208 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
16209                                struct net_device *netdev, int index,
16210                                const u8 *bssid, bool preauth, gfp_t gfp)
16211 {
16212         struct sk_buff *msg;
16213         struct nlattr *attr;
16214         void *hdr;
16215
16216         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16217         if (!msg)
16218                 return;
16219
16220         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
16221         if (!hdr) {
16222                 nlmsg_free(msg);
16223                 return;
16224         }
16225
16226         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16227             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
16228                 goto nla_put_failure;
16229
16230         attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE);
16231         if (!attr)
16232                 goto nla_put_failure;
16233
16234         if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
16235             nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
16236             (preauth &&
16237              nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
16238                 goto nla_put_failure;
16239
16240         nla_nest_end(msg, attr);
16241
16242         genlmsg_end(msg, hdr);
16243
16244         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16245                                 NL80211_MCGRP_MLME, gfp);
16246         return;
16247
16248  nla_put_failure:
16249         nlmsg_free(msg);
16250 }
16251
16252 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
16253                                      const u8 *bssid, bool preauth, gfp_t gfp)
16254 {
16255         struct wireless_dev *wdev = dev->ieee80211_ptr;
16256         struct wiphy *wiphy = wdev->wiphy;
16257         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16258
16259         trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
16260         nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
16261 }
16262 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
16263
16264 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
16265                                      struct net_device *netdev,
16266                                      struct cfg80211_chan_def *chandef,
16267                                      gfp_t gfp,
16268                                      enum nl80211_commands notif,
16269                                      u8 count)
16270 {
16271         struct sk_buff *msg;
16272         void *hdr;
16273
16274         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16275         if (!msg)
16276                 return;
16277
16278         hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
16279         if (!hdr) {
16280                 nlmsg_free(msg);
16281                 return;
16282         }
16283
16284         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
16285                 goto nla_put_failure;
16286
16287         if (nl80211_send_chandef(msg, chandef))
16288                 goto nla_put_failure;
16289
16290         if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
16291             (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
16292                         goto nla_put_failure;
16293
16294         genlmsg_end(msg, hdr);
16295
16296         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16297                                 NL80211_MCGRP_MLME, gfp);
16298         return;
16299
16300  nla_put_failure:
16301         nlmsg_free(msg);
16302 }
16303
16304 void cfg80211_ch_switch_notify(struct net_device *dev,
16305                                struct cfg80211_chan_def *chandef)
16306 {
16307         struct wireless_dev *wdev = dev->ieee80211_ptr;
16308         struct wiphy *wiphy = wdev->wiphy;
16309         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16310
16311         ASSERT_WDEV_LOCK(wdev);
16312
16313         trace_cfg80211_ch_switch_notify(dev, chandef);
16314
16315         wdev->chandef = *chandef;
16316         wdev->preset_chandef = *chandef;
16317
16318         if ((wdev->iftype == NL80211_IFTYPE_STATION ||
16319              wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
16320             !WARN_ON(!wdev->current_bss))
16321                 cfg80211_update_assoc_bss_entry(wdev, chandef->chan);
16322
16323         cfg80211_sched_dfs_chan_update(rdev);
16324
16325         nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
16326                                  NL80211_CMD_CH_SWITCH_NOTIFY, 0);
16327 }
16328 EXPORT_SYMBOL(cfg80211_ch_switch_notify);
16329
16330 void cfg80211_ch_switch_started_notify(struct net_device *dev,
16331                                        struct cfg80211_chan_def *chandef,
16332                                        u8 count)
16333 {
16334         struct wireless_dev *wdev = dev->ieee80211_ptr;
16335         struct wiphy *wiphy = wdev->wiphy;
16336         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16337
16338         trace_cfg80211_ch_switch_started_notify(dev, chandef);
16339
16340         nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
16341                                  NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
16342 }
16343 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
16344
16345 void
16346 nl80211_radar_notify(struct cfg80211_registered_device *rdev,
16347                      const struct cfg80211_chan_def *chandef,
16348                      enum nl80211_radar_event event,
16349                      struct net_device *netdev, gfp_t gfp)
16350 {
16351         struct sk_buff *msg;
16352         void *hdr;
16353
16354         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16355         if (!msg)
16356                 return;
16357
16358         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
16359         if (!hdr) {
16360                 nlmsg_free(msg);
16361                 return;
16362         }
16363
16364         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
16365                 goto nla_put_failure;
16366
16367         /* NOP and radar events don't need a netdev parameter */
16368         if (netdev) {
16369                 struct wireless_dev *wdev = netdev->ieee80211_ptr;
16370
16371                 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16372                     nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16373                                       NL80211_ATTR_PAD))
16374                         goto nla_put_failure;
16375         }
16376
16377         if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
16378                 goto nla_put_failure;
16379
16380         if (nl80211_send_chandef(msg, chandef))
16381                 goto nla_put_failure;
16382
16383         genlmsg_end(msg, hdr);
16384
16385         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16386                                 NL80211_MCGRP_MLME, gfp);
16387         return;
16388
16389  nla_put_failure:
16390         nlmsg_free(msg);
16391 }
16392
16393 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
16394                                        struct sta_opmode_info *sta_opmode,
16395                                        gfp_t gfp)
16396 {
16397         struct sk_buff *msg;
16398         struct wireless_dev *wdev = dev->ieee80211_ptr;
16399         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16400         void *hdr;
16401
16402         if (WARN_ON(!mac))
16403                 return;
16404
16405         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16406         if (!msg)
16407                 return;
16408
16409         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
16410         if (!hdr) {
16411                 nlmsg_free(msg);
16412                 return;
16413         }
16414
16415         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
16416                 goto nla_put_failure;
16417
16418         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
16419                 goto nla_put_failure;
16420
16421         if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
16422                 goto nla_put_failure;
16423
16424         if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
16425             nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
16426                 goto nla_put_failure;
16427
16428         if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
16429             nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
16430                 goto nla_put_failure;
16431
16432         if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
16433             nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
16434                 goto nla_put_failure;
16435
16436         genlmsg_end(msg, hdr);
16437
16438         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16439                                 NL80211_MCGRP_MLME, gfp);
16440
16441         return;
16442
16443 nla_put_failure:
16444         nlmsg_free(msg);
16445 }
16446 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);
16447
16448 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
16449                            u64 cookie, bool acked, s32 ack_signal,
16450                            bool is_valid_ack_signal, gfp_t gfp)
16451 {
16452         struct wireless_dev *wdev = dev->ieee80211_ptr;
16453         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16454         struct sk_buff *msg;
16455         void *hdr;
16456
16457         trace_cfg80211_probe_status(dev, addr, cookie, acked);
16458
16459         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16460
16461         if (!msg)
16462                 return;
16463
16464         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
16465         if (!hdr) {
16466                 nlmsg_free(msg);
16467                 return;
16468         }
16469
16470         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16471             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16472             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
16473             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
16474                               NL80211_ATTR_PAD) ||
16475             (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
16476             (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
16477                                                 ack_signal)))
16478                 goto nla_put_failure;
16479
16480         genlmsg_end(msg, hdr);
16481
16482         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16483                                 NL80211_MCGRP_MLME, gfp);
16484         return;
16485
16486  nla_put_failure:
16487         nlmsg_free(msg);
16488 }
16489 EXPORT_SYMBOL(cfg80211_probe_status);
16490
16491 void cfg80211_report_obss_beacon(struct wiphy *wiphy,
16492                                  const u8 *frame, size_t len,
16493                                  int freq, int sig_dbm)
16494 {
16495         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16496         struct sk_buff *msg;
16497         void *hdr;
16498         struct cfg80211_beacon_registration *reg;
16499
16500         trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
16501
16502         spin_lock_bh(&rdev->beacon_registrations_lock);
16503         list_for_each_entry(reg, &rdev->beacon_registrations, list) {
16504                 msg = nlmsg_new(len + 100, GFP_ATOMIC);
16505                 if (!msg) {
16506                         spin_unlock_bh(&rdev->beacon_registrations_lock);
16507                         return;
16508                 }
16509
16510                 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
16511                 if (!hdr)
16512                         goto nla_put_failure;
16513
16514                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16515                     (freq &&
16516                      nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
16517                     (sig_dbm &&
16518                      nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
16519                     nla_put(msg, NL80211_ATTR_FRAME, len, frame))
16520                         goto nla_put_failure;
16521
16522                 genlmsg_end(msg, hdr);
16523
16524                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
16525         }
16526         spin_unlock_bh(&rdev->beacon_registrations_lock);
16527         return;
16528
16529  nla_put_failure:
16530         spin_unlock_bh(&rdev->beacon_registrations_lock);
16531         nlmsg_free(msg);
16532 }
16533 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
16534
16535 #ifdef CONFIG_PM
16536 static int cfg80211_net_detect_results(struct sk_buff *msg,
16537                                        struct cfg80211_wowlan_wakeup *wakeup)
16538 {
16539         struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
16540         struct nlattr *nl_results, *nl_match, *nl_freqs;
16541         int i, j;
16542
16543         nl_results = nla_nest_start_noflag(msg,
16544                                            NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
16545         if (!nl_results)
16546                 return -EMSGSIZE;
16547
16548         for (i = 0; i < nd->n_matches; i++) {
16549                 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
16550
16551                 nl_match = nla_nest_start_noflag(msg, i);
16552                 if (!nl_match)
16553                         break;
16554
16555                 /* The SSID attribute is optional in nl80211, but for
16556                  * simplicity reasons it's always present in the
16557                  * cfg80211 structure.  If a driver can't pass the
16558                  * SSID, that needs to be changed.  A zero length SSID
16559                  * is still a valid SSID (wildcard), so it cannot be
16560                  * used for this purpose.
16561                  */
16562                 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
16563                             match->ssid.ssid)) {
16564                         nla_nest_cancel(msg, nl_match);
16565                         goto out;
16566                 }
16567
16568                 if (match->n_channels) {
16569                         nl_freqs = nla_nest_start_noflag(msg,
16570                                                          NL80211_ATTR_SCAN_FREQUENCIES);
16571                         if (!nl_freqs) {
16572                                 nla_nest_cancel(msg, nl_match);
16573                                 goto out;
16574                         }
16575
16576                         for (j = 0; j < match->n_channels; j++) {
16577                                 if (nla_put_u32(msg, j, match->channels[j])) {
16578                                         nla_nest_cancel(msg, nl_freqs);
16579                                         nla_nest_cancel(msg, nl_match);
16580                                         goto out;
16581                                 }
16582                         }
16583
16584                         nla_nest_end(msg, nl_freqs);
16585                 }
16586
16587                 nla_nest_end(msg, nl_match);
16588         }
16589
16590 out:
16591         nla_nest_end(msg, nl_results);
16592         return 0;
16593 }
16594
16595 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
16596                                    struct cfg80211_wowlan_wakeup *wakeup,
16597                                    gfp_t gfp)
16598 {
16599         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16600         struct sk_buff *msg;
16601         void *hdr;
16602         int size = 200;
16603
16604         trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
16605
16606         if (wakeup)
16607                 size += wakeup->packet_present_len;
16608
16609         msg = nlmsg_new(size, gfp);
16610         if (!msg)
16611                 return;
16612
16613         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
16614         if (!hdr)
16615                 goto free_msg;
16616
16617         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16618             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16619                               NL80211_ATTR_PAD))
16620                 goto free_msg;
16621
16622         if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
16623                                         wdev->netdev->ifindex))
16624                 goto free_msg;
16625
16626         if (wakeup) {
16627                 struct nlattr *reasons;
16628
16629                 reasons = nla_nest_start_noflag(msg,
16630                                                 NL80211_ATTR_WOWLAN_TRIGGERS);
16631                 if (!reasons)
16632                         goto free_msg;
16633
16634                 if (wakeup->disconnect &&
16635                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
16636                         goto free_msg;
16637                 if (wakeup->magic_pkt &&
16638                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
16639                         goto free_msg;
16640                 if (wakeup->gtk_rekey_failure &&
16641                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
16642                         goto free_msg;
16643                 if (wakeup->eap_identity_req &&
16644                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
16645                         goto free_msg;
16646                 if (wakeup->four_way_handshake &&
16647                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
16648                         goto free_msg;
16649                 if (wakeup->rfkill_release &&
16650                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
16651                         goto free_msg;
16652
16653                 if (wakeup->pattern_idx >= 0 &&
16654                     nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
16655                                 wakeup->pattern_idx))
16656                         goto free_msg;
16657
16658                 if (wakeup->tcp_match &&
16659                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
16660                         goto free_msg;
16661
16662                 if (wakeup->tcp_connlost &&
16663                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
16664                         goto free_msg;
16665
16666                 if (wakeup->tcp_nomoretokens &&
16667                     nla_put_flag(msg,
16668                                  NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
16669                         goto free_msg;
16670
16671                 if (wakeup->packet) {
16672                         u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
16673                         u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
16674
16675                         if (!wakeup->packet_80211) {
16676                                 pkt_attr =
16677                                         NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
16678                                 len_attr =
16679                                         NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
16680                         }
16681
16682                         if (wakeup->packet_len &&
16683                             nla_put_u32(msg, len_attr, wakeup->packet_len))
16684                                 goto free_msg;
16685
16686                         if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
16687                                     wakeup->packet))
16688                                 goto free_msg;
16689                 }
16690
16691                 if (wakeup->net_detect &&
16692                     cfg80211_net_detect_results(msg, wakeup))
16693                                 goto free_msg;
16694
16695                 nla_nest_end(msg, reasons);
16696         }
16697
16698         genlmsg_end(msg, hdr);
16699
16700         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16701                                 NL80211_MCGRP_MLME, gfp);
16702         return;
16703
16704  free_msg:
16705         nlmsg_free(msg);
16706 }
16707 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
16708 #endif
16709
16710 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
16711                                 enum nl80211_tdls_operation oper,
16712                                 u16 reason_code, gfp_t gfp)
16713 {
16714         struct wireless_dev *wdev = dev->ieee80211_ptr;
16715         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16716         struct sk_buff *msg;
16717         void *hdr;
16718
16719         trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
16720                                          reason_code);
16721
16722         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16723         if (!msg)
16724                 return;
16725
16726         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
16727         if (!hdr) {
16728                 nlmsg_free(msg);
16729                 return;
16730         }
16731
16732         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16733             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16734             nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
16735             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
16736             (reason_code > 0 &&
16737              nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
16738                 goto nla_put_failure;
16739
16740         genlmsg_end(msg, hdr);
16741
16742         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16743                                 NL80211_MCGRP_MLME, gfp);
16744         return;
16745
16746  nla_put_failure:
16747         nlmsg_free(msg);
16748 }
16749 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
16750
16751 static int nl80211_netlink_notify(struct notifier_block * nb,
16752                                   unsigned long state,
16753                                   void *_notify)
16754 {
16755         struct netlink_notify *notify = _notify;
16756         struct cfg80211_registered_device *rdev;
16757         struct wireless_dev *wdev;
16758         struct cfg80211_beacon_registration *reg, *tmp;
16759
16760         if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
16761                 return NOTIFY_DONE;
16762
16763         rcu_read_lock();
16764
16765         list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
16766                 struct cfg80211_sched_scan_request *sched_scan_req;
16767
16768                 list_for_each_entry_rcu(sched_scan_req,
16769                                         &rdev->sched_scan_req_list,
16770                                         list) {
16771                         if (sched_scan_req->owner_nlportid == notify->portid) {
16772                                 sched_scan_req->nl_owner_dead = true;
16773                                 schedule_work(&rdev->sched_scan_stop_wk);
16774                         }
16775                 }
16776
16777                 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
16778                         cfg80211_mlme_unregister_socket(wdev, notify->portid);
16779
16780                         if (wdev->owner_nlportid == notify->portid) {
16781                                 wdev->nl_owner_dead = true;
16782                                 schedule_work(&rdev->destroy_work);
16783                         } else if (wdev->conn_owner_nlportid == notify->portid) {
16784                                 schedule_work(&wdev->disconnect_wk);
16785                         }
16786
16787                         cfg80211_release_pmsr(wdev, notify->portid);
16788                 }
16789
16790                 spin_lock_bh(&rdev->beacon_registrations_lock);
16791                 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
16792                                          list) {
16793                         if (reg->nlportid == notify->portid) {
16794                                 list_del(&reg->list);
16795                                 kfree(reg);
16796                                 break;
16797                         }
16798                 }
16799                 spin_unlock_bh(&rdev->beacon_registrations_lock);
16800         }
16801
16802         rcu_read_unlock();
16803
16804         /*
16805          * It is possible that the user space process that is controlling the
16806          * indoor setting disappeared, so notify the regulatory core.
16807          */
16808         regulatory_netlink_notify(notify->portid);
16809         return NOTIFY_OK;
16810 }
16811
16812 static struct notifier_block nl80211_netlink_notifier = {
16813         .notifier_call = nl80211_netlink_notify,
16814 };
16815
16816 void cfg80211_ft_event(struct net_device *netdev,
16817                        struct cfg80211_ft_event_params *ft_event)
16818 {
16819         struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
16820         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16821         struct sk_buff *msg;
16822         void *hdr;
16823
16824         trace_cfg80211_ft_event(wiphy, netdev, ft_event);
16825
16826         if (!ft_event->target_ap)
16827                 return;
16828
16829         msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
16830                         GFP_KERNEL);
16831         if (!msg)
16832                 return;
16833
16834         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
16835         if (!hdr)
16836                 goto out;
16837
16838         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16839             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16840             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
16841                 goto out;
16842
16843         if (ft_event->ies &&
16844             nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
16845                 goto out;
16846         if (ft_event->ric_ies &&
16847             nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
16848                     ft_event->ric_ies))
16849                 goto out;
16850
16851         genlmsg_end(msg, hdr);
16852
16853         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16854                                 NL80211_MCGRP_MLME, GFP_KERNEL);
16855         return;
16856  out:
16857         nlmsg_free(msg);
16858 }
16859 EXPORT_SYMBOL(cfg80211_ft_event);
16860
16861 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
16862 {
16863         struct cfg80211_registered_device *rdev;
16864         struct sk_buff *msg;
16865         void *hdr;
16866         u32 nlportid;
16867
16868         rdev = wiphy_to_rdev(wdev->wiphy);
16869         if (!rdev->crit_proto_nlportid)
16870                 return;
16871
16872         nlportid = rdev->crit_proto_nlportid;
16873         rdev->crit_proto_nlportid = 0;
16874
16875         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16876         if (!msg)
16877                 return;
16878
16879         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
16880         if (!hdr)
16881                 goto nla_put_failure;
16882
16883         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16884             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16885                               NL80211_ATTR_PAD))
16886                 goto nla_put_failure;
16887
16888         genlmsg_end(msg, hdr);
16889
16890         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
16891         return;
16892
16893  nla_put_failure:
16894         nlmsg_free(msg);
16895 }
16896 EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
16897
16898 void nl80211_send_ap_stopped(struct wireless_dev *wdev)
16899 {
16900         struct wiphy *wiphy = wdev->wiphy;
16901         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16902         struct sk_buff *msg;
16903         void *hdr;
16904
16905         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
16906         if (!msg)
16907                 return;
16908
16909         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
16910         if (!hdr)
16911                 goto out;
16912
16913         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16914             nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
16915             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16916                               NL80211_ATTR_PAD))
16917                 goto out;
16918
16919         genlmsg_end(msg, hdr);
16920
16921         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
16922                                 NL80211_MCGRP_MLME, GFP_KERNEL);
16923         return;
16924  out:
16925         nlmsg_free(msg);
16926 }
16927
16928 int cfg80211_external_auth_request(struct net_device *dev,
16929                                    struct cfg80211_external_auth_params *params,
16930                                    gfp_t gfp)
16931 {
16932         struct wireless_dev *wdev = dev->ieee80211_ptr;
16933         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16934         struct sk_buff *msg;
16935         void *hdr;
16936
16937         if (!wdev->conn_owner_nlportid)
16938                 return -EINVAL;
16939
16940         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16941         if (!msg)
16942                 return -ENOMEM;
16943
16944         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
16945         if (!hdr)
16946                 goto nla_put_failure;
16947
16948         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16949             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16950             nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
16951             nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
16952                         params->action) ||
16953             nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
16954             nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
16955                     params->ssid.ssid))
16956                 goto nla_put_failure;
16957
16958         genlmsg_end(msg, hdr);
16959         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
16960                         wdev->conn_owner_nlportid);
16961         return 0;
16962
16963  nla_put_failure:
16964         nlmsg_free(msg);
16965         return -ENOBUFS;
16966 }
16967 EXPORT_SYMBOL(cfg80211_external_auth_request);
16968
16969 void cfg80211_update_owe_info_event(struct net_device *netdev,
16970                                     struct cfg80211_update_owe_info *owe_info,
16971                                     gfp_t gfp)
16972 {
16973         struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
16974         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16975         struct sk_buff *msg;
16976         void *hdr;
16977
16978         trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info);
16979
16980         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16981         if (!msg)
16982                 return;
16983
16984         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO);
16985         if (!hdr)
16986                 goto nla_put_failure;
16987
16988         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16989             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16990             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer))
16991                 goto nla_put_failure;
16992
16993         if (!owe_info->ie_len ||
16994             nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie))
16995                 goto nla_put_failure;
16996
16997         genlmsg_end(msg, hdr);
16998
16999         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
17000                                 NL80211_MCGRP_MLME, gfp);
17001         return;
17002
17003 nla_put_failure:
17004         genlmsg_cancel(msg, hdr);
17005         nlmsg_free(msg);
17006 }
17007 EXPORT_SYMBOL(cfg80211_update_owe_info_event);
17008
17009 /* initialisation/exit functions */
17010
17011 int __init nl80211_init(void)
17012 {
17013         int err;
17014
17015         err = genl_register_family(&nl80211_fam);
17016         if (err)
17017                 return err;
17018
17019         err = netlink_register_notifier(&nl80211_netlink_notifier);
17020         if (err)
17021                 goto err_out;
17022
17023         return 0;
17024  err_out:
17025         genl_unregister_family(&nl80211_fam);
17026         return err;
17027 }
17028
17029 void nl80211_exit(void)
17030 {
17031         netlink_unregister_notifier(&nl80211_netlink_notifier);
17032         genl_unregister_family(&nl80211_fam);
17033 }