net/wireless/nl80211.c

   1 /*
   2  * This is the new netlink-based wireless configuration interface.
   3  *
   4  * Copyright 2006-2010  Johannes Berg <johannes@sipsolutions.net>
   5  * Copyright 2013-2014  Intel Mobile Communications GmbH
   6  * Copyright 2015-2017  Intel Deutschland GmbH
   7  * Copyright (C) 2018-2019 Intel Corporation
   8  */
   9
  10 #include <linux/if.h>
  11 #include <linux/module.h>
  12 #include <linux/err.h>
  13 #include <linux/slab.h>
  14 #include <linux/list.h>
  15 #include <linux/if_ether.h>
  16 #include <linux/ieee80211.h>
  17 #include <linux/nl80211.h>
  18 #include <linux/rtnetlink.h>
  19 #include <linux/netlink.h>
  20 #include <linux/nospec.h>
  21 #include <linux/etherdevice.h>
  22 #include <net/net_namespace.h>
  23 #include <net/genetlink.h>
  24 #include <net/cfg80211.h>
  25 #include <net/sock.h>
  26 #include <net/inet_connection_sock.h>
  27 #include "core.h"
  28 #include "nl80211.h"
  29 #include "reg.h"
  30 #include "rdev-ops.h"
  31
  32 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  33                                    struct genl_info *info,
  34                                    struct cfg80211_crypto_settings *settings,
  35                                    int cipher_limit);
  36
  37 /* the netlink family */
  38 static struct genl_family nl80211_fam;
  39
  40 /* multicast groups */
  41 enum nl80211_multicast_groups {
  42         NL80211_MCGRP_CONFIG,
  43         NL80211_MCGRP_SCAN,
  44         NL80211_MCGRP_REGULATORY,
  45         NL80211_MCGRP_MLME,
  46         NL80211_MCGRP_VENDOR,
  47         NL80211_MCGRP_NAN,
  48         NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
  49 };
  50
  51 static const struct genl_multicast_group nl80211_mcgrps[] = {
  52         [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
  53         [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
  54         [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
  55         [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
  56         [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
  57         [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
  58 #ifdef CONFIG_NL80211_TESTMODE
  59         [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
  60 #endif
  61 };
  62
  63 /* returns ERR_PTR values */
  64 static struct wireless_dev *
  65 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
  66 {
  67         struct cfg80211_registered_device *rdev;
  68         struct wireless_dev *result = NULL;
  69         bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
  70         bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
  71         u64 wdev_id;
  72         int wiphy_idx = -1;
  73         int ifidx = -1;
  74
  75         ASSERT_RTNL();
  76
  77         if (!have_ifidx && !have_wdev_id)
  78                 return ERR_PTR(-EINVAL);
  79
  80         if (have_ifidx)
  81                 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  82         if (have_wdev_id) {
  83                 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  84                 wiphy_idx = wdev_id >> 32;
  85         }
  86
  87         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  88                 struct wireless_dev *wdev;
  89
  90                 if (wiphy_net(&rdev->wiphy) != netns)
  91                         continue;
  92
  93                 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
  94                         continue;
  95
  96                 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  97                         if (have_ifidx && wdev->netdev &&
  98                             wdev->netdev->ifindex == ifidx) {
  99                                 result = wdev;
 100                                 break;
 101                         }
 102                         if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
 103                                 result = wdev;
 104                                 break;
 105                         }
 106                 }
 107
 108                 if (result)
 109                         break;
 110         }
 111
 112         if (result)
 113                 return result;
 114         return ERR_PTR(-ENODEV);
 115 }
 116
 117 static struct cfg80211_registered_device *
 118 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
 119 {
 120         struct cfg80211_registered_device *rdev = NULL, *tmp;
 121         struct net_device *netdev;
 122
 123         ASSERT_RTNL();
 124
 125         if (!attrs[NL80211_ATTR_WIPHY] &&
 126             !attrs[NL80211_ATTR_IFINDEX] &&
 127             !attrs[NL80211_ATTR_WDEV])
 128                 return ERR_PTR(-EINVAL);
 129
 130         if (attrs[NL80211_ATTR_WIPHY])
 131                 rdev = cfg80211_rdev_by_wiphy_idx(
 132                                 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
 133
 134         if (attrs[NL80211_ATTR_WDEV]) {
 135                 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
 136                 struct wireless_dev *wdev;
 137                 bool found = false;
 138
 139                 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
 140                 if (tmp) {
 141                         /* make sure wdev exists */
 142                         list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
 143                                 if (wdev->identifier != (u32)wdev_id)
 144                                         continue;
 145                                 found = true;
 146                                 break;
 147                         }
 148
 149                         if (!found)
 150                                 tmp = NULL;
 151
 152                         if (rdev && tmp != rdev)
 153                                 return ERR_PTR(-EINVAL);
 154                         rdev = tmp;
 155                 }
 156         }
 157
 158         if (attrs[NL80211_ATTR_IFINDEX]) {
 159                 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
 160
 161                 netdev = __dev_get_by_index(netns, ifindex);
 162                 if (netdev) {
 163                         if (netdev->ieee80211_ptr)
 164                                 tmp = wiphy_to_rdev(
 165                                         netdev->ieee80211_ptr->wiphy);
 166                         else
 167                                 tmp = NULL;
 168
 169                         /* not wireless device -- return error */
 170                         if (!tmp)
 171                                 return ERR_PTR(-EINVAL);
 172
 173                         /* mismatch -- return error */
 174                         if (rdev && tmp != rdev)
 175                                 return ERR_PTR(-EINVAL);
 176
 177                         rdev = tmp;
 178                 }
 179         }
 180
 181         if (!rdev)
 182                 return ERR_PTR(-ENODEV);
 183
 184         if (netns != wiphy_net(&rdev->wiphy))
 185                 return ERR_PTR(-ENODEV);
 186
 187         return rdev;
 188 }
 189
 190 /*
 191  * This function returns a pointer to the driver
 192  * that the genl_info item that is passed refers to.
 193  *
 194  * The result of this can be a PTR_ERR and hence must
 195  * be checked with IS_ERR() for errors.
 196  */
 197 static struct cfg80211_registered_device *
 198 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
 199 {
 200         return __cfg80211_rdev_from_attrs(netns, info->attrs);
 201 }
 202
 203 static int validate_ie_attr(const struct nlattr *attr,
 204                             struct netlink_ext_ack *extack)
 205 {
 206         const u8 *data = nla_data(attr);
 207         unsigned int len = nla_len(attr);
 208         const struct element *elem;
 209
 210         for_each_element(elem, data, len) {
 211                 /* nothing */
 212         }
 213
 214         if (for_each_element_completed(elem, data, len))
 215                 return 0;
 216
 217         NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements");
 218         return -EINVAL;
 219 }
 220
 221 /* policy for the attributes */
 222 static const struct nla_policy
 223 nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = {
 224         [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, },
 225         [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY,
 226                                         .len = U8_MAX },
 227         [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY,
 228                                              .len = U8_MAX },
 229 };
 230
 231 static const struct nla_policy
 232 nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = {
 233         [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG },
 234         [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 },
 235         [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] =
 236                 NLA_POLICY_MAX(NLA_U8, 15),
 237         [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 },
 238         [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] =
 239                 NLA_POLICY_MAX(NLA_U8, 15),
 240         [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] =
 241                 NLA_POLICY_MAX(NLA_U8, 31),
 242         [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 },
 243         [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG },
 244         [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG },
 245 };
 246
 247 static const struct nla_policy
 248 nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = {
 249         [NL80211_PMSR_TYPE_FTM] =
 250                 NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy),
 251 };
 252
 253 static const struct nla_policy
 254 nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = {
 255         [NL80211_PMSR_REQ_ATTR_DATA] =
 256                 NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy),
 257         [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG },
 258 };
 259
 260 static const struct nla_policy
 261 nl80211_psmr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = {
 262         [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR,
 263         /*
 264          * we could specify this again to be the top-level policy,
 265          * but that would open us up to recursion problems ...
 266          */
 267         [NL80211_PMSR_PEER_ATTR_CHAN] = { .type = NLA_NESTED },
 268         [NL80211_PMSR_PEER_ATTR_REQ] =
 269                 NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy),
 270         [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT },
 271 };
 272
 273 static const struct nla_policy
 274 nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = {
 275         [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT },
 276         [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT },
 277         [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT },
 278         [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT },
 279         [NL80211_PMSR_ATTR_PEERS] =
 280                 NLA_POLICY_NESTED_ARRAY(nl80211_psmr_peer_attr_policy),
 281 };
 282
 283 const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
 284         [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
 285         [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
 286                                       .len = 20-1 },
 287         [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
 288
 289         [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
 290         [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
 291         [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
 292         [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
 293         [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
 294
 295         [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
 296         [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
 297         [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
 298         [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
 299         [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
 300         [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
 301
 302         [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX),
 303         [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
 304         [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
 305
 306         [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
 307         [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
 308
 309         [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
 310         [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
 311                                     .len = WLAN_MAX_KEY_LEN },
 312         [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 5),
 313         [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
 314         [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
 315         [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
 316         [NL80211_ATTR_KEY_TYPE] =
 317                 NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES),
 318
 319         [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
 320         [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
 321         [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
 322                                        .len = IEEE80211_MAX_DATA_LEN },
 323         [NL80211_ATTR_BEACON_TAIL] =
 324                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
 325                                        IEEE80211_MAX_DATA_LEN),
 326         [NL80211_ATTR_STA_AID] =
 327                 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
 328         [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
 329         [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
 330         [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
 331                                                .len = NL80211_MAX_SUPP_RATES },
 332         [NL80211_ATTR_STA_PLINK_ACTION] =
 333                 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1),
 334         [NL80211_ATTR_STA_TX_POWER_SETTING] =
 335                 NLA_POLICY_RANGE(NLA_U8,
 336                                  NL80211_TX_POWER_AUTOMATIC,
 337                                  NL80211_TX_POWER_FIXED),
 338         [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 },
 339         [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
 340         [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
 341         [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
 342                                    .len = IEEE80211_MAX_MESH_ID_LEN },
 343         [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
 344
 345         [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
 346         [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
 347
 348         [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
 349         [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
 350         [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
 351         [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
 352                                            .len = NL80211_MAX_SUPP_RATES },
 353         [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
 354
 355         [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
 356         [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
 357
 358         [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
 359
 360         [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
 361         [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
 362                                                    validate_ie_attr,
 363                                                    IEEE80211_MAX_DATA_LEN),
 364         [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
 365         [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
 366
 367         [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
 368                                 .len = IEEE80211_MAX_SSID_LEN },
 369         [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
 370         [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
 371         [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
 372         [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
 373         [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32,
 374                                                   NL80211_MFP_NO,
 375                                                   NL80211_MFP_OPTIONAL),
 376         [NL80211_ATTR_STA_FLAGS2] = {
 377                 .len = sizeof(struct nl80211_sta_flag_update),
 378         },
 379         [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
 380         [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
 381         [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
 382         [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
 383         [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
 384         [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
 385         [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
 386         [NL80211_ATTR_PID] = { .type = NLA_U32 },
 387         [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
 388         [NL80211_ATTR_PMKID] = { .len = WLAN_PMKID_LEN },
 389         [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
 390         [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
 391         [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
 392         [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
 393                                  .len = IEEE80211_MAX_DATA_LEN },
 394         [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
 395         [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32,
 396                                                    NL80211_PS_DISABLED,
 397                                                    NL80211_PS_ENABLED),
 398         [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
 399         [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
 400         [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
 401         [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
 402         [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
 403         [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
 404         [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
 405         [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
 406         [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
 407         [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
 408         [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
 409         [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
 410         [NL80211_ATTR_STA_PLINK_STATE] =
 411                 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1),
 412         [NL80211_ATTR_MESH_PEER_AID] =
 413                 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
 414         [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
 415         [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
 416         [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
 417         [NL80211_ATTR_HIDDEN_SSID] =
 418                 NLA_POLICY_RANGE(NLA_U32,
 419                                  NL80211_HIDDEN_SSID_NOT_IN_USE,
 420                                  NL80211_HIDDEN_SSID_ZERO_CONTENTS),
 421         [NL80211_ATTR_IE_PROBE_RESP] =
 422                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
 423                                        IEEE80211_MAX_DATA_LEN),
 424         [NL80211_ATTR_IE_ASSOC_RESP] =
 425                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
 426                                        IEEE80211_MAX_DATA_LEN),
 427         [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
 428         [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
 429         [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
 430         [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
 431         [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
 432         [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
 433         [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
 434         [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
 435         [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
 436         [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
 437         [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
 438                                       .len = IEEE80211_MAX_DATA_LEN },
 439         [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
 440         [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
 441         [NL80211_ATTR_HT_CAPABILITY_MASK] = {
 442                 .len = NL80211_HT_CAPABILITY_LEN
 443         },
 444         [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
 445         [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
 446         [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
 447         [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
 448         [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
 449         [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
 450         [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
 451         [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
 452         [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127),
 453         [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1),
 454         [NL80211_ATTR_LOCAL_MESH_POWER_MODE] =
 455                 NLA_POLICY_RANGE(NLA_U32,
 456                                  NL80211_MESH_POWER_UNKNOWN + 1,
 457                                  NL80211_MESH_POWER_MAX),
 458         [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
 459         [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
 460         [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
 461         [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
 462         [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
 463         [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
 464         [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
 465                 .len = NL80211_VHT_CAPABILITY_LEN,
 466         },
 467         [NL80211_ATTR_MDID] = { .type = NLA_U16 },
 468         [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
 469                                   .len = IEEE80211_MAX_DATA_LEN },
 470         [NL80211_ATTR_PEER_AID] =
 471                 NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
 472         [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
 473         [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
 474         [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
 475         [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
 476         [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
 477         [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
 478         [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
 479         [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
 480         [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
 481         [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
 482         [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
 483         [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
 484         [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
 485                                    .len = IEEE80211_QOS_MAP_LEN_MAX },
 486         [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
 487         [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
 488         [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
 489         [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
 490         [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
 491         [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
 492         [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1),
 493         [NL80211_ATTR_USER_PRIO] =
 494                 NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1),
 495         [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
 496         [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
 497         [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
 498         [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
 499         [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
 500         [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
 501         [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
 502         [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
 503         [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
 504         [NL80211_ATTR_STA_SUPPORT_P2P_PS] =
 505                 NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1),
 506         [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
 507                 .len = VHT_MUMIMO_GROUPS_DATA_LEN
 508         },
 509         [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
 510         [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1),
 511         [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
 512         [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
 513         [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
 514                                     .len = FILS_MAX_KEK_LEN },
 515         [NL80211_ATTR_FILS_NONCES] = { .len = 2 * FILS_NONCE_LEN },
 516         [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
 517         [NL80211_ATTR_BSSID] = { .len = ETH_ALEN },
 518         [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
 519         [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
 520                 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
 521         },
 522         [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
 523         [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
 524                                              .len = FILS_ERP_MAX_USERNAME_LEN },
 525         [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
 526                                           .len = FILS_ERP_MAX_REALM_LEN },
 527         [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
 528         [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
 529                                         .len = FILS_ERP_MAX_RRK_LEN },
 530         [NL80211_ATTR_FILS_CACHE_ID] = { .len = 2 },
 531         [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
 532         [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
 533         [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
 534
 535         [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
 536         [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
 537         [NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 },
 538         [NL80211_ATTR_HE_CAPABILITY] = { .type = NLA_BINARY,
 539                                          .len = NL80211_HE_MAX_CAPABILITY_LEN },
 540
 541         [NL80211_ATTR_FTM_RESPONDER] = {
 542                 .type = NLA_NESTED,
 543                 .validation_data = nl80211_ftm_responder_policy,
 544         },
 545         [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1),
 546         [NL80211_ATTR_PEER_MEASUREMENTS] =
 547                 NLA_POLICY_NESTED(nl80211_pmsr_attr_policy),
 548         [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1),
 549 };
 550
 551 /* policy for the key attributes */
 552 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
 553         [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
 554         [NL80211_KEY_IDX] = { .type = NLA_U8 },
 555         [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
 556         [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
 557         [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
 558         [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
 559         [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1),
 560         [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
 561         [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX),
 562 };
 563
 564 /* policy for the key default flags */
 565 static const struct nla_policy
 566 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
 567         [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
 568         [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
 569 };
 570
 571 #ifdef CONFIG_PM
 572 /* policy for WoWLAN attributes */
 573 static const struct nla_policy
 574 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
 575         [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
 576         [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
 577         [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
 578         [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
 579         [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
 580         [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
 581         [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
 582         [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
 583         [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
 584         [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
 585 };
 586
 587 static const struct nla_policy
 588 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
 589         [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
 590         [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
 591         [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
 592         [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
 593         [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
 594         [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
 595         [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
 596                 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
 597         },
 598         [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
 599                 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
 600         },
 601         [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
 602         [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
 603         [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
 604 };
 605 #endif /* CONFIG_PM */
 606
 607 /* policy for coalesce rule attributes */
 608 static const struct nla_policy
 609 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
 610         [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
 611         [NL80211_ATTR_COALESCE_RULE_CONDITION] =
 612                 NLA_POLICY_RANGE(NLA_U32,
 613                                  NL80211_COALESCE_CONDITION_MATCH,
 614                                  NL80211_COALESCE_CONDITION_NO_MATCH),
 615         [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
 616 };
 617
 618 /* policy for GTK rekey offload attributes */
 619 static const struct nla_policy
 620 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
 621         [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
 622         [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
 623         [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
 624 };
 625
 626 static const struct nla_policy
 627 nl80211_match_band_rssi_policy[NUM_NL80211_BANDS] = {
 628         [NL80211_BAND_2GHZ] = { .type = NLA_S32 },
 629         [NL80211_BAND_5GHZ] = { .type = NLA_S32 },
 630         [NL80211_BAND_60GHZ] = { .type = NLA_S32 },
 631 };
 632
 633 static const struct nla_policy
 634 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
 635         [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
 636                                                  .len = IEEE80211_MAX_SSID_LEN },
 637         [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = { .len = ETH_ALEN },
 638         [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
 639         [NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI] =
 640                 NLA_POLICY_NESTED(nl80211_match_band_rssi_policy),
 641 };
 642
 643 static const struct nla_policy
 644 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
 645         [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
 646         [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
 647 };
 648
 649 static const struct nla_policy
 650 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
 651         [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
 652         [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
 653         [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
 654                 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
 655         },
 656 };
 657
 658 /* policy for NAN function attributes */
 659 static const struct nla_policy
 660 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
 661         [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
 662         [NL80211_NAN_FUNC_SERVICE_ID] = {
 663                                     .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
 664         [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
 665         [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
 666         [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
 667         [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
 668         [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
 669         [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
 670         [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
 671         [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
 672         [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
 673                         .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
 674         [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
 675         [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
 676         [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
 677         [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
 678         [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
 679 };
 680
 681 /* policy for Service Response Filter attributes */
 682 static const struct nla_policy
 683 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
 684         [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
 685         [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
 686                                  .len =  NL80211_NAN_FUNC_SRF_MAX_LEN },
 687         [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
 688         [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
 689 };
 690
 691 /* policy for packet pattern attributes */
 692 static const struct nla_policy
 693 nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
 694         [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
 695         [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
 696         [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
 697 };
 698
 699 int nl80211_prepare_wdev_dump(struct netlink_callback *cb,
 700                               struct cfg80211_registered_device **rdev,
 701                               struct wireless_dev **wdev)
 702 {
 703         int err;
 704
 705         if (!cb->args[0]) {
 706                 err = nlmsg_parse_deprecated(cb->nlh,
 707                                              GENL_HDRLEN + nl80211_fam.hdrsize,
 708                                              genl_family_attrbuf(&nl80211_fam),
 709                                              nl80211_fam.maxattr,
 710                                              nl80211_policy, NULL);
 711                 if (err)
 712                         return err;
 713
 714                 *wdev = __cfg80211_wdev_from_attrs(
 715                                         sock_net(cb->skb->sk),
 716                                         genl_family_attrbuf(&nl80211_fam));
 717                 if (IS_ERR(*wdev))
 718                         return PTR_ERR(*wdev);
 719                 *rdev = wiphy_to_rdev((*wdev)->wiphy);
 720                 /* 0 is the first index - add 1 to parse only once */
 721                 cb->args[0] = (*rdev)->wiphy_idx + 1;
 722                 cb->args[1] = (*wdev)->identifier;
 723         } else {
 724                 /* subtract the 1 again here */
 725                 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
 726                 struct wireless_dev *tmp;
 727
 728                 if (!wiphy)
 729                         return -ENODEV;
 730                 *rdev = wiphy_to_rdev(wiphy);
 731                 *wdev = NULL;
 732
 733                 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
 734                         if (tmp->identifier == cb->args[1]) {
 735                                 *wdev = tmp;
 736                                 break;
 737                         }
 738                 }
 739
 740                 if (!*wdev)
 741                         return -ENODEV;
 742         }
 743
 744         return 0;
 745 }
 746
 747 /* message building helper */
 748 void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
 749                      int flags, u8 cmd)
 750 {
 751         /* since there is no private header just add the generic one */
 752         return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
 753 }
 754
 755 static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
 756                                      const struct ieee80211_reg_rule *rule)
 757 {
 758         int j;
 759         struct nlattr *nl_wmm_rules =
 760                 nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM);
 761
 762         if (!nl_wmm_rules)
 763                 goto nla_put_failure;
 764
 765         for (j = 0; j < IEEE80211_NUM_ACS; j++) {
 766                 struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j);
 767
 768                 if (!nl_wmm_rule)
 769                         goto nla_put_failure;
 770
 771                 if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
 772                                 rule->wmm_rule.client[j].cw_min) ||
 773                     nla_put_u16(msg, NL80211_WMMR_CW_MAX,
 774                                 rule->wmm_rule.client[j].cw_max) ||
 775                     nla_put_u8(msg, NL80211_WMMR_AIFSN,
 776                                rule->wmm_rule.client[j].aifsn) ||
 777                     nla_put_u16(msg, NL80211_WMMR_TXOP,
 778                                 rule->wmm_rule.client[j].cot))
 779                         goto nla_put_failure;
 780
 781                 nla_nest_end(msg, nl_wmm_rule);
 782         }
 783         nla_nest_end(msg, nl_wmm_rules);
 784
 785         return 0;
 786
 787 nla_put_failure:
 788         return -ENOBUFS;
 789 }
 790
 791 static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
 792                                    struct ieee80211_channel *chan,
 793                                    bool large)
 794 {
 795         /* Some channels must be completely excluded from the
 796          * list to protect old user-space tools from breaking
 797          */
 798         if (!large && chan->flags &
 799             (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
 800                 return 0;
 801
 802         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
 803                         chan->center_freq))
 804                 goto nla_put_failure;
 805
 806         if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
 807             nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
 808                 goto nla_put_failure;
 809         if (chan->flags & IEEE80211_CHAN_NO_IR) {
 810                 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
 811                         goto nla_put_failure;
 812                 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
 813                         goto nla_put_failure;
 814         }
 815         if (chan->flags & IEEE80211_CHAN_RADAR) {
 816                 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
 817                         goto nla_put_failure;
 818                 if (large) {
 819                         u32 time;
 820
 821                         time = elapsed_jiffies_msecs(chan->dfs_state_entered);
 822
 823                         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
 824                                         chan->dfs_state))
 825                                 goto nla_put_failure;
 826                         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
 827                                         time))
 828                                 goto nla_put_failure;
 829                         if (nla_put_u32(msg,
 830                                         NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
 831                                         chan->dfs_cac_ms))
 832                                 goto nla_put_failure;
 833                 }
 834         }
 835
 836         if (large) {
 837                 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
 838                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
 839                         goto nla_put_failure;
 840                 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
 841                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
 842                         goto nla_put_failure;
 843                 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
 844                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
 845                         goto nla_put_failure;
 846                 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
 847                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
 848                         goto nla_put_failure;
 849                 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
 850                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
 851                         goto nla_put_failure;
 852                 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
 853                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
 854                         goto nla_put_failure;
 855                 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
 856                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
 857                         goto nla_put_failure;
 858                 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
 859                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
 860                         goto nla_put_failure;
 861         }
 862
 863         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
 864                         DBM_TO_MBM(chan->max_power)))
 865                 goto nla_put_failure;
 866
 867         if (large) {
 868                 const struct ieee80211_reg_rule *rule =
 869                         freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq));
 870
 871                 if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) {
 872                         if (nl80211_msg_put_wmm_rules(msg, rule))
 873                                 goto nla_put_failure;
 874                 }
 875         }
 876
 877         return 0;
 878
 879  nla_put_failure:
 880         return -ENOBUFS;
 881 }
 882
 883 static bool nl80211_put_txq_stats(struct sk_buff *msg,
 884                                   struct cfg80211_txq_stats *txqstats,
 885                                   int attrtype)
 886 {
 887         struct nlattr *txqattr;
 888
 889 #define PUT_TXQVAL_U32(attr, memb) do {                                   \
 890         if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) &&         \
 891             nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
 892                 return false;                                             \
 893         } while (0)
 894
 895         txqattr = nla_nest_start_noflag(msg, attrtype);
 896         if (!txqattr)
 897                 return false;
 898
 899         PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
 900         PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
 901         PUT_TXQVAL_U32(FLOWS, flows);
 902         PUT_TXQVAL_U32(DROPS, drops);
 903         PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
 904         PUT_TXQVAL_U32(OVERLIMIT, overlimit);
 905         PUT_TXQVAL_U32(OVERMEMORY, overmemory);
 906         PUT_TXQVAL_U32(COLLISIONS, collisions);
 907         PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
 908         PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
 909         PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
 910         nla_nest_end(msg, txqattr);
 911
 912 #undef PUT_TXQVAL_U32
 913         return true;
 914 }
 915
 916 /* netlink command implementations */
 917
 918 struct key_parse {
 919         struct key_params p;
 920         int idx;
 921         int type;
 922         bool def, defmgmt;
 923         bool def_uni, def_multi;
 924 };
 925
 926 static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
 927                                  struct key_parse *k)
 928 {
 929         struct nlattr *tb[NL80211_KEY_MAX + 1];
 930         int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key,
 931                                               nl80211_key_policy,
 932                                               info->extack);
 933         if (err)
 934                 return err;
 935
 936         k->def = !!tb[NL80211_KEY_DEFAULT];
 937         k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
 938
 939         if (k->def) {
 940                 k->def_uni = true;
 941                 k->def_multi = true;
 942         }
 943         if (k->defmgmt)
 944                 k->def_multi = true;
 945
 946         if (tb[NL80211_KEY_IDX])
 947                 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
 948
 949         if (tb[NL80211_KEY_DATA]) {
 950                 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
 951                 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
 952         }
 953
 954         if (tb[NL80211_KEY_SEQ]) {
 955                 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
 956                 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
 957         }
 958
 959         if (tb[NL80211_KEY_CIPHER])
 960                 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
 961
 962         if (tb[NL80211_KEY_TYPE])
 963                 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
 964
 965         if (tb[NL80211_KEY_DEFAULT_TYPES]) {
 966                 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
 967
 968                 err = nla_parse_nested_deprecated(kdt,
 969                                                   NUM_NL80211_KEY_DEFAULT_TYPES - 1,
 970                                                   tb[NL80211_KEY_DEFAULT_TYPES],
 971                                                   nl80211_key_default_policy,
 972                                                   info->extack);
 973                 if (err)
 974                         return err;
 975
 976                 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
 977                 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
 978         }
 979
 980         if (tb[NL80211_KEY_MODE])
 981                 k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]);
 982
 983         return 0;
 984 }
 985
 986 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
 987 {
 988         if (info->attrs[NL80211_ATTR_KEY_DATA]) {
 989                 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
 990                 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
 991         }
 992
 993         if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
 994                 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
 995                 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
 996         }
 997
 998         if (info->attrs[NL80211_ATTR_KEY_IDX])
 999                 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
1000
1001         if (info->attrs[NL80211_ATTR_KEY_CIPHER])
1002                 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
1003
1004         k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
1005         k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
1006
1007         if (k->def) {
1008                 k->def_uni = true;
1009                 k->def_multi = true;
1010         }
1011         if (k->defmgmt)
1012                 k->def_multi = true;
1013
1014         if (info->attrs[NL80211_ATTR_KEY_TYPE])
1015                 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
1016
1017         if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
1018                 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
1019                 int err = nla_parse_nested_deprecated(kdt,
1020                                                       NUM_NL80211_KEY_DEFAULT_TYPES - 1,
1021                                                       info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
1022                                                       nl80211_key_default_policy,
1023                                                       info->extack);
1024                 if (err)
1025                         return err;
1026
1027                 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
1028                 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
1029         }
1030
1031         return 0;
1032 }
1033
1034 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
1035 {
1036         int err;
1037
1038         memset(k, 0, sizeof(*k));
1039         k->idx = -1;
1040         k->type = -1;
1041
1042         if (info->attrs[NL80211_ATTR_KEY])
1043                 err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
1044         else
1045                 err = nl80211_parse_key_old(info, k);
1046
1047         if (err)
1048                 return err;
1049
1050         if (k->def && k->defmgmt) {
1051                 GENL_SET_ERR_MSG(info, "key with def && defmgmt is invalid");
1052                 return -EINVAL;
1053         }
1054
1055         if (k->defmgmt) {
1056                 if (k->def_uni || !k->def_multi) {
1057                         GENL_SET_ERR_MSG(info, "defmgmt key must be mcast");
1058                         return -EINVAL;
1059                 }
1060         }
1061
1062         if (k->idx != -1) {
1063                 if (k->defmgmt) {
1064                         if (k->idx < 4 || k->idx > 5) {
1065                                 GENL_SET_ERR_MSG(info,
1066                                                  "defmgmt key idx not 4 or 5");
1067                                 return -EINVAL;
1068                         }
1069                 } else if (k->def) {
1070                         if (k->idx < 0 || k->idx > 3) {
1071                                 GENL_SET_ERR_MSG(info, "def key idx not 0-3");
1072                                 return -EINVAL;
1073                         }
1074                 } else {
1075                         if (k->idx < 0 || k->idx > 5) {
1076                                 GENL_SET_ERR_MSG(info, "key idx not 0-5");
1077                                 return -EINVAL;
1078                         }
1079                 }
1080         }
1081
1082         return 0;
1083 }
1084
1085 static struct cfg80211_cached_keys *
1086 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
1087                        struct genl_info *info, bool *no_ht)
1088 {
1089         struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
1090         struct key_parse parse;
1091         struct nlattr *key;
1092         struct cfg80211_cached_keys *result;
1093         int rem, err, def = 0;
1094         bool have_key = false;
1095
1096         nla_for_each_nested(key, keys, rem) {
1097                 have_key = true;
1098                 break;
1099         }
1100
1101         if (!have_key)
1102                 return NULL;
1103
1104         result = kzalloc(sizeof(*result), GFP_KERNEL);
1105         if (!result)
1106                 return ERR_PTR(-ENOMEM);
1107
1108         result->def = -1;
1109
1110         nla_for_each_nested(key, keys, rem) {
1111                 memset(&parse, 0, sizeof(parse));
1112                 parse.idx = -1;
1113
1114                 err = nl80211_parse_key_new(info, key, &parse);
1115                 if (err)
1116                         goto error;
1117                 err = -EINVAL;
1118                 if (!parse.p.key)
1119                         goto error;
1120                 if (parse.idx < 0 || parse.idx > 3) {
1121                         GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
1122                         goto error;
1123                 }
1124                 if (parse.def) {
1125                         if (def) {
1126                                 GENL_SET_ERR_MSG(info,
1127                                                  "only one key can be default");
1128                                 goto error;
1129                         }
1130                         def = 1;
1131                         result->def = parse.idx;
1132                         if (!parse.def_uni || !parse.def_multi)
1133                                 goto error;
1134                 } else if (parse.defmgmt)
1135                         goto error;
1136                 err = cfg80211_validate_key_settings(rdev, &parse.p,
1137                                                      parse.idx, false, NULL);
1138                 if (err)
1139                         goto error;
1140                 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
1141                     parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
1142                         GENL_SET_ERR_MSG(info, "connect key must be WEP");
1143                         err = -EINVAL;
1144                         goto error;
1145                 }
1146                 result->params[parse.idx].cipher = parse.p.cipher;
1147                 result->params[parse.idx].key_len = parse.p.key_len;
1148                 result->params[parse.idx].key = result->data[parse.idx];
1149                 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
1150
1151                 /* must be WEP key if we got here */
1152                 if (no_ht)
1153                         *no_ht = true;
1154         }
1155
1156         if (result->def < 0) {
1157                 err = -EINVAL;
1158                 GENL_SET_ERR_MSG(info, "need a default/TX key");
1159                 goto error;
1160         }
1161
1162         return result;
1163  error:
1164         kfree(result);
1165         return ERR_PTR(err);
1166 }
1167
1168 static int nl80211_key_allowed(struct wireless_dev *wdev)
1169 {
1170         ASSERT_WDEV_LOCK(wdev);
1171
1172         switch (wdev->iftype) {
1173         case NL80211_IFTYPE_AP:
1174         case NL80211_IFTYPE_AP_VLAN:
1175         case NL80211_IFTYPE_P2P_GO:
1176         case NL80211_IFTYPE_MESH_POINT:
1177                 break;
1178         case NL80211_IFTYPE_ADHOC:
1179         case NL80211_IFTYPE_STATION:
1180         case NL80211_IFTYPE_P2P_CLIENT:
1181                 if (!wdev->current_bss)
1182                         return -ENOLINK;
1183                 break;
1184         case NL80211_IFTYPE_UNSPECIFIED:
1185         case NL80211_IFTYPE_OCB:
1186         case NL80211_IFTYPE_MONITOR:
1187         case NL80211_IFTYPE_NAN:
1188         case NL80211_IFTYPE_P2P_DEVICE:
1189         case NL80211_IFTYPE_WDS:
1190         case NUM_NL80211_IFTYPES:
1191                 return -EINVAL;
1192         }
1193
1194         return 0;
1195 }
1196
1197 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
1198                                                         struct nlattr *tb)
1199 {
1200         struct ieee80211_channel *chan;
1201
1202         if (tb == NULL)
1203                 return NULL;
1204         chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
1205         if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
1206                 return NULL;
1207         return chan;
1208 }
1209
1210 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
1211 {
1212         struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr);
1213         int i;
1214
1215         if (!nl_modes)
1216                 goto nla_put_failure;
1217
1218         i = 0;
1219         while (ifmodes) {
1220                 if ((ifmodes & 1) && nla_put_flag(msg, i))
1221                         goto nla_put_failure;
1222                 ifmodes >>= 1;
1223                 i++;
1224         }
1225
1226         nla_nest_end(msg, nl_modes);
1227         return 0;
1228
1229 nla_put_failure:
1230         return -ENOBUFS;
1231 }
1232
1233 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1234                                           struct sk_buff *msg,
1235                                           bool large)
1236 {
1237         struct nlattr *nl_combis;
1238         int i, j;
1239
1240         nl_combis = nla_nest_start_noflag(msg,
1241                                           NL80211_ATTR_INTERFACE_COMBINATIONS);
1242         if (!nl_combis)
1243                 goto nla_put_failure;
1244
1245         for (i = 0; i < wiphy->n_iface_combinations; i++) {
1246                 const struct ieee80211_iface_combination *c;
1247                 struct nlattr *nl_combi, *nl_limits;
1248
1249                 c = &wiphy->iface_combinations[i];
1250
1251                 nl_combi = nla_nest_start_noflag(msg, i + 1);
1252                 if (!nl_combi)
1253                         goto nla_put_failure;
1254
1255                 nl_limits = nla_nest_start_noflag(msg,
1256                                                   NL80211_IFACE_COMB_LIMITS);
1257                 if (!nl_limits)
1258                         goto nla_put_failure;
1259
1260                 for (j = 0; j < c->n_limits; j++) {
1261                         struct nlattr *nl_limit;
1262
1263                         nl_limit = nla_nest_start_noflag(msg, j + 1);
1264                         if (!nl_limit)
1265                                 goto nla_put_failure;
1266                         if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1267                                         c->limits[j].max))
1268                                 goto nla_put_failure;
1269                         if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1270                                                 c->limits[j].types))
1271                                 goto nla_put_failure;
1272                         nla_nest_end(msg, nl_limit);
1273                 }
1274
1275                 nla_nest_end(msg, nl_limits);
1276
1277                 if (c->beacon_int_infra_match &&
1278                     nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1279                         goto nla_put_failure;
1280                 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1281                                 c->num_different_channels) ||
1282                     nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1283                                 c->max_interfaces))
1284                         goto nla_put_failure;
1285                 if (large &&
1286                     (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1287                                 c->radar_detect_widths) ||
1288                      nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1289                                 c->radar_detect_regions)))
1290                         goto nla_put_failure;
1291                 if (c->beacon_int_min_gcd &&
1292                     nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
1293                                 c->beacon_int_min_gcd))
1294                         goto nla_put_failure;
1295
1296                 nla_nest_end(msg, nl_combi);
1297         }
1298
1299         nla_nest_end(msg, nl_combis);
1300
1301         return 0;
1302 nla_put_failure:
1303         return -ENOBUFS;
1304 }
1305
1306 #ifdef CONFIG_PM
1307 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1308                                         struct sk_buff *msg)
1309 {
1310         const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1311         struct nlattr *nl_tcp;
1312
1313         if (!tcp)
1314                 return 0;
1315
1316         nl_tcp = nla_nest_start_noflag(msg,
1317                                        NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1318         if (!nl_tcp)
1319                 return -ENOBUFS;
1320
1321         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1322                         tcp->data_payload_max))
1323                 return -ENOBUFS;
1324
1325         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1326                         tcp->data_payload_max))
1327                 return -ENOBUFS;
1328
1329         if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1330                 return -ENOBUFS;
1331
1332         if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1333                                 sizeof(*tcp->tok), tcp->tok))
1334                 return -ENOBUFS;
1335
1336         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1337                         tcp->data_interval_max))
1338                 return -ENOBUFS;
1339
1340         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1341                         tcp->wake_payload_max))
1342                 return -ENOBUFS;
1343
1344         nla_nest_end(msg, nl_tcp);
1345         return 0;
1346 }
1347
1348 static int nl80211_send_wowlan(struct sk_buff *msg,
1349                                struct cfg80211_registered_device *rdev,
1350                                bool large)
1351 {
1352         struct nlattr *nl_wowlan;
1353
1354         if (!rdev->wiphy.wowlan)
1355                 return 0;
1356
1357         nl_wowlan = nla_nest_start_noflag(msg,
1358                                           NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1359         if (!nl_wowlan)
1360                 return -ENOBUFS;
1361
1362         if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1363              nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1364             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1365              nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1366             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1367              nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1368             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1369              nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1370             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1371              nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1372             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1373              nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1374             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1375              nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1376             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1377              nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1378                 return -ENOBUFS;
1379
1380         if (rdev->wiphy.wowlan->n_patterns) {
1381                 struct nl80211_pattern_support pat = {
1382                         .max_patterns = rdev->wiphy.wowlan->n_patterns,
1383                         .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1384                         .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1385                         .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1386                 };
1387
1388                 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1389                             sizeof(pat), &pat))
1390                         return -ENOBUFS;
1391         }
1392
1393         if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1394             nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1395                         rdev->wiphy.wowlan->max_nd_match_sets))
1396                 return -ENOBUFS;
1397
1398         if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1399                 return -ENOBUFS;
1400
1401         nla_nest_end(msg, nl_wowlan);
1402
1403         return 0;
1404 }
1405 #endif
1406
1407 static int nl80211_send_coalesce(struct sk_buff *msg,
1408                                  struct cfg80211_registered_device *rdev)
1409 {
1410         struct nl80211_coalesce_rule_support rule;
1411
1412         if (!rdev->wiphy.coalesce)
1413                 return 0;
1414
1415         rule.max_rules = rdev->wiphy.coalesce->n_rules;
1416         rule.max_delay = rdev->wiphy.coalesce->max_delay;
1417         rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1418         rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1419         rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1420         rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1421
1422         if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1423                 return -ENOBUFS;
1424
1425         return 0;
1426 }
1427
1428 static int
1429 nl80211_send_iftype_data(struct sk_buff *msg,
1430                          const struct ieee80211_sband_iftype_data *iftdata)
1431 {
1432         const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap;
1433
1434         if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES,
1435                                 iftdata->types_mask))
1436                 return -ENOBUFS;
1437
1438         if (he_cap->has_he) {
1439                 if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC,
1440                             sizeof(he_cap->he_cap_elem.mac_cap_info),
1441                             he_cap->he_cap_elem.mac_cap_info) ||
1442                     nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY,
1443                             sizeof(he_cap->he_cap_elem.phy_cap_info),
1444                             he_cap->he_cap_elem.phy_cap_info) ||
1445                     nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET,
1446                             sizeof(he_cap->he_mcs_nss_supp),
1447                             &he_cap->he_mcs_nss_supp) ||
1448                     nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE,
1449                             sizeof(he_cap->ppe_thres), he_cap->ppe_thres))
1450                         return -ENOBUFS;
1451         }
1452
1453         return 0;
1454 }
1455
1456 static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1457                                       struct ieee80211_supported_band *sband)
1458 {
1459         struct nlattr *nl_rates, *nl_rate;
1460         struct ieee80211_rate *rate;
1461         int i;
1462
1463         /* add HT info */
1464         if (sband->ht_cap.ht_supported &&
1465             (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1466                      sizeof(sband->ht_cap.mcs),
1467                      &sband->ht_cap.mcs) ||
1468              nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1469                          sband->ht_cap.cap) ||
1470              nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1471                         sband->ht_cap.ampdu_factor) ||
1472              nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1473                         sband->ht_cap.ampdu_density)))
1474                 return -ENOBUFS;
1475
1476         /* add VHT info */
1477         if (sband->vht_cap.vht_supported &&
1478             (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1479                      sizeof(sband->vht_cap.vht_mcs),
1480                      &sband->vht_cap.vht_mcs) ||
1481              nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1482                          sband->vht_cap.cap)))
1483                 return -ENOBUFS;
1484
1485         if (sband->n_iftype_data) {
1486                 struct nlattr *nl_iftype_data =
1487                         nla_nest_start_noflag(msg,
1488                                               NL80211_BAND_ATTR_IFTYPE_DATA);
1489                 int err;
1490
1491                 if (!nl_iftype_data)
1492                         return -ENOBUFS;
1493
1494                 for (i = 0; i < sband->n_iftype_data; i++) {
1495                         struct nlattr *iftdata;
1496
1497                         iftdata = nla_nest_start_noflag(msg, i + 1);
1498                         if (!iftdata)
1499                                 return -ENOBUFS;
1500
1501                         err = nl80211_send_iftype_data(msg,
1502                                                        &sband->iftype_data[i]);
1503                         if (err)
1504                                 return err;
1505
1506                         nla_nest_end(msg, iftdata);
1507                 }
1508
1509                 nla_nest_end(msg, nl_iftype_data);
1510         }
1511
1512         /* add bitrates */
1513         nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES);
1514         if (!nl_rates)
1515                 return -ENOBUFS;
1516
1517         for (i = 0; i < sband->n_bitrates; i++) {
1518                 nl_rate = nla_nest_start_noflag(msg, i);
1519                 if (!nl_rate)
1520                         return -ENOBUFS;
1521
1522                 rate = &sband->bitrates[i];
1523                 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1524                                 rate->bitrate))
1525                         return -ENOBUFS;
1526                 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1527                     nla_put_flag(msg,
1528                                  NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1529                         return -ENOBUFS;
1530
1531                 nla_nest_end(msg, nl_rate);
1532         }
1533
1534         nla_nest_end(msg, nl_rates);
1535
1536         return 0;
1537 }
1538
1539 static int
1540 nl80211_send_mgmt_stypes(struct sk_buff *msg,
1541                          const struct ieee80211_txrx_stypes *mgmt_stypes)
1542 {
1543         u16 stypes;
1544         struct nlattr *nl_ftypes, *nl_ifs;
1545         enum nl80211_iftype ift;
1546         int i;
1547
1548         if (!mgmt_stypes)
1549                 return 0;
1550
1551         nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES);
1552         if (!nl_ifs)
1553                 return -ENOBUFS;
1554
1555         for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1556                 nl_ftypes = nla_nest_start_noflag(msg, ift);
1557                 if (!nl_ftypes)
1558                         return -ENOBUFS;
1559                 i = 0;
1560                 stypes = mgmt_stypes[ift].tx;
1561                 while (stypes) {
1562                         if ((stypes & 1) &&
1563                             nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1564                                         (i << 4) | IEEE80211_FTYPE_MGMT))
1565                                 return -ENOBUFS;
1566                         stypes >>= 1;
1567                         i++;
1568                 }
1569                 nla_nest_end(msg, nl_ftypes);
1570         }
1571
1572         nla_nest_end(msg, nl_ifs);
1573
1574         nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES);
1575         if (!nl_ifs)
1576                 return -ENOBUFS;
1577
1578         for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1579                 nl_ftypes = nla_nest_start_noflag(msg, ift);
1580                 if (!nl_ftypes)
1581                         return -ENOBUFS;
1582                 i = 0;
1583                 stypes = mgmt_stypes[ift].rx;
1584                 while (stypes) {
1585                         if ((stypes & 1) &&
1586                             nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1587                                         (i << 4) | IEEE80211_FTYPE_MGMT))
1588                                 return -ENOBUFS;
1589                         stypes >>= 1;
1590                         i++;
1591                 }
1592                 nla_nest_end(msg, nl_ftypes);
1593         }
1594         nla_nest_end(msg, nl_ifs);
1595
1596         return 0;
1597 }
1598
1599 #define CMD(op, n)                                                      \
1600          do {                                                           \
1601                 if (rdev->ops->op) {                                    \
1602                         i++;                                            \
1603                         if (nla_put_u32(msg, i, NL80211_CMD_ ## n))     \
1604                                 goto nla_put_failure;                   \
1605                 }                                                       \
1606         } while (0)
1607
1608 static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
1609                                         struct sk_buff *msg)
1610 {
1611         int i = 0;
1612
1613         /*
1614          * do *NOT* add anything into this function, new things need to be
1615          * advertised only to new versions of userspace that can deal with
1616          * the split (and they can't possibly care about new features...
1617          */
1618         CMD(add_virtual_intf, NEW_INTERFACE);
1619         CMD(change_virtual_intf, SET_INTERFACE);
1620         CMD(add_key, NEW_KEY);
1621         CMD(start_ap, START_AP);
1622         CMD(add_station, NEW_STATION);
1623         CMD(add_mpath, NEW_MPATH);
1624         CMD(update_mesh_config, SET_MESH_CONFIG);
1625         CMD(change_bss, SET_BSS);
1626         CMD(auth, AUTHENTICATE);
1627         CMD(assoc, ASSOCIATE);
1628         CMD(deauth, DEAUTHENTICATE);
1629         CMD(disassoc, DISASSOCIATE);
1630         CMD(join_ibss, JOIN_IBSS);
1631         CMD(join_mesh, JOIN_MESH);
1632         CMD(set_pmksa, SET_PMKSA);
1633         CMD(del_pmksa, DEL_PMKSA);
1634         CMD(flush_pmksa, FLUSH_PMKSA);
1635         if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1636                 CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1637         CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1638         CMD(mgmt_tx, FRAME);
1639         CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1640         if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1641                 i++;
1642                 if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1643                         goto nla_put_failure;
1644         }
1645         if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1646             rdev->ops->join_mesh) {
1647                 i++;
1648                 if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1649                         goto nla_put_failure;
1650         }
1651         CMD(set_wds_peer, SET_WDS_PEER);
1652         if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1653                 CMD(tdls_mgmt, TDLS_MGMT);
1654                 CMD(tdls_oper, TDLS_OPER);
1655         }
1656         if (rdev->wiphy.max_sched_scan_reqs)
1657                 CMD(sched_scan_start, START_SCHED_SCAN);
1658         CMD(probe_client, PROBE_CLIENT);
1659         CMD(set_noack_map, SET_NOACK_MAP);
1660         if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1661                 i++;
1662                 if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1663                         goto nla_put_failure;
1664         }
1665         CMD(start_p2p_device, START_P2P_DEVICE);
1666         CMD(set_mcast_rate, SET_MCAST_RATE);
1667 #ifdef CONFIG_NL80211_TESTMODE
1668         CMD(testmode_cmd, TESTMODE);
1669 #endif
1670
1671         if (rdev->ops->connect || rdev->ops->auth) {
1672                 i++;
1673                 if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1674                         goto nla_put_failure;
1675         }
1676
1677         if (rdev->ops->disconnect || rdev->ops->deauth) {
1678                 i++;
1679                 if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1680                         goto nla_put_failure;
1681         }
1682
1683         return i;
1684  nla_put_failure:
1685         return -ENOBUFS;
1686 }
1687
1688 static int
1689 nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap,
1690                            struct sk_buff *msg)
1691 {
1692         struct nlattr *ftm;
1693
1694         if (!cap->ftm.supported)
1695                 return 0;
1696
1697         ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM);
1698         if (!ftm)
1699                 return -ENOBUFS;
1700
1701         if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP))
1702                 return -ENOBUFS;
1703         if (cap->ftm.non_asap &&
1704             nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP))
1705                 return -ENOBUFS;
1706         if (cap->ftm.request_lci &&
1707             nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI))
1708                 return -ENOBUFS;
1709         if (cap->ftm.request_civicloc &&
1710             nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC))
1711                 return -ENOBUFS;
1712         if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES,
1713                         cap->ftm.preambles))
1714                 return -ENOBUFS;
1715         if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS,
1716                         cap->ftm.bandwidths))
1717                 return -ENOBUFS;
1718         if (cap->ftm.max_bursts_exponent >= 0 &&
1719             nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT,
1720                         cap->ftm.max_bursts_exponent))
1721                 return -ENOBUFS;
1722         if (cap->ftm.max_ftms_per_burst &&
1723             nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST,
1724                         cap->ftm.max_ftms_per_burst))
1725                 return -ENOBUFS;
1726
1727         nla_nest_end(msg, ftm);
1728         return 0;
1729 }
1730
1731 static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev,
1732                                   struct sk_buff *msg)
1733 {
1734         const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa;
1735         struct nlattr *pmsr, *caps;
1736
1737         if (!cap)
1738                 return 0;
1739
1740         /*
1741          * we don't need to clean up anything here since the caller
1742          * will genlmsg_cancel() if we fail
1743          */
1744
1745         pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS);
1746         if (!pmsr)
1747                 return -ENOBUFS;
1748
1749         if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers))
1750                 return -ENOBUFS;
1751
1752         if (cap->report_ap_tsf &&
1753             nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF))
1754                 return -ENOBUFS;
1755
1756         if (cap->randomize_mac_addr &&
1757             nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR))
1758                 return -ENOBUFS;
1759
1760         caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA);
1761         if (!caps)
1762                 return -ENOBUFS;
1763
1764         if (nl80211_send_pmsr_ftm_capa(cap, msg))
1765                 return -ENOBUFS;
1766
1767         nla_nest_end(msg, caps);
1768         nla_nest_end(msg, pmsr);
1769
1770         return 0;
1771 }
1772
1773 struct nl80211_dump_wiphy_state {
1774         s64 filter_wiphy;
1775         long start;
1776         long split_start, band_start, chan_start, capa_start;
1777         bool split;
1778 };
1779
1780 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
1781                               enum nl80211_commands cmd,
1782                               struct sk_buff *msg, u32 portid, u32 seq,
1783                               int flags, struct nl80211_dump_wiphy_state *state)
1784 {
1785         void *hdr;
1786         struct nlattr *nl_bands, *nl_band;
1787         struct nlattr *nl_freqs, *nl_freq;
1788         struct nlattr *nl_cmds;
1789         enum nl80211_band band;
1790         struct ieee80211_channel *chan;
1791         int i;
1792         const struct ieee80211_txrx_stypes *mgmt_stypes =
1793                                 rdev->wiphy.mgmt_stypes;
1794         u32 features;
1795
1796         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
1797         if (!hdr)
1798                 return -ENOBUFS;
1799
1800         if (WARN_ON(!state))
1801                 return -EINVAL;
1802
1803         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1804             nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1805                            wiphy_name(&rdev->wiphy)) ||
1806             nla_put_u32(msg, NL80211_ATTR_GENERATION,
1807                         cfg80211_rdev_list_generation))
1808                 goto nla_put_failure;
1809
1810         if (cmd != NL80211_CMD_NEW_WIPHY)
1811                 goto finish;
1812
1813         switch (state->split_start) {
1814         case 0:
1815                 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1816                                rdev->wiphy.retry_short) ||
1817                     nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1818                                rdev->wiphy.retry_long) ||
1819                     nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1820                                 rdev->wiphy.frag_threshold) ||
1821                     nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1822                                 rdev->wiphy.rts_threshold) ||
1823                     nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1824                                rdev->wiphy.coverage_class) ||
1825                     nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1826                                rdev->wiphy.max_scan_ssids) ||
1827                     nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1828                                rdev->wiphy.max_sched_scan_ssids) ||
1829                     nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1830                                 rdev->wiphy.max_scan_ie_len) ||
1831                     nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
1832                                 rdev->wiphy.max_sched_scan_ie_len) ||
1833                     nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
1834                                rdev->wiphy.max_match_sets) ||
1835                     nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1836                                 rdev->wiphy.max_sched_scan_plans) ||
1837                     nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1838                                 rdev->wiphy.max_sched_scan_plan_interval) ||
1839                     nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1840                                 rdev->wiphy.max_sched_scan_plan_iterations))
1841                         goto nla_put_failure;
1842
1843                 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
1844                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1845                         goto nla_put_failure;
1846                 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
1847                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1848                         goto nla_put_failure;
1849                 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
1850                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1851                         goto nla_put_failure;
1852                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
1853                     nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1854                         goto nla_put_failure;
1855                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
1856                     nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1857                         goto nla_put_failure;
1858                 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
1859                     nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
1860                         goto nla_put_failure;
1861                 state->split_start++;
1862                 if (state->split)
1863                         break;
1864                 /* fall through */
1865         case 1:
1866                 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
1867                             sizeof(u32) * rdev->wiphy.n_cipher_suites,
1868                             rdev->wiphy.cipher_suites))
1869                         goto nla_put_failure;
1870
1871                 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
1872                                rdev->wiphy.max_num_pmkids))
1873                         goto nla_put_failure;
1874
1875                 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
1876                     nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1877                         goto nla_put_failure;
1878
1879                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
1880                                 rdev->wiphy.available_antennas_tx) ||
1881                     nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
1882                                 rdev->wiphy.available_antennas_rx))
1883                         goto nla_put_failure;
1884
1885                 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
1886                     nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
1887                                 rdev->wiphy.probe_resp_offload))
1888                         goto nla_put_failure;
1889
1890                 if ((rdev->wiphy.available_antennas_tx ||
1891                      rdev->wiphy.available_antennas_rx) &&
1892                     rdev->ops->get_antenna) {
1893                         u32 tx_ant = 0, rx_ant = 0;
1894                         int res;
1895
1896                         res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
1897                         if (!res) {
1898                                 if (nla_put_u32(msg,
1899                                                 NL80211_ATTR_WIPHY_ANTENNA_TX,
1900                                                 tx_ant) ||
1901                                     nla_put_u32(msg,
1902                                                 NL80211_ATTR_WIPHY_ANTENNA_RX,
1903                                                 rx_ant))
1904                                         goto nla_put_failure;
1905                         }
1906                 }
1907
1908                 state->split_start++;
1909                 if (state->split)
1910                         break;
1911                 /* fall through */
1912         case 2:
1913                 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
1914                                         rdev->wiphy.interface_modes))
1915                                 goto nla_put_failure;
1916                 state->split_start++;
1917                 if (state->split)
1918                         break;
1919                 /* fall through */
1920         case 3:
1921                 nl_bands = nla_nest_start_noflag(msg,
1922                                                  NL80211_ATTR_WIPHY_BANDS);
1923                 if (!nl_bands)
1924                         goto nla_put_failure;
1925
1926                 for (band = state->band_start;
1927                      band < NUM_NL80211_BANDS; band++) {
1928                         struct ieee80211_supported_band *sband;
1929
1930                         sband = rdev->wiphy.bands[band];
1931
1932                         if (!sband)
1933                                 continue;
1934
1935                         nl_band = nla_nest_start_noflag(msg, band);
1936                         if (!nl_band)
1937                                 goto nla_put_failure;
1938
1939                         switch (state->chan_start) {
1940                         case 0:
1941                                 if (nl80211_send_band_rateinfo(msg, sband))
1942                                         goto nla_put_failure;
1943                                 state->chan_start++;
1944                                 if (state->split)
1945                                         break;
1946                                 /* fall through */
1947                         default:
1948                                 /* add frequencies */
1949                                 nl_freqs = nla_nest_start_noflag(msg,
1950                                                                  NL80211_BAND_ATTR_FREQS);
1951                                 if (!nl_freqs)
1952                                         goto nla_put_failure;
1953
1954                                 for (i = state->chan_start - 1;
1955                                      i < sband->n_channels;
1956                                      i++) {
1957                                         nl_freq = nla_nest_start_noflag(msg,
1958                                                                         i);
1959                                         if (!nl_freq)
1960                                                 goto nla_put_failure;
1961
1962                                         chan = &sband->channels[i];
1963
1964                                         if (nl80211_msg_put_channel(
1965                                                         msg, &rdev->wiphy, chan,
1966                                                         state->split))
1967                                                 goto nla_put_failure;
1968
1969                                         nla_nest_end(msg, nl_freq);
1970                                         if (state->split)
1971                                                 break;
1972                                 }
1973                                 if (i < sband->n_channels)
1974                                         state->chan_start = i + 2;
1975                                 else
1976                                         state->chan_start = 0;
1977                                 nla_nest_end(msg, nl_freqs);
1978                         }
1979
1980                         nla_nest_end(msg, nl_band);
1981
1982                         if (state->split) {
1983                                 /* start again here */
1984                                 if (state->chan_start)
1985                                         band--;
1986                                 break;
1987                         }
1988                 }
1989                 nla_nest_end(msg, nl_bands);
1990
1991                 if (band < NUM_NL80211_BANDS)
1992                         state->band_start = band + 1;
1993                 else
1994                         state->band_start = 0;
1995
1996                 /* if bands & channels are done, continue outside */
1997                 if (state->band_start == 0 && state->chan_start == 0)
1998                         state->split_start++;
1999                 if (state->split)
2000                         break;
2001                 /* fall through */
2002         case 4:
2003                 nl_cmds = nla_nest_start_noflag(msg,
2004                                                 NL80211_ATTR_SUPPORTED_COMMANDS);
2005                 if (!nl_cmds)
2006                         goto nla_put_failure;
2007
2008                 i = nl80211_add_commands_unsplit(rdev, msg);
2009                 if (i < 0)
2010                         goto nla_put_failure;
2011                 if (state->split) {
2012                         CMD(crit_proto_start, CRIT_PROTOCOL_START);
2013                         CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
2014                         if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
2015                                 CMD(channel_switch, CHANNEL_SWITCH);
2016                         CMD(set_qos_map, SET_QOS_MAP);
2017                         if (rdev->wiphy.features &
2018                                         NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
2019                                 CMD(add_tx_ts, ADD_TX_TS);
2020                         CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
2021                         CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
2022                 }
2023 #undef CMD
2024
2025                 nla_nest_end(msg, nl_cmds);
2026                 state->split_start++;
2027                 if (state->split)
2028                         break;
2029                 /* fall through */
2030         case 5:
2031                 if (rdev->ops->remain_on_channel &&
2032                     (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
2033                     nla_put_u32(msg,
2034                                 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
2035                                 rdev->wiphy.max_remain_on_channel_duration))
2036                         goto nla_put_failure;
2037
2038                 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
2039                     nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
2040                         goto nla_put_failure;
2041
2042                 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
2043                         goto nla_put_failure;
2044                 state->split_start++;
2045                 if (state->split)
2046                         break;
2047                 /* fall through */
2048         case 6:
2049 #ifdef CONFIG_PM
2050                 if (nl80211_send_wowlan(msg, rdev, state->split))
2051                         goto nla_put_failure;
2052                 state->split_start++;
2053                 if (state->split)
2054                         break;
2055 #else
2056                 state->split_start++;
2057 #endif
2058                 /* fall through */
2059         case 7:
2060                 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
2061                                         rdev->wiphy.software_iftypes))
2062                         goto nla_put_failure;
2063
2064                 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
2065                                                    state->split))
2066                         goto nla_put_failure;
2067
2068                 state->split_start++;
2069                 if (state->split)
2070                         break;
2071                 /* fall through */
2072         case 8:
2073                 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
2074                     nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
2075                                 rdev->wiphy.ap_sme_capa))
2076                         goto nla_put_failure;
2077
2078                 features = rdev->wiphy.features;
2079                 /*
2080                  * We can only add the per-channel limit information if the
2081                  * dump is split, otherwise it makes it too big. Therefore
2082                  * only advertise it in that case.
2083                  */
2084                 if (state->split)
2085                         features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
2086                 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
2087                         goto nla_put_failure;
2088
2089                 if (rdev->wiphy.ht_capa_mod_mask &&
2090                     nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
2091                             sizeof(*rdev->wiphy.ht_capa_mod_mask),
2092                             rdev->wiphy.ht_capa_mod_mask))
2093                         goto nla_put_failure;
2094
2095                 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
2096                     rdev->wiphy.max_acl_mac_addrs &&
2097                     nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
2098                                 rdev->wiphy.max_acl_mac_addrs))
2099                         goto nla_put_failure;
2100
2101                 /*
2102                  * Any information below this point is only available to
2103                  * applications that can deal with it being split. This
2104                  * helps ensure that newly added capabilities don't break
2105                  * older tools by overrunning their buffers.
2106                  *
2107                  * We still increment split_start so that in the split
2108                  * case we'll continue with more data in the next round,
2109                  * but break unconditionally so unsplit data stops here.
2110                  */
2111                 state->split_start++;
2112                 break;
2113         case 9:
2114                 if (rdev->wiphy.extended_capabilities &&
2115                     (nla_put(msg, NL80211_ATTR_EXT_CAPA,
2116                              rdev->wiphy.extended_capabilities_len,
2117                              rdev->wiphy.extended_capabilities) ||
2118                      nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
2119                              rdev->wiphy.extended_capabilities_len,
2120                              rdev->wiphy.extended_capabilities_mask)))
2121                         goto nla_put_failure;
2122
2123                 if (rdev->wiphy.vht_capa_mod_mask &&
2124                     nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
2125                             sizeof(*rdev->wiphy.vht_capa_mod_mask),
2126                             rdev->wiphy.vht_capa_mod_mask))
2127                         goto nla_put_failure;
2128
2129                 state->split_start++;
2130                 break;
2131         case 10:
2132                 if (nl80211_send_coalesce(msg, rdev))
2133                         goto nla_put_failure;
2134
2135                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
2136                     (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
2137                      nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
2138                         goto nla_put_failure;
2139
2140                 if (rdev->wiphy.max_ap_assoc_sta &&
2141                     nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
2142                                 rdev->wiphy.max_ap_assoc_sta))
2143                         goto nla_put_failure;
2144
2145                 state->split_start++;
2146                 break;
2147         case 11:
2148                 if (rdev->wiphy.n_vendor_commands) {
2149                         const struct nl80211_vendor_cmd_info *info;
2150                         struct nlattr *nested;
2151
2152                         nested = nla_nest_start_noflag(msg,
2153                                                        NL80211_ATTR_VENDOR_DATA);
2154                         if (!nested)
2155                                 goto nla_put_failure;
2156
2157                         for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
2158                                 info = &rdev->wiphy.vendor_commands[i].info;
2159                                 if (nla_put(msg, i + 1, sizeof(*info), info))
2160                                         goto nla_put_failure;
2161                         }
2162                         nla_nest_end(msg, nested);
2163                 }
2164
2165                 if (rdev->wiphy.n_vendor_events) {
2166                         const struct nl80211_vendor_cmd_info *info;
2167                         struct nlattr *nested;
2168
2169                         nested = nla_nest_start_noflag(msg,
2170                                                        NL80211_ATTR_VENDOR_EVENTS);
2171                         if (!nested)
2172                                 goto nla_put_failure;
2173
2174                         for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
2175                                 info = &rdev->wiphy.vendor_events[i];
2176                                 if (nla_put(msg, i + 1, sizeof(*info), info))
2177                                         goto nla_put_failure;
2178                         }
2179                         nla_nest_end(msg, nested);
2180                 }
2181                 state->split_start++;
2182                 break;
2183         case 12:
2184                 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
2185                     nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
2186                                rdev->wiphy.max_num_csa_counters))
2187                         goto nla_put_failure;
2188
2189                 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
2190                     nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
2191                         goto nla_put_failure;
2192
2193                 if (rdev->wiphy.max_sched_scan_reqs &&
2194                     nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
2195                                 rdev->wiphy.max_sched_scan_reqs))
2196                         goto nla_put_failure;
2197
2198                 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
2199                             sizeof(rdev->wiphy.ext_features),
2200                             rdev->wiphy.ext_features))
2201                         goto nla_put_failure;
2202
2203                 if (rdev->wiphy.bss_select_support) {
2204                         struct nlattr *nested;
2205                         u32 bss_select_support = rdev->wiphy.bss_select_support;
2206
2207                         nested = nla_nest_start_noflag(msg,
2208                                                        NL80211_ATTR_BSS_SELECT);
2209                         if (!nested)
2210                                 goto nla_put_failure;
2211
2212                         i = 0;
2213                         while (bss_select_support) {
2214                                 if ((bss_select_support & 1) &&
2215                                     nla_put_flag(msg, i))
2216                                         goto nla_put_failure;
2217                                 i++;
2218                                 bss_select_support >>= 1;
2219                         }
2220                         nla_nest_end(msg, nested);
2221                 }
2222
2223                 state->split_start++;
2224                 break;
2225         case 13:
2226                 if (rdev->wiphy.num_iftype_ext_capab &&
2227                     rdev->wiphy.iftype_ext_capab) {
2228                         struct nlattr *nested_ext_capab, *nested;
2229
2230                         nested = nla_nest_start_noflag(msg,
2231                                                        NL80211_ATTR_IFTYPE_EXT_CAPA);
2232                         if (!nested)
2233                                 goto nla_put_failure;
2234
2235                         for (i = state->capa_start;
2236                              i < rdev->wiphy.num_iftype_ext_capab; i++) {
2237                                 const struct wiphy_iftype_ext_capab *capab;
2238
2239                                 capab = &rdev->wiphy.iftype_ext_capab[i];
2240
2241                                 nested_ext_capab = nla_nest_start_noflag(msg,
2242                                                                          i);
2243                                 if (!nested_ext_capab ||
2244                                     nla_put_u32(msg, NL80211_ATTR_IFTYPE,
2245                                                 capab->iftype) ||
2246                                     nla_put(msg, NL80211_ATTR_EXT_CAPA,
2247                                             capab->extended_capabilities_len,
2248                                             capab->extended_capabilities) ||
2249                                     nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
2250                                             capab->extended_capabilities_len,
2251                                             capab->extended_capabilities_mask))
2252                                         goto nla_put_failure;
2253
2254                                 nla_nest_end(msg, nested_ext_capab);
2255                                 if (state->split)
2256                                         break;
2257                         }
2258                         nla_nest_end(msg, nested);
2259                         if (i < rdev->wiphy.num_iftype_ext_capab) {
2260                                 state->capa_start = i + 1;
2261                                 break;
2262                         }
2263                 }
2264
2265                 if (nla_put_u32(msg, NL80211_ATTR_BANDS,
2266                                 rdev->wiphy.nan_supported_bands))
2267                         goto nla_put_failure;
2268
2269                 if (wiphy_ext_feature_isset(&rdev->wiphy,
2270                                             NL80211_EXT_FEATURE_TXQS)) {
2271                         struct cfg80211_txq_stats txqstats = {};
2272                         int res;
2273
2274                         res = rdev_get_txq_stats(rdev, NULL, &txqstats);
2275                         if (!res &&
2276                             !nl80211_put_txq_stats(msg, &txqstats,
2277                                                    NL80211_ATTR_TXQ_STATS))
2278                                 goto nla_put_failure;
2279
2280                         if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
2281                                         rdev->wiphy.txq_limit))
2282                                 goto nla_put_failure;
2283                         if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
2284                                         rdev->wiphy.txq_memory_limit))
2285                                 goto nla_put_failure;
2286                         if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
2287                                         rdev->wiphy.txq_quantum))
2288                                 goto nla_put_failure;
2289                 }
2290
2291                 state->split_start++;
2292                 break;
2293         case 14:
2294                 if (nl80211_send_pmsr_capa(rdev, msg))
2295                         goto nla_put_failure;
2296
2297                 state->split_start++;
2298                 break;
2299         case 15:
2300                 if (rdev->wiphy.akm_suites &&
2301                     nla_put(msg, NL80211_ATTR_AKM_SUITES,
2302                             sizeof(u32) * rdev->wiphy.n_akm_suites,
2303                             rdev->wiphy.akm_suites))
2304                         goto nla_put_failure;
2305
2306                 /* done */
2307                 state->split_start = 0;
2308                 break;
2309         }
2310  finish:
2311         genlmsg_end(msg, hdr);
2312         return 0;
2313
2314  nla_put_failure:
2315         genlmsg_cancel(msg, hdr);
2316         return -EMSGSIZE;
2317 }
2318
2319 static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
2320                                     struct netlink_callback *cb,
2321                                     struct nl80211_dump_wiphy_state *state)
2322 {
2323         struct nlattr **tb = genl_family_attrbuf(&nl80211_fam);
2324         int ret = nlmsg_parse_deprecated(cb->nlh,
2325                                          GENL_HDRLEN + nl80211_fam.hdrsize,
2326                                          tb, nl80211_fam.maxattr,
2327                                          nl80211_policy, NULL);
2328         /* ignore parse errors for backward compatibility */
2329         if (ret)
2330                 return 0;
2331
2332         state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
2333         if (tb[NL80211_ATTR_WIPHY])
2334                 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
2335         if (tb[NL80211_ATTR_WDEV])
2336                 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
2337         if (tb[NL80211_ATTR_IFINDEX]) {
2338                 struct net_device *netdev;
2339                 struct cfg80211_registered_device *rdev;
2340                 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
2341
2342                 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
2343                 if (!netdev)
2344                         return -ENODEV;
2345                 if (netdev->ieee80211_ptr) {
2346                         rdev = wiphy_to_rdev(
2347                                 netdev->ieee80211_ptr->wiphy);
2348                         state->filter_wiphy = rdev->wiphy_idx;
2349                 }
2350         }
2351
2352         return 0;
2353 }
2354
2355 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
2356 {
2357         int idx = 0, ret;
2358         struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
2359         struct cfg80211_registered_device *rdev;
2360
2361         rtnl_lock();
2362         if (!state) {
2363                 state = kzalloc(sizeof(*state), GFP_KERNEL);
2364                 if (!state) {
2365                         rtnl_unlock();
2366                         return -ENOMEM;
2367                 }
2368                 state->filter_wiphy = -1;
2369                 ret = nl80211_dump_wiphy_parse(skb, cb, state);
2370                 if (ret) {
2371                         kfree(state);
2372                         rtnl_unlock();
2373                         return ret;
2374                 }
2375                 cb->args[0] = (long)state;
2376         }
2377
2378         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2379                 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2380                         continue;
2381                 if (++idx <= state->start)
2382                         continue;
2383                 if (state->filter_wiphy != -1 &&
2384                     state->filter_wiphy != rdev->wiphy_idx)
2385                         continue;
2386                 /* attempt to fit multiple wiphy data chunks into the skb */
2387                 do {
2388                         ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
2389                                                  skb,
2390                                                  NETLINK_CB(cb->skb).portid,
2391                                                  cb->nlh->nlmsg_seq,
2392                                                  NLM_F_MULTI, state);
2393                         if (ret < 0) {
2394                                 /*
2395                                  * If sending the wiphy data didn't fit (ENOBUFS
2396                                  * or EMSGSIZE returned), this SKB is still
2397                                  * empty (so it's not too big because another
2398                                  * wiphy dataset is already in the skb) and
2399                                  * we've not tried to adjust the dump allocation
2400                                  * yet ... then adjust the alloc size to be
2401                                  * bigger, and return 1 but with the empty skb.
2402                                  * This results in an empty message being RX'ed
2403                                  * in userspace, but that is ignored.
2404                                  *
2405                                  * We can then retry with the larger buffer.
2406                                  */
2407                                 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
2408                                     !skb->len && !state->split &&
2409                                     cb->min_dump_alloc < 4096) {
2410                                         cb->min_dump_alloc = 4096;
2411                                         state->split_start = 0;
2412                                         rtnl_unlock();
2413                                         return 1;
2414                                 }
2415                                 idx--;
2416                                 break;
2417                         }
2418                 } while (state->split_start > 0);
2419                 break;
2420         }
2421         rtnl_unlock();
2422
2423         state->start = idx;
2424
2425         return skb->len;
2426 }
2427
2428 static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
2429 {
2430         kfree((void *)cb->args[0]);
2431         return 0;
2432 }
2433
2434 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
2435 {
2436         struct sk_buff *msg;
2437         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2438         struct nl80211_dump_wiphy_state state = {};
2439
2440         msg = nlmsg_new(4096, GFP_KERNEL);
2441         if (!msg)
2442                 return -ENOMEM;
2443
2444         if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2445                                info->snd_portid, info->snd_seq, 0,
2446                                &state) < 0) {
2447                 nlmsg_free(msg);
2448                 return -ENOBUFS;
2449         }
2450
2451         return genlmsg_reply(msg, info);
2452 }
2453
2454 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2455         [NL80211_TXQ_ATTR_QUEUE]                = { .type = NLA_U8 },
2456         [NL80211_TXQ_ATTR_TXOP]                 = { .type = NLA_U16 },
2457         [NL80211_TXQ_ATTR_CWMIN]                = { .type = NLA_U16 },
2458         [NL80211_TXQ_ATTR_CWMAX]                = { .type = NLA_U16 },
2459         [NL80211_TXQ_ATTR_AIFS]                 = { .type = NLA_U8 },
2460 };
2461
2462 static int parse_txq_params(struct nlattr *tb[],
2463                             struct ieee80211_txq_params *txq_params)
2464 {
2465         u8 ac;
2466
2467         if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
2468             !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2469             !tb[NL80211_TXQ_ATTR_AIFS])
2470                 return -EINVAL;
2471
2472         ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
2473         txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2474         txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2475         txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2476         txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2477
2478         if (ac >= NL80211_NUM_ACS)
2479                 return -EINVAL;
2480         txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
2481         return 0;
2482 }
2483
2484 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2485 {
2486         /*
2487          * You can only set the channel explicitly for WDS interfaces,
2488          * all others have their channel managed via their respective
2489          * "establish a connection" command (connect, join, ...)
2490          *
2491          * For AP/GO and mesh mode, the channel can be set with the
2492          * channel userspace API, but is only stored and passed to the
2493          * low-level driver when the AP starts or the mesh is joined.
2494          * This is for backward compatibility, userspace can also give
2495          * the channel in the start-ap or join-mesh commands instead.
2496          *
2497          * Monitors are special as they are normally slaved to
2498          * whatever else is going on, so they have their own special
2499          * operation to set the monitor channel if possible.
2500          */
2501         return !wdev ||
2502                 wdev->iftype == NL80211_IFTYPE_AP ||
2503                 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
2504                 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2505                 wdev->iftype == NL80211_IFTYPE_P2P_GO;
2506 }
2507
2508 int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2509                           struct genl_info *info,
2510                           struct cfg80211_chan_def *chandef)
2511 {
2512         struct netlink_ext_ack *extack = info->extack;
2513         struct nlattr **attrs = info->attrs;
2514         u32 control_freq;
2515
2516         if (!attrs[NL80211_ATTR_WIPHY_FREQ])
2517                 return -EINVAL;
2518
2519         control_freq = nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ]);
2520
2521         chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
2522         chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2523         chandef->center_freq1 = control_freq;
2524         chandef->center_freq2 = 0;
2525
2526         /* Primary channel not allowed */
2527         if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED) {
2528                 NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
2529                                     "Channel is disabled");
2530                 return -EINVAL;
2531         }
2532
2533         if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2534                 enum nl80211_channel_type chantype;
2535
2536                 chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2537
2538                 switch (chantype) {
2539                 case NL80211_CHAN_NO_HT:
2540                 case NL80211_CHAN_HT20:
2541                 case NL80211_CHAN_HT40PLUS:
2542                 case NL80211_CHAN_HT40MINUS:
2543                         cfg80211_chandef_create(chandef, chandef->chan,
2544                                                 chantype);
2545                         /* user input for center_freq is incorrect */
2546                         if (attrs[NL80211_ATTR_CENTER_FREQ1] &&
2547                             chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) {
2548                                 NL_SET_ERR_MSG_ATTR(extack,
2549                                                     attrs[NL80211_ATTR_CENTER_FREQ1],
2550                                                     "bad center frequency 1");
2551                                 return -EINVAL;
2552                         }
2553                         /* center_freq2 must be zero */
2554                         if (attrs[NL80211_ATTR_CENTER_FREQ2] &&
2555                             nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) {
2556                                 NL_SET_ERR_MSG_ATTR(extack,
2557                                                     attrs[NL80211_ATTR_CENTER_FREQ2],
2558                                                     "center frequency 2 can't be used");
2559                                 return -EINVAL;
2560                         }
2561                         break;
2562                 default:
2563                         NL_SET_ERR_MSG_ATTR(extack,
2564                                             attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
2565                                             "invalid channel type");
2566                         return -EINVAL;
2567                 }
2568         } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2569                 chandef->width =
2570                         nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2571                 if (attrs[NL80211_ATTR_CENTER_FREQ1])
2572                         chandef->center_freq1 =
2573                                 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]);
2574                 if (attrs[NL80211_ATTR_CENTER_FREQ2])
2575                         chandef->center_freq2 =
2576                                 nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]);
2577         }
2578
2579         if (!cfg80211_chandef_valid(chandef)) {
2580                 NL_SET_ERR_MSG(extack, "invalid channel definition");
2581                 return -EINVAL;
2582         }
2583
2584         if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2585                                      IEEE80211_CHAN_DISABLED)) {
2586                 NL_SET_ERR_MSG(extack, "(extension) channel is disabled");
2587                 return -EINVAL;
2588         }
2589
2590         if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2591              chandef->width == NL80211_CHAN_WIDTH_10) &&
2592             !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) {
2593                 NL_SET_ERR_MSG(extack, "5/10 MHz not supported");
2594                 return -EINVAL;
2595         }
2596
2597         return 0;
2598 }
2599
2600 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
2601                                  struct net_device *dev,
2602                                  struct genl_info *info)
2603 {
2604         struct cfg80211_chan_def chandef;
2605         int result;
2606         enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
2607         struct wireless_dev *wdev = NULL;
2608
2609         if (dev)
2610                 wdev = dev->ieee80211_ptr;
2611         if (!nl80211_can_set_dev_channel(wdev))
2612                 return -EOPNOTSUPP;
2613         if (wdev)
2614                 iftype = wdev->iftype;
2615
2616         result = nl80211_parse_chandef(rdev, info, &chandef);
2617         if (result)
2618                 return result;
2619
2620         switch (iftype) {
2621         case NL80211_IFTYPE_AP:
2622         case NL80211_IFTYPE_P2P_GO:
2623                 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2624                                                    iftype)) {
2625                         result = -EINVAL;
2626                         break;
2627                 }
2628                 if (wdev->beacon_interval) {
2629                         if (!dev || !rdev->ops->set_ap_chanwidth ||
2630                             !(rdev->wiphy.features &
2631                               NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2632                                 result = -EBUSY;
2633                                 break;
2634                         }
2635
2636                         /* Only allow dynamic channel width changes */
2637                         if (chandef.chan != wdev->preset_chandef.chan) {
2638                                 result = -EBUSY;
2639                                 break;
2640                         }
2641                         result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2642                         if (result)
2643                                 break;
2644                 }
2645                 wdev->preset_chandef = chandef;
2646                 result = 0;
2647                 break;
2648         case NL80211_IFTYPE_MESH_POINT:
2649                 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
2650                 break;
2651         case NL80211_IFTYPE_MONITOR:
2652                 result = cfg80211_set_monitor_channel(rdev, &chandef);
2653                 break;
2654         default:
2655                 result = -EINVAL;
2656         }
2657
2658         return result;
2659 }
2660
2661 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2662 {
2663         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2664         struct net_device *netdev = info->user_ptr[1];
2665
2666         return __nl80211_set_channel(rdev, netdev, info);
2667 }
2668
2669 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2670 {
2671         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2672         struct net_device *dev = info->user_ptr[1];
2673         struct wireless_dev *wdev = dev->ieee80211_ptr;
2674         const u8 *bssid;
2675
2676         if (!info->attrs[NL80211_ATTR_MAC])
2677                 return -EINVAL;
2678
2679         if (netif_running(dev))
2680                 return -EBUSY;
2681
2682         if (!rdev->ops->set_wds_peer)
2683                 return -EOPNOTSUPP;
2684
2685         if (wdev->iftype != NL80211_IFTYPE_WDS)
2686                 return -EOPNOTSUPP;
2687
2688         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
2689         return rdev_set_wds_peer(rdev, dev, bssid);
2690 }
2691
2692 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2693 {
2694         struct cfg80211_registered_device *rdev;
2695         struct net_device *netdev = NULL;
2696         struct wireless_dev *wdev;
2697         int result = 0, rem_txq_params = 0;
2698         struct nlattr *nl_txq_params;
2699         u32 changed;
2700         u8 retry_short = 0, retry_long = 0;
2701         u32 frag_threshold = 0, rts_threshold = 0;
2702         u8 coverage_class = 0;
2703         u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
2704
2705         ASSERT_RTNL();
2706
2707         /*
2708          * Try to find the wiphy and netdev. Normally this
2709          * function shouldn't need the netdev, but this is
2710          * done for backward compatibility -- previously
2711          * setting the channel was done per wiphy, but now
2712          * it is per netdev. Previous userland like hostapd
2713          * also passed a netdev to set_wiphy, so that it is
2714          * possible to let that go to the right netdev!
2715          */
2716
2717         if (info->attrs[NL80211_ATTR_IFINDEX]) {
2718                 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2719
2720                 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
2721                 if (netdev && netdev->ieee80211_ptr)
2722                         rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
2723                 else
2724                         netdev = NULL;
2725         }
2726
2727         if (!netdev) {
2728                 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2729                                                   info->attrs);
2730                 if (IS_ERR(rdev))
2731                         return PTR_ERR(rdev);
2732                 wdev = NULL;
2733                 netdev = NULL;
2734                 result = 0;
2735         } else
2736                 wdev = netdev->ieee80211_ptr;
2737
2738         /*
2739          * end workaround code, by now the rdev is available
2740          * and locked, and wdev may or may not be NULL.
2741          */
2742
2743         if (info->attrs[NL80211_ATTR_WIPHY_NAME])
2744                 result = cfg80211_dev_rename(
2745                         rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
2746
2747         if (result)
2748                 return result;
2749
2750         if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2751                 struct ieee80211_txq_params txq_params;
2752                 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2753
2754                 if (!rdev->ops->set_txq_params)
2755                         return -EOPNOTSUPP;
2756
2757                 if (!netdev)
2758                         return -EINVAL;
2759
2760                 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2761                     netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2762                         return -EINVAL;
2763
2764                 if (!netif_running(netdev))
2765                         return -ENETDOWN;
2766
2767                 nla_for_each_nested(nl_txq_params,
2768                                     info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2769                                     rem_txq_params) {
2770                         result = nla_parse_nested_deprecated(tb,
2771                                                              NL80211_TXQ_ATTR_MAX,
2772                                                              nl_txq_params,
2773                                                              txq_params_policy,
2774                                                              info->extack);
2775                         if (result)
2776                                 return result;
2777                         result = parse_txq_params(tb, &txq_params);
2778                         if (result)
2779                                 return result;
2780
2781                         result = rdev_set_txq_params(rdev, netdev,
2782                                                      &txq_params);
2783                         if (result)
2784                                 return result;
2785                 }
2786         }
2787
2788         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
2789                 result = __nl80211_set_channel(
2790                         rdev,
2791                         nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2792                         info);
2793                 if (result)
2794                         return result;
2795         }
2796
2797         if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
2798                 struct wireless_dev *txp_wdev = wdev;
2799                 enum nl80211_tx_power_setting type;
2800                 int idx, mbm = 0;
2801
2802                 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2803                         txp_wdev = NULL;
2804
2805                 if (!rdev->ops->set_tx_power)
2806                         return -EOPNOTSUPP;
2807
2808                 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2809                 type = nla_get_u32(info->attrs[idx]);
2810
2811                 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
2812                     (type != NL80211_TX_POWER_AUTOMATIC))
2813                         return -EINVAL;
2814
2815                 if (type != NL80211_TX_POWER_AUTOMATIC) {
2816                         idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2817                         mbm = nla_get_u32(info->attrs[idx]);
2818                 }
2819
2820                 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
2821                 if (result)
2822                         return result;
2823         }
2824
2825         if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2826             info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2827                 u32 tx_ant, rx_ant;
2828
2829                 if ((!rdev->wiphy.available_antennas_tx &&
2830                      !rdev->wiphy.available_antennas_rx) ||
2831                     !rdev->ops->set_antenna)
2832                         return -EOPNOTSUPP;
2833
2834                 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
2835                 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
2836
2837                 /* reject antenna configurations which don't match the
2838                  * available antenna masks, except for the "all" mask */
2839                 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
2840                     (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
2841                         return -EINVAL;
2842
2843                 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
2844                 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
2845
2846                 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
2847                 if (result)
2848                         return result;
2849         }
2850
2851         changed = 0;
2852
2853         if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
2854                 retry_short = nla_get_u8(
2855                         info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
2856
2857                 changed |= WIPHY_PARAM_RETRY_SHORT;
2858         }
2859
2860         if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
2861                 retry_long = nla_get_u8(
2862                         info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
2863
2864                 changed |= WIPHY_PARAM_RETRY_LONG;
2865         }
2866
2867         if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
2868                 frag_threshold = nla_get_u32(
2869                         info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
2870                 if (frag_threshold < 256)
2871                         return -EINVAL;
2872
2873                 if (frag_threshold != (u32) -1) {
2874                         /*
2875                          * Fragments (apart from the last one) are required to
2876                          * have even length. Make the fragmentation code
2877                          * simpler by stripping LSB should someone try to use
2878                          * odd threshold value.
2879                          */
2880                         frag_threshold &= ~0x1;
2881                 }
2882                 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
2883         }
2884
2885         if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
2886                 rts_threshold = nla_get_u32(
2887                         info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
2888                 changed |= WIPHY_PARAM_RTS_THRESHOLD;
2889         }
2890
2891         if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
2892                 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
2893                         return -EINVAL;
2894
2895                 coverage_class = nla_get_u8(
2896                         info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
2897                 changed |= WIPHY_PARAM_COVERAGE_CLASS;
2898         }
2899
2900         if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
2901                 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
2902                         return -EOPNOTSUPP;
2903
2904                 changed |= WIPHY_PARAM_DYN_ACK;
2905         }
2906
2907         if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
2908                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
2909                                              NL80211_EXT_FEATURE_TXQS))
2910                         return -EOPNOTSUPP;
2911                 txq_limit = nla_get_u32(
2912                         info->attrs[NL80211_ATTR_TXQ_LIMIT]);
2913                 changed |= WIPHY_PARAM_TXQ_LIMIT;
2914         }
2915
2916         if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
2917                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
2918                                              NL80211_EXT_FEATURE_TXQS))
2919                         return -EOPNOTSUPP;
2920                 txq_memory_limit = nla_get_u32(
2921                         info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
2922                 changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
2923         }
2924
2925         if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
2926                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
2927                                              NL80211_EXT_FEATURE_TXQS))
2928                         return -EOPNOTSUPP;
2929                 txq_quantum = nla_get_u32(
2930                         info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
2931                 changed |= WIPHY_PARAM_TXQ_QUANTUM;
2932         }
2933
2934         if (changed) {
2935                 u8 old_retry_short, old_retry_long;
2936                 u32 old_frag_threshold, old_rts_threshold;
2937                 u8 old_coverage_class;
2938                 u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
2939
2940                 if (!rdev->ops->set_wiphy_params)
2941                         return -EOPNOTSUPP;
2942
2943                 old_retry_short = rdev->wiphy.retry_short;
2944                 old_retry_long = rdev->wiphy.retry_long;
2945                 old_frag_threshold = rdev->wiphy.frag_threshold;
2946                 old_rts_threshold = rdev->wiphy.rts_threshold;
2947                 old_coverage_class = rdev->wiphy.coverage_class;
2948                 old_txq_limit = rdev->wiphy.txq_limit;
2949                 old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
2950                 old_txq_quantum = rdev->wiphy.txq_quantum;
2951
2952                 if (changed & WIPHY_PARAM_RETRY_SHORT)
2953                         rdev->wiphy.retry_short = retry_short;
2954                 if (changed & WIPHY_PARAM_RETRY_LONG)
2955                         rdev->wiphy.retry_long = retry_long;
2956                 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
2957                         rdev->wiphy.frag_threshold = frag_threshold;
2958                 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
2959                         rdev->wiphy.rts_threshold = rts_threshold;
2960                 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
2961                         rdev->wiphy.coverage_class = coverage_class;
2962                 if (changed & WIPHY_PARAM_TXQ_LIMIT)
2963                         rdev->wiphy.txq_limit = txq_limit;
2964                 if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
2965                         rdev->wiphy.txq_memory_limit = txq_memory_limit;
2966                 if (changed & WIPHY_PARAM_TXQ_QUANTUM)
2967                         rdev->wiphy.txq_quantum = txq_quantum;
2968
2969                 result = rdev_set_wiphy_params(rdev, changed);
2970                 if (result) {
2971                         rdev->wiphy.retry_short = old_retry_short;
2972                         rdev->wiphy.retry_long = old_retry_long;
2973                         rdev->wiphy.frag_threshold = old_frag_threshold;
2974                         rdev->wiphy.rts_threshold = old_rts_threshold;
2975                         rdev->wiphy.coverage_class = old_coverage_class;
2976                         rdev->wiphy.txq_limit = old_txq_limit;
2977                         rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
2978                         rdev->wiphy.txq_quantum = old_txq_quantum;
2979                         return result;
2980                 }
2981         }
2982         return 0;
2983 }
2984
2985 static int nl80211_send_chandef(struct sk_buff *msg,
2986                                 const struct cfg80211_chan_def *chandef)
2987 {
2988         if (WARN_ON(!cfg80211_chandef_valid(chandef)))
2989                 return -EINVAL;
2990
2991         if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
2992                         chandef->chan->center_freq))
2993                 return -ENOBUFS;
2994         switch (chandef->width) {
2995         case NL80211_CHAN_WIDTH_20_NOHT:
2996         case NL80211_CHAN_WIDTH_20:
2997         case NL80211_CHAN_WIDTH_40:
2998                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
2999                                 cfg80211_get_chandef_type(chandef)))
3000                         return -ENOBUFS;
3001                 break;
3002         default:
3003                 break;
3004         }
3005         if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
3006                 return -ENOBUFS;
3007         if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
3008                 return -ENOBUFS;
3009         if (chandef->center_freq2 &&
3010             nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
3011                 return -ENOBUFS;
3012         return 0;
3013 }
3014
3015 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
3016                               struct cfg80211_registered_device *rdev,
3017                               struct wireless_dev *wdev,
3018                               enum nl80211_commands cmd)
3019 {
3020         struct net_device *dev = wdev->netdev;
3021         void *hdr;
3022
3023         WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
3024                 cmd != NL80211_CMD_DEL_INTERFACE &&
3025                 cmd != NL80211_CMD_SET_INTERFACE);
3026
3027         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
3028         if (!hdr)
3029                 return -1;
3030
3031         if (dev &&
3032             (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3033              nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
3034                 goto nla_put_failure;
3035
3036         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
3037             nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
3038             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
3039                               NL80211_ATTR_PAD) ||
3040             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
3041             nla_put_u32(msg, NL80211_ATTR_GENERATION,
3042                         rdev->devlist_generation ^
3043                         (cfg80211_rdev_list_generation << 2)) ||
3044             nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr))
3045                 goto nla_put_failure;
3046
3047         if (rdev->ops->get_channel) {
3048                 int ret;
3049                 struct cfg80211_chan_def chandef;
3050
3051                 ret = rdev_get_channel(rdev, wdev, &chandef);
3052                 if (ret == 0) {
3053                         if (nl80211_send_chandef(msg, &chandef))
3054                                 goto nla_put_failure;
3055                 }
3056         }
3057
3058         if (rdev->ops->get_tx_power) {
3059                 int dbm, ret;
3060
3061                 ret = rdev_get_tx_power(rdev, wdev, &dbm);
3062                 if (ret == 0 &&
3063                     nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
3064                                 DBM_TO_MBM(dbm)))
3065                         goto nla_put_failure;
3066         }
3067
3068         wdev_lock(wdev);
3069         switch (wdev->iftype) {
3070         case NL80211_IFTYPE_AP:
3071                 if (wdev->ssid_len &&
3072                     nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
3073                         goto nla_put_failure_locked;
3074                 break;
3075         case NL80211_IFTYPE_STATION:
3076         case NL80211_IFTYPE_P2P_CLIENT:
3077         case NL80211_IFTYPE_ADHOC: {
3078                 const u8 *ssid_ie;
3079                 if (!wdev->current_bss)
3080                         break;
3081                 rcu_read_lock();
3082                 ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub,
3083                                                WLAN_EID_SSID);
3084                 if (ssid_ie &&
3085                     nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2))
3086                         goto nla_put_failure_rcu_locked;
3087                 rcu_read_unlock();
3088                 break;
3089                 }
3090         default:
3091                 /* nothing */
3092                 break;
3093         }
3094         wdev_unlock(wdev);
3095
3096         if (rdev->ops->get_txq_stats) {
3097                 struct cfg80211_txq_stats txqstats = {};
3098                 int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);
3099
3100                 if (ret == 0 &&
3101                     !nl80211_put_txq_stats(msg, &txqstats,
3102                                            NL80211_ATTR_TXQ_STATS))
3103                         goto nla_put_failure;
3104         }
3105
3106         genlmsg_end(msg, hdr);
3107         return 0;
3108
3109  nla_put_failure_rcu_locked:
3110         rcu_read_unlock();
3111  nla_put_failure_locked:
3112         wdev_unlock(wdev);
3113  nla_put_failure:
3114         genlmsg_cancel(msg, hdr);
3115         return -EMSGSIZE;
3116 }
3117
3118 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
3119 {
3120         int wp_idx = 0;
3121         int if_idx = 0;
3122         int wp_start = cb->args[0];
3123         int if_start = cb->args[1];
3124         int filter_wiphy = -1;
3125         struct cfg80211_registered_device *rdev;
3126         struct wireless_dev *wdev;
3127         int ret;
3128
3129         rtnl_lock();
3130         if (!cb->args[2]) {
3131                 struct nl80211_dump_wiphy_state state = {
3132                         .filter_wiphy = -1,
3133                 };
3134
3135                 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
3136                 if (ret)
3137                         goto out_unlock;
3138
3139                 filter_wiphy = state.filter_wiphy;
3140
3141                 /*
3142                  * if filtering, set cb->args[2] to +1 since 0 is the default
3143                  * value needed to determine that parsing is necessary.
3144                  */
3145                 if (filter_wiphy >= 0)
3146                         cb->args[2] = filter_wiphy + 1;
3147                 else
3148                         cb->args[2] = -1;
3149         } else if (cb->args[2] > 0) {
3150                 filter_wiphy = cb->args[2] - 1;
3151         }
3152
3153         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
3154                 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
3155                         continue;
3156                 if (wp_idx < wp_start) {
3157                         wp_idx++;
3158                         continue;
3159                 }
3160
3161                 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
3162                         continue;
3163
3164                 if_idx = 0;
3165
3166                 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
3167                         if (if_idx < if_start) {
3168                                 if_idx++;
3169                                 continue;
3170                         }
3171                         if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
3172                                                cb->nlh->nlmsg_seq, NLM_F_MULTI,
3173                                                rdev, wdev,
3174                                                NL80211_CMD_NEW_INTERFACE) < 0) {
3175                                 goto out;
3176                         }
3177                         if_idx++;
3178                 }
3179
3180                 wp_idx++;
3181         }
3182  out:
3183         cb->args[0] = wp_idx;
3184         cb->args[1] = if_idx;
3185
3186         ret = skb->len;
3187  out_unlock:
3188         rtnl_unlock();
3189
3190         return ret;
3191 }
3192
3193 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
3194 {
3195         struct sk_buff *msg;
3196         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3197         struct wireless_dev *wdev = info->user_ptr[1];
3198
3199         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3200         if (!msg)
3201                 return -ENOMEM;
3202
3203         if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3204                                rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
3205                 nlmsg_free(msg);
3206                 return -ENOBUFS;
3207         }
3208
3209         return genlmsg_reply(msg, info);
3210 }
3211
3212 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
3213         [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
3214         [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
3215         [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
3216         [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
3217         [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
3218         [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
3219 };
3220
3221 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
3222 {
3223         struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
3224         int flag;
3225
3226         *mntrflags = 0;
3227
3228         if (!nla)
3229                 return -EINVAL;
3230
3231         if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL))
3232                 return -EINVAL;
3233
3234         for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
3235                 if (flags[flag])
3236                         *mntrflags |= (1<<flag);
3237
3238         *mntrflags |= MONITOR_FLAG_CHANGED;
3239
3240         return 0;
3241 }
3242
3243 static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
3244                                      enum nl80211_iftype type,
3245                                      struct genl_info *info,
3246                                      struct vif_params *params)
3247 {
3248         bool change = false;
3249         int err;
3250
3251         if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
3252                 if (type != NL80211_IFTYPE_MONITOR)
3253                         return -EINVAL;
3254
3255                 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
3256                                           &params->flags);
3257                 if (err)
3258                         return err;
3259
3260                 change = true;
3261         }
3262
3263         if (params->flags & MONITOR_FLAG_ACTIVE &&
3264             !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
3265                 return -EOPNOTSUPP;
3266
3267         if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
3268                 const u8 *mumimo_groups;
3269                 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
3270
3271                 if (type != NL80211_IFTYPE_MONITOR)
3272                         return -EINVAL;
3273
3274                 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
3275                         return -EOPNOTSUPP;
3276
3277                 mumimo_groups =
3278                         nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
3279
3280                 /* bits 0 and 63 are reserved and must be zero */
3281                 if ((mumimo_groups[0] & BIT(0)) ||
3282                     (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
3283                         return -EINVAL;
3284
3285                 params->vht_mumimo_groups = mumimo_groups;
3286                 change = true;
3287         }
3288
3289         if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
3290                 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
3291
3292                 if (type != NL80211_IFTYPE_MONITOR)
3293                         return -EINVAL;
3294
3295                 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
3296                         return -EOPNOTSUPP;
3297
3298                 params->vht_mumimo_follow_addr =
3299                         nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
3300                 change = true;
3301         }
3302
3303         return change ? 1 : 0;
3304 }
3305
3306 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
3307                                struct net_device *netdev, u8 use_4addr,
3308                                enum nl80211_iftype iftype)
3309 {
3310         if (!use_4addr) {
3311                 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
3312                         return -EBUSY;
3313                 return 0;
3314         }
3315
3316         switch (iftype) {
3317         case NL80211_IFTYPE_AP_VLAN:
3318                 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
3319                         return 0;
3320                 break;
3321         case NL80211_IFTYPE_STATION:
3322                 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
3323                         return 0;
3324                 break;
3325         default:
3326                 break;
3327         }
3328
3329         return -EOPNOTSUPP;
3330 }
3331
3332 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
3333 {
3334         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3335         struct vif_params params;
3336         int err;
3337         enum nl80211_iftype otype, ntype;
3338         struct net_device *dev = info->user_ptr[1];
3339         bool change = false;
3340
3341         memset(&params, 0, sizeof(params));
3342
3343         otype = ntype = dev->ieee80211_ptr->iftype;
3344
3345         if (info->attrs[NL80211_ATTR_IFTYPE]) {
3346                 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
3347                 if (otype != ntype)
3348                         change = true;
3349         }
3350
3351         if (info->attrs[NL80211_ATTR_MESH_ID]) {
3352                 struct wireless_dev *wdev = dev->ieee80211_ptr;
3353
3354                 if (ntype != NL80211_IFTYPE_MESH_POINT)
3355                         return -EINVAL;
3356                 if (netif_running(dev))
3357                         return -EBUSY;
3358
3359                 wdev_lock(wdev);
3360                 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3361                              IEEE80211_MAX_MESH_ID_LEN);
3362                 wdev->mesh_id_up_len =
3363                         nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3364                 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3365                        wdev->mesh_id_up_len);
3366                 wdev_unlock(wdev);
3367         }
3368
3369         if (info->attrs[NL80211_ATTR_4ADDR]) {
3370                 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3371                 change = true;
3372                 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
3373                 if (err)
3374                         return err;
3375         } else {
3376                 params.use_4addr = -1;
3377         }
3378
3379         err = nl80211_parse_mon_options(rdev, ntype, info, &params);
3380         if (err < 0)
3381                 return err;
3382         if (err > 0)
3383                 change = true;
3384
3385         if (change)
3386                 err = cfg80211_change_iface(rdev, dev, ntype, &params);
3387         else
3388                 err = 0;
3389
3390         if (!err && params.use_4addr != -1)
3391                 dev->ieee80211_ptr->use_4addr = params.use_4addr;
3392
3393         if (change && !err) {
3394                 struct wireless_dev *wdev = dev->ieee80211_ptr;
3395
3396                 nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE);
3397         }
3398
3399         return err;
3400 }
3401
3402 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
3403 {
3404         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3405         struct vif_params params;
3406         struct wireless_dev *wdev;
3407         struct sk_buff *msg;
3408         int err;
3409         enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
3410
3411         /* to avoid failing a new interface creation due to pending removal */
3412         cfg80211_destroy_ifaces(rdev);
3413
3414         memset(&params, 0, sizeof(params));
3415
3416         if (!info->attrs[NL80211_ATTR_IFNAME])
3417                 return -EINVAL;
3418
3419         if (info->attrs[NL80211_ATTR_IFTYPE])
3420                 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
3421
3422         if (!rdev->ops->add_virtual_intf ||
3423             !(rdev->wiphy.interface_modes & (1 << type)))
3424                 return -EOPNOTSUPP;
3425
3426         if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
3427              rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
3428             info->attrs[NL80211_ATTR_MAC]) {
3429                 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
3430                            ETH_ALEN);
3431                 if (!is_valid_ether_addr(params.macaddr))
3432                         return -EADDRNOTAVAIL;
3433         }
3434
3435         if (info->attrs[NL80211_ATTR_4ADDR]) {
3436                 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
3437                 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
3438                 if (err)
3439                         return err;
3440         }
3441
3442         err = nl80211_parse_mon_options(rdev, type, info, &params);
3443         if (err < 0)
3444                 return err;
3445
3446         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3447         if (!msg)
3448                 return -ENOMEM;
3449
3450         wdev = rdev_add_virtual_intf(rdev,
3451                                 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
3452                                 NET_NAME_USER, type, &params);
3453         if (WARN_ON(!wdev)) {
3454                 nlmsg_free(msg);
3455                 return -EPROTO;
3456         } else if (IS_ERR(wdev)) {
3457                 nlmsg_free(msg);
3458                 return PTR_ERR(wdev);
3459         }
3460
3461         if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
3462                 wdev->owner_nlportid = info->snd_portid;
3463
3464         switch (type) {
3465         case NL80211_IFTYPE_MESH_POINT:
3466                 if (!info->attrs[NL80211_ATTR_MESH_ID])
3467                         break;
3468                 wdev_lock(wdev);
3469                 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
3470                              IEEE80211_MAX_MESH_ID_LEN);
3471                 wdev->mesh_id_up_len =
3472                         nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
3473                 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
3474                        wdev->mesh_id_up_len);
3475                 wdev_unlock(wdev);
3476                 break;
3477         case NL80211_IFTYPE_NAN:
3478         case NL80211_IFTYPE_P2P_DEVICE:
3479                 /*
3480                  * P2P Device and NAN do not have a netdev, so don't go
3481                  * through the netdev notifier and must be added here
3482                  */
3483                 cfg80211_init_wdev(rdev, wdev);
3484                 break;
3485         default:
3486                 break;
3487         }
3488
3489         if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
3490                                rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
3491                 nlmsg_free(msg);
3492                 return -ENOBUFS;
3493         }
3494
3495         return genlmsg_reply(msg, info);
3496 }
3497
3498 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
3499 {
3500         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3501         struct wireless_dev *wdev = info->user_ptr[1];
3502
3503         if (!rdev->ops->del_virtual_intf)
3504                 return -EOPNOTSUPP;
3505
3506         /*
3507          * If we remove a wireless device without a netdev then clear
3508          * user_ptr[1] so that nl80211_post_doit won't dereference it
3509          * to check if it needs to do dev_put(). Otherwise it crashes
3510          * since the wdev has been freed, unlike with a netdev where
3511          * we need the dev_put() for the netdev to really be freed.
3512          */
3513         if (!wdev->netdev)
3514                 info->user_ptr[1] = NULL;
3515
3516         return rdev_del_virtual_intf(rdev, wdev);
3517 }
3518
3519 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
3520 {
3521         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3522         struct net_device *dev = info->user_ptr[1];
3523         u16 noack_map;
3524
3525         if (!info->attrs[NL80211_ATTR_NOACK_MAP])
3526                 return -EINVAL;
3527
3528         if (!rdev->ops->set_noack_map)
3529                 return -EOPNOTSUPP;
3530
3531         noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
3532
3533         return rdev_set_noack_map(rdev, dev, noack_map);
3534 }
3535
3536 struct get_key_cookie {
3537         struct sk_buff *msg;
3538         int error;
3539         int idx;
3540 };
3541
3542 static void get_key_callback(void *c, struct key_params *params)
3543 {
3544         struct nlattr *key;
3545         struct get_key_cookie *cookie = c;
3546
3547         if ((params->key &&
3548              nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3549                      params->key_len, params->key)) ||
3550             (params->seq &&
3551              nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3552                      params->seq_len, params->seq)) ||
3553             (params->cipher &&
3554              nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3555                          params->cipher)))
3556                 goto nla_put_failure;
3557
3558         key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY);
3559         if (!key)
3560                 goto nla_put_failure;
3561
3562         if ((params->key &&
3563              nla_put(cookie->msg, NL80211_KEY_DATA,
3564                      params->key_len, params->key)) ||
3565             (params->seq &&
3566              nla_put(cookie->msg, NL80211_KEY_SEQ,
3567                      params->seq_len, params->seq)) ||
3568             (params->cipher &&
3569              nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3570                          params->cipher)))
3571                 goto nla_put_failure;
3572
3573         if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx))
3574                 goto nla_put_failure;
3575
3576         nla_nest_end(cookie->msg, key);
3577
3578         return;
3579  nla_put_failure:
3580         cookie->error = 1;
3581 }
3582
3583 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3584 {
3585         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3586         int err;
3587         struct net_device *dev = info->user_ptr[1];
3588         u8 key_idx = 0;
3589         const u8 *mac_addr = NULL;
3590         bool pairwise;
3591         struct get_key_cookie cookie = {
3592                 .error = 0,
3593         };
3594         void *hdr;
3595         struct sk_buff *msg;
3596
3597         if (info->attrs[NL80211_ATTR_KEY_IDX])
3598                 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3599
3600         if (info->attrs[NL80211_ATTR_MAC])
3601                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3602
3603         pairwise = !!mac_addr;
3604         if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3605                 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
3606
3607                 if (kt != NL80211_KEYTYPE_GROUP &&
3608                     kt != NL80211_KEYTYPE_PAIRWISE)
3609                         return -EINVAL;
3610                 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3611         }
3612
3613         if (!rdev->ops->get_key)
3614                 return -EOPNOTSUPP;
3615
3616         if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3617                 return -ENOENT;
3618
3619         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3620         if (!msg)
3621                 return -ENOMEM;
3622
3623         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3624                              NL80211_CMD_NEW_KEY);
3625         if (!hdr)
3626                 goto nla_put_failure;
3627
3628         cookie.msg = msg;
3629         cookie.idx = key_idx;
3630
3631         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3632             nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3633                 goto nla_put_failure;
3634         if (mac_addr &&
3635             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3636                 goto nla_put_failure;
3637
3638         err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3639                            get_key_callback);
3640
3641         if (err)
3642                 goto free_msg;
3643
3644         if (cookie.error)
3645                 goto nla_put_failure;
3646
3647         genlmsg_end(msg, hdr);
3648         return genlmsg_reply(msg, info);
3649
3650  nla_put_failure:
3651         err = -ENOBUFS;
3652  free_msg:
3653         nlmsg_free(msg);
3654         return err;
3655 }
3656
3657 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3658 {
3659         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3660         struct key_parse key;
3661         int err;
3662         struct net_device *dev = info->user_ptr[1];
3663
3664         err = nl80211_parse_key(info, &key);
3665         if (err)
3666                 return err;
3667
3668         if (key.idx < 0)
3669                 return -EINVAL;
3670
3671         /* Only support setting default key and
3672          * Extended Key ID action NL80211_KEY_SET_TX.
3673          */
3674         if (!key.def && !key.defmgmt &&
3675             !(key.p.mode == NL80211_KEY_SET_TX))
3676                 return -EINVAL;
3677
3678         wdev_lock(dev->ieee80211_ptr);
3679
3680         if (key.def) {
3681                 if (!rdev->ops->set_default_key) {
3682                         err = -EOPNOTSUPP;
3683                         goto out;
3684                 }
3685
3686                 err = nl80211_key_allowed(dev->ieee80211_ptr);
3687                 if (err)
3688                         goto out;
3689
3690                 err = rdev_set_default_key(rdev, dev, key.idx,
3691                                                  key.def_uni, key.def_multi);
3692
3693                 if (err)
3694                         goto out;
3695
3696 #ifdef CONFIG_CFG80211_WEXT
3697                 dev->ieee80211_ptr->wext.default_key = key.idx;
3698 #endif
3699         } else if (key.defmgmt) {
3700                 if (key.def_uni || !key.def_multi) {
3701                         err = -EINVAL;
3702                         goto out;
3703                 }
3704
3705                 if (!rdev->ops->set_default_mgmt_key) {
3706                         err = -EOPNOTSUPP;
3707                         goto out;
3708                 }
3709
3710                 err = nl80211_key_allowed(dev->ieee80211_ptr);
3711                 if (err)
3712                         goto out;
3713
3714                 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
3715                 if (err)
3716                         goto out;
3717
3718 #ifdef CONFIG_CFG80211_WEXT
3719                 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3720 #endif
3721         } else if (key.p.mode == NL80211_KEY_SET_TX &&
3722                    wiphy_ext_feature_isset(&rdev->wiphy,
3723                                            NL80211_EXT_FEATURE_EXT_KEY_ID)) {
3724                 u8 *mac_addr = NULL;
3725
3726                 if (info->attrs[NL80211_ATTR_MAC])
3727                         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3728
3729                 if (!mac_addr || key.idx < 0 || key.idx > 1) {
3730                         err = -EINVAL;
3731                         goto out;
3732                 }
3733
3734                 err = rdev_add_key(rdev, dev, key.idx,
3735                                    NL80211_KEYTYPE_PAIRWISE,
3736                                    mac_addr, &key.p);
3737         } else {
3738                 err = -EINVAL;
3739         }
3740  out:
3741         wdev_unlock(dev->ieee80211_ptr);
3742
3743         return err;
3744 }
3745
3746 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3747 {
3748         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3749         int err;
3750         struct net_device *dev = info->user_ptr[1];
3751         struct key_parse key;
3752         const u8 *mac_addr = NULL;
3753
3754         err = nl80211_parse_key(info, &key);
3755         if (err)
3756                 return err;
3757
3758         if (!key.p.key)
3759                 return -EINVAL;
3760
3761         if (info->attrs[NL80211_ATTR_MAC])
3762                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3763
3764         if (key.type == -1) {
3765                 if (mac_addr)
3766                         key.type = NL80211_KEYTYPE_PAIRWISE;
3767                 else
3768                         key.type = NL80211_KEYTYPE_GROUP;
3769         }
3770
3771         /* for now */
3772         if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3773             key.type != NL80211_KEYTYPE_GROUP)
3774                 return -EINVAL;
3775
3776         if (!rdev->ops->add_key)
3777                 return -EOPNOTSUPP;
3778
3779         if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3780                                            key.type == NL80211_KEYTYPE_PAIRWISE,
3781                                            mac_addr))
3782                 return -EINVAL;
3783
3784         wdev_lock(dev->ieee80211_ptr);
3785         err = nl80211_key_allowed(dev->ieee80211_ptr);
3786         if (!err)
3787                 err = rdev_add_key(rdev, dev, key.idx,
3788                                    key.type == NL80211_KEYTYPE_PAIRWISE,
3789                                     mac_addr, &key.p);
3790         wdev_unlock(dev->ieee80211_ptr);
3791
3792         return err;
3793 }
3794
3795 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3796 {
3797         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3798         int err;
3799         struct net_device *dev = info->user_ptr[1];
3800         u8 *mac_addr = NULL;
3801         struct key_parse key;
3802
3803         err = nl80211_parse_key(info, &key);
3804         if (err)
3805                 return err;
3806
3807         if (info->attrs[NL80211_ATTR_MAC])
3808                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3809
3810         if (key.type == -1) {
3811                 if (mac_addr)
3812                         key.type = NL80211_KEYTYPE_PAIRWISE;
3813                 else
3814                         key.type = NL80211_KEYTYPE_GROUP;
3815         }
3816
3817         /* for now */
3818         if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3819             key.type != NL80211_KEYTYPE_GROUP)
3820                 return -EINVAL;
3821
3822         if (!rdev->ops->del_key)
3823                 return -EOPNOTSUPP;
3824
3825         wdev_lock(dev->ieee80211_ptr);
3826         err = nl80211_key_allowed(dev->ieee80211_ptr);
3827
3828         if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
3829             !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3830                 err = -ENOENT;
3831
3832         if (!err)
3833                 err = rdev_del_key(rdev, dev, key.idx,
3834                                    key.type == NL80211_KEYTYPE_PAIRWISE,
3835                                    mac_addr);
3836
3837 #ifdef CONFIG_CFG80211_WEXT
3838         if (!err) {
3839                 if (key.idx == dev->ieee80211_ptr->wext.default_key)
3840                         dev->ieee80211_ptr->wext.default_key = -1;
3841                 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
3842                         dev->ieee80211_ptr->wext.default_mgmt_key = -1;
3843         }
3844 #endif
3845         wdev_unlock(dev->ieee80211_ptr);
3846
3847         return err;
3848 }
3849
3850 /* This function returns an error or the number of nested attributes */
3851 static int validate_acl_mac_addrs(struct nlattr *nl_attr)
3852 {
3853         struct nlattr *attr;
3854         int n_entries = 0, tmp;
3855
3856         nla_for_each_nested(attr, nl_attr, tmp) {
3857                 if (nla_len(attr) != ETH_ALEN)
3858                         return -EINVAL;
3859
3860                 n_entries++;
3861         }
3862
3863         return n_entries;
3864 }
3865
3866 /*
3867  * This function parses ACL information and allocates memory for ACL data.
3868  * On successful return, the calling function is responsible to free the
3869  * ACL buffer returned by this function.
3870  */
3871 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
3872                                                 struct genl_info *info)
3873 {
3874         enum nl80211_acl_policy acl_policy;
3875         struct nlattr *attr;
3876         struct cfg80211_acl_data *acl;
3877         int i = 0, n_entries, tmp;
3878
3879         if (!wiphy->max_acl_mac_addrs)
3880                 return ERR_PTR(-EOPNOTSUPP);
3881
3882         if (!info->attrs[NL80211_ATTR_ACL_POLICY])
3883                 return ERR_PTR(-EINVAL);
3884
3885         acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
3886         if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
3887             acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
3888                 return ERR_PTR(-EINVAL);
3889
3890         if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
3891                 return ERR_PTR(-EINVAL);
3892
3893         n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
3894         if (n_entries < 0)
3895                 return ERR_PTR(n_entries);
3896
3897         if (n_entries > wiphy->max_acl_mac_addrs)
3898                 return ERR_PTR(-ENOTSUPP);
3899
3900         acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL);
3901         if (!acl)
3902                 return ERR_PTR(-ENOMEM);
3903
3904         nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
3905                 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
3906                 i++;
3907         }
3908
3909         acl->n_acl_entries = n_entries;
3910         acl->acl_policy = acl_policy;
3911
3912         return acl;
3913 }
3914
3915 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
3916 {
3917         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3918         struct net_device *dev = info->user_ptr[1];
3919         struct cfg80211_acl_data *acl;
3920         int err;
3921
3922         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3923             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3924                 return -EOPNOTSUPP;
3925
3926         if (!dev->ieee80211_ptr->beacon_interval)
3927                 return -EINVAL;
3928
3929         acl = parse_acl_data(&rdev->wiphy, info);
3930         if (IS_ERR(acl))
3931                 return PTR_ERR(acl);
3932
3933         err = rdev_set_mac_acl(rdev, dev, acl);
3934
3935         kfree(acl);
3936
3937         return err;
3938 }
3939
3940 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
3941                            u8 *rates, u8 rates_len)
3942 {
3943         u8 i;
3944         u32 mask = 0;
3945
3946         for (i = 0; i < rates_len; i++) {
3947                 int rate = (rates[i] & 0x7f) * 5;
3948                 int ridx;
3949
3950                 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
3951                         struct ieee80211_rate *srate =
3952                                 &sband->bitrates[ridx];
3953                         if (rate == srate->bitrate) {
3954                                 mask |= 1 << ridx;
3955                                 break;
3956                         }
3957                 }
3958                 if (ridx == sband->n_bitrates)
3959                         return 0; /* rate not found */
3960         }
3961
3962         return mask;
3963 }
3964
3965 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
3966                                u8 *rates, u8 rates_len,
3967                                u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
3968 {
3969         u8 i;
3970
3971         memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
3972
3973         for (i = 0; i < rates_len; i++) {
3974                 int ridx, rbit;
3975
3976                 ridx = rates[i] / 8;
3977                 rbit = BIT(rates[i] % 8);
3978
3979                 /* check validity */
3980                 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
3981                         return false;
3982
3983                 /* check availability */
3984                 ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
3985                 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
3986                         mcs[ridx] |= rbit;
3987                 else
3988                         return false;
3989         }
3990
3991         return true;
3992 }
3993
3994 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
3995 {
3996         u16 mcs_mask = 0;
3997
3998         switch (vht_mcs_map) {
3999         case IEEE80211_VHT_MCS_NOT_SUPPORTED:
4000                 break;
4001         case IEEE80211_VHT_MCS_SUPPORT_0_7:
4002                 mcs_mask = 0x00FF;
4003                 break;
4004         case IEEE80211_VHT_MCS_SUPPORT_0_8:
4005                 mcs_mask = 0x01FF;
4006                 break;
4007         case IEEE80211_VHT_MCS_SUPPORT_0_9:
4008                 mcs_mask = 0x03FF;
4009                 break;
4010         default:
4011                 break;
4012         }
4013
4014         return mcs_mask;
4015 }
4016
4017 static void vht_build_mcs_mask(u16 vht_mcs_map,
4018                                u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
4019 {
4020         u8 nss;
4021
4022         for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
4023                 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
4024                 vht_mcs_map >>= 2;
4025         }
4026 }
4027
4028 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
4029                              struct nl80211_txrate_vht *txrate,
4030                              u16 mcs[NL80211_VHT_NSS_MAX])
4031 {
4032         u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
4033         u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
4034         u8 i;
4035
4036         if (!sband->vht_cap.vht_supported)
4037                 return false;
4038
4039         memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
4040
4041         /* Build vht_mcs_mask from VHT capabilities */
4042         vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
4043
4044         for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
4045                 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
4046                         mcs[i] = txrate->mcs[i];
4047                 else
4048                         return false;
4049         }
4050
4051         return true;
4052 }
4053
4054 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
4055         [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
4056                                     .len = NL80211_MAX_SUPP_RATES },
4057         [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
4058                                 .len = NL80211_MAX_SUPP_HT_RATES },
4059         [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
4060         [NL80211_TXRATE_GI] = { .type = NLA_U8 },
4061 };
4062
4063 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
4064                                          struct cfg80211_bitrate_mask *mask)
4065 {
4066         struct nlattr *tb[NL80211_TXRATE_MAX + 1];
4067         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4068         int rem, i;
4069         struct nlattr *tx_rates;
4070         struct ieee80211_supported_band *sband;
4071         u16 vht_tx_mcs_map;
4072
4073         memset(mask, 0, sizeof(*mask));
4074         /* Default to all rates enabled */
4075         for (i = 0; i < NUM_NL80211_BANDS; i++) {
4076                 sband = rdev->wiphy.bands[i];
4077
4078                 if (!sband)
4079                         continue;
4080
4081                 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
4082                 memcpy(mask->control[i].ht_mcs,
4083                        sband->ht_cap.mcs.rx_mask,
4084                        sizeof(mask->control[i].ht_mcs));
4085
4086                 if (!sband->vht_cap.vht_supported)
4087                         continue;
4088
4089                 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
4090                 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
4091         }
4092
4093         /* if no rates are given set it back to the defaults */
4094         if (!info->attrs[NL80211_ATTR_TX_RATES])
4095                 goto out;
4096
4097         /* The nested attribute uses enum nl80211_band as the index. This maps
4098          * directly to the enum nl80211_band values used in cfg80211.
4099          */
4100         BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
4101         nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
4102                 enum nl80211_band band = nla_type(tx_rates);
4103                 int err;
4104
4105                 if (band < 0 || band >= NUM_NL80211_BANDS)
4106                         return -EINVAL;
4107                 sband = rdev->wiphy.bands[band];
4108                 if (sband == NULL)
4109                         return -EINVAL;
4110                 err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX,
4111                                                   tx_rates,
4112                                                   nl80211_txattr_policy,
4113                                                   info->extack);
4114                 if (err)
4115                         return err;
4116                 if (tb[NL80211_TXRATE_LEGACY]) {
4117                         mask->control[band].legacy = rateset_to_mask(
4118                                 sband,
4119                                 nla_data(tb[NL80211_TXRATE_LEGACY]),
4120                                 nla_len(tb[NL80211_TXRATE_LEGACY]));
4121                         if ((mask->control[band].legacy == 0) &&
4122                             nla_len(tb[NL80211_TXRATE_LEGACY]))
4123                                 return -EINVAL;
4124                 }
4125                 if (tb[NL80211_TXRATE_HT]) {
4126                         if (!ht_rateset_to_mask(
4127                                         sband,
4128                                         nla_data(tb[NL80211_TXRATE_HT]),
4129                                         nla_len(tb[NL80211_TXRATE_HT]),
4130                                         mask->control[band].ht_mcs))
4131                                 return -EINVAL;
4132                 }
4133                 if (tb[NL80211_TXRATE_VHT]) {
4134                         if (!vht_set_mcs_mask(
4135                                         sband,
4136                                         nla_data(tb[NL80211_TXRATE_VHT]),
4137                                         mask->control[band].vht_mcs))
4138                                 return -EINVAL;
4139                 }
4140                 if (tb[NL80211_TXRATE_GI]) {
4141                         mask->control[band].gi =
4142                                 nla_get_u8(tb[NL80211_TXRATE_GI]);
4143                         if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
4144                                 return -EINVAL;
4145                 }
4146
4147                 if (mask->control[band].legacy == 0) {
4148                         /* don't allow empty legacy rates if HT or VHT
4149                          * are not even supported.
4150                          */
4151                         if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
4152                               rdev->wiphy.bands[band]->vht_cap.vht_supported))
4153                                 return -EINVAL;
4154
4155                         for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
4156                                 if (mask->control[band].ht_mcs[i])
4157                                         goto out;
4158
4159                         for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
4160                                 if (mask->control[band].vht_mcs[i])
4161                                         goto out;
4162
4163                         /* legacy and mcs rates may not be both empty */
4164                         return -EINVAL;
4165                 }
4166         }
4167
4168 out:
4169         return 0;
4170 }
4171
4172 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
4173                                    enum nl80211_band band,
4174                                    struct cfg80211_bitrate_mask *beacon_rate)
4175 {
4176         u32 count_ht, count_vht, i;
4177         u32 rate = beacon_rate->control[band].legacy;
4178
4179         /* Allow only one rate */
4180         if (hweight32(rate) > 1)
4181                 return -EINVAL;
4182
4183         count_ht = 0;
4184         for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
4185                 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
4186                         return -EINVAL;
4187                 } else if (beacon_rate->control[band].ht_mcs[i]) {
4188                         count_ht++;
4189                         if (count_ht > 1)
4190                                 return -EINVAL;
4191                 }
4192                 if (count_ht && rate)
4193                         return -EINVAL;
4194         }
4195
4196         count_vht = 0;
4197         for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
4198                 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
4199                         return -EINVAL;
4200                 } else if (beacon_rate->control[band].vht_mcs[i]) {
4201                         count_vht++;
4202                         if (count_vht > 1)
4203                                 return -EINVAL;
4204                 }
4205                 if (count_vht && rate)
4206                         return -EINVAL;
4207         }
4208
4209         if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
4210                 return -EINVAL;
4211
4212         if (rate &&
4213             !wiphy_ext_feature_isset(&rdev->wiphy,
4214                                      NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
4215                 return -EINVAL;
4216         if (count_ht &&
4217             !wiphy_ext_feature_isset(&rdev->wiphy,
4218                                      NL80211_EXT_FEATURE_BEACON_RATE_HT))
4219                 return -EINVAL;
4220         if (count_vht &&
4221             !wiphy_ext_feature_isset(&rdev->wiphy,
4222                                      NL80211_EXT_FEATURE_BEACON_RATE_VHT))
4223                 return -EINVAL;
4224
4225         return 0;
4226 }
4227
4228 static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev,
4229                                 struct nlattr *attrs[],
4230                                 struct cfg80211_beacon_data *bcn)
4231 {
4232         bool haveinfo = false;
4233         int err;
4234
4235         memset(bcn, 0, sizeof(*bcn));
4236
4237         if (attrs[NL80211_ATTR_BEACON_HEAD]) {
4238                 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
4239                 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
4240                 if (!bcn->head_len)
4241                         return -EINVAL;
4242                 haveinfo = true;
4243         }
4244
4245         if (attrs[NL80211_ATTR_BEACON_TAIL]) {
4246                 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
4247                 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
4248                 haveinfo = true;
4249         }
4250
4251         if (!haveinfo)
4252                 return -EINVAL;
4253
4254         if (attrs[NL80211_ATTR_IE]) {
4255                 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
4256                 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
4257         }
4258
4259         if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
4260                 bcn->proberesp_ies =
4261                         nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
4262                 bcn->proberesp_ies_len =
4263                         nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
4264         }
4265
4266         if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
4267                 bcn->assocresp_ies =
4268                         nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
4269                 bcn->assocresp_ies_len =
4270                         nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
4271         }
4272
4273         if (attrs[NL80211_ATTR_PROBE_RESP]) {
4274                 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
4275                 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
4276         }
4277
4278         if (attrs[NL80211_ATTR_FTM_RESPONDER]) {
4279                 struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1];
4280
4281                 err = nla_parse_nested_deprecated(tb,
4282                                                   NL80211_FTM_RESP_ATTR_MAX,
4283                                                   attrs[NL80211_ATTR_FTM_RESPONDER],
4284                                                   NULL, NULL);
4285                 if (err)
4286                         return err;
4287
4288                 if (tb[NL80211_FTM_RESP_ATTR_ENABLED] &&
4289                     wiphy_ext_feature_isset(&rdev->wiphy,
4290                                             NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER))
4291                         bcn->ftm_responder = 1;
4292                 else
4293                         return -EOPNOTSUPP;
4294
4295                 if (tb[NL80211_FTM_RESP_ATTR_LCI]) {
4296                         bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]);
4297                         bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]);
4298                 }
4299
4300                 if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) {
4301                         bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
4302                         bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
4303                 }
4304         } else {
4305                 bcn->ftm_responder = -1;
4306         }
4307
4308         return 0;
4309 }
4310
4311 static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
4312                                             const u8 *rates)
4313 {
4314         int i;
4315
4316         if (!rates)
4317                 return;
4318
4319         for (i = 0; i < rates[1]; i++) {
4320                 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
4321                         params->ht_required = true;
4322                 if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
4323                         params->vht_required = true;
4324         }
4325 }
4326
4327 /*
4328  * Since the nl80211 API didn't include, from the beginning, attributes about
4329  * HT/VHT requirements/capabilities, we parse them out of the IEs for the
4330  * benefit of drivers that rebuild IEs in the firmware.
4331  */
4332 static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
4333 {
4334         const struct cfg80211_beacon_data *bcn = &params->beacon;
4335         size_t ies_len = bcn->tail_len;
4336         const u8 *ies = bcn->tail;
4337         const u8 *rates;
4338         const u8 *cap;
4339
4340         rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
4341         nl80211_check_ap_rate_selectors(params, rates);
4342
4343         rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
4344         nl80211_check_ap_rate_selectors(params, rates);
4345
4346         cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
4347         if (cap && cap[1] >= sizeof(*params->ht_cap))
4348                 params->ht_cap = (void *)(cap + 2);
4349         cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
4350         if (cap && cap[1] >= sizeof(*params->vht_cap))
4351                 params->vht_cap = (void *)(cap + 2);
4352         cap = cfg80211_find_ext_ie(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len);
4353         if (cap && cap[1] >= sizeof(*params->he_cap) + 1)
4354                 params->he_cap = (void *)(cap + 3);
4355 }
4356
4357 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
4358                                    struct cfg80211_ap_settings *params)
4359 {
4360         struct wireless_dev *wdev;
4361         bool ret = false;
4362
4363         list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
4364                 if (wdev->iftype != NL80211_IFTYPE_AP &&
4365                     wdev->iftype != NL80211_IFTYPE_P2P_GO)
4366                         continue;
4367
4368                 if (!wdev->preset_chandef.chan)
4369                         continue;
4370
4371                 params->chandef = wdev->preset_chandef;
4372                 ret = true;
4373                 break;
4374         }
4375
4376         return ret;
4377 }
4378
4379 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
4380                                     enum nl80211_auth_type auth_type,
4381                                     enum nl80211_commands cmd)
4382 {
4383         if (auth_type > NL80211_AUTHTYPE_MAX)
4384                 return false;
4385
4386         switch (cmd) {
4387         case NL80211_CMD_AUTHENTICATE:
4388                 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
4389                     auth_type == NL80211_AUTHTYPE_SAE)
4390                         return false;
4391                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
4392                                              NL80211_EXT_FEATURE_FILS_STA) &&
4393                     (auth_type == NL80211_AUTHTYPE_FILS_SK ||
4394                      auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4395                      auth_type == NL80211_AUTHTYPE_FILS_PK))
4396                         return false;
4397                 return true;
4398         case NL80211_CMD_CONNECT:
4399                 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
4400                     auth_type == NL80211_AUTHTYPE_SAE)
4401                         return false;
4402
4403                 /* FILS with SK PFS or PK not supported yet */
4404                 if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4405                     auth_type == NL80211_AUTHTYPE_FILS_PK)
4406                         return false;
4407                 if (!wiphy_ext_feature_isset(
4408                             &rdev->wiphy,
4409                             NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
4410                     auth_type == NL80211_AUTHTYPE_FILS_SK)
4411                         return false;
4412                 return true;
4413         case NL80211_CMD_START_AP:
4414                 /* SAE not supported yet */
4415                 if (auth_type == NL80211_AUTHTYPE_SAE)
4416                         return false;
4417                 /* FILS not supported yet */
4418                 if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
4419                     auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
4420                     auth_type == NL80211_AUTHTYPE_FILS_PK)
4421                         return false;
4422                 return true;
4423         default:
4424                 return false;
4425         }
4426 }
4427
4428 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
4429 {
4430         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4431         struct net_device *dev = info->user_ptr[1];
4432         struct wireless_dev *wdev = dev->ieee80211_ptr;
4433         struct cfg80211_ap_settings params;
4434         int err;
4435
4436         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4437             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4438                 return -EOPNOTSUPP;
4439
4440         if (!rdev->ops->start_ap)
4441                 return -EOPNOTSUPP;
4442
4443         if (wdev->beacon_interval)
4444                 return -EALREADY;
4445
4446         memset(&params, 0, sizeof(params));
4447
4448         /* these are required for START_AP */
4449         if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
4450             !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
4451             !info->attrs[NL80211_ATTR_BEACON_HEAD])
4452                 return -EINVAL;
4453
4454         err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon);
4455         if (err)
4456                 return err;
4457
4458         params.beacon_interval =
4459                 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
4460         params.dtim_period =
4461                 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
4462
4463         err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
4464                                            params.beacon_interval);
4465         if (err)
4466                 return err;
4467
4468         /*
4469          * In theory, some of these attributes should be required here
4470          * but since they were not used when the command was originally
4471          * added, keep them optional for old user space programs to let
4472          * them continue to work with drivers that do not need the
4473          * additional information -- drivers must check!
4474          */
4475         if (info->attrs[NL80211_ATTR_SSID]) {
4476                 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
4477                 params.ssid_len =
4478                         nla_len(info->attrs[NL80211_ATTR_SSID]);
4479                 if (params.ssid_len == 0 ||
4480                     params.ssid_len > IEEE80211_MAX_SSID_LEN)
4481                         return -EINVAL;
4482         }
4483
4484         if (info->attrs[NL80211_ATTR_HIDDEN_SSID])
4485                 params.hidden_ssid = nla_get_u32(
4486                         info->attrs[NL80211_ATTR_HIDDEN_SSID]);
4487
4488         params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
4489
4490         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
4491                 params.auth_type = nla_get_u32(
4492                         info->attrs[NL80211_ATTR_AUTH_TYPE]);
4493                 if (!nl80211_valid_auth_type(rdev, params.auth_type,
4494                                              NL80211_CMD_START_AP))
4495                         return -EINVAL;
4496         } else
4497                 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
4498
4499         err = nl80211_crypto_settings(rdev, info, &params.crypto,
4500                                       NL80211_MAX_NR_CIPHER_SUITES);
4501         if (err)
4502                 return err;
4503
4504         if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
4505                 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
4506                         return -EOPNOTSUPP;
4507                 params.inactivity_timeout = nla_get_u16(
4508                         info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
4509         }
4510
4511         if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
4512                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4513                         return -EINVAL;
4514                 params.p2p_ctwindow =
4515                         nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
4516                 if (params.p2p_ctwindow != 0 &&
4517                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
4518                         return -EINVAL;
4519         }
4520
4521         if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
4522                 u8 tmp;
4523
4524                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4525                         return -EINVAL;
4526                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
4527                 params.p2p_opp_ps = tmp;
4528                 if (params.p2p_opp_ps != 0 &&
4529                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
4530                         return -EINVAL;
4531         }
4532
4533         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
4534                 err = nl80211_parse_chandef(rdev, info, &params.chandef);
4535                 if (err)
4536                         return err;
4537         } else if (wdev->preset_chandef.chan) {
4538                 params.chandef = wdev->preset_chandef;
4539         } else if (!nl80211_get_ap_channel(rdev, &params))
4540                 return -EINVAL;
4541
4542         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
4543                                            wdev->iftype))
4544                 return -EINVAL;
4545
4546         if (info->attrs[NL80211_ATTR_TX_RATES]) {
4547                 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
4548                 if (err)
4549                         return err;
4550
4551                 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
4552                                               &params.beacon_rate);
4553                 if (err)
4554                         return err;
4555         }
4556
4557         if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
4558                 params.smps_mode =
4559                         nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
4560                 switch (params.smps_mode) {
4561                 case NL80211_SMPS_OFF:
4562                         break;
4563                 case NL80211_SMPS_STATIC:
4564                         if (!(rdev->wiphy.features &
4565                               NL80211_FEATURE_STATIC_SMPS))
4566                                 return -EINVAL;
4567                         break;
4568                 case NL80211_SMPS_DYNAMIC:
4569                         if (!(rdev->wiphy.features &
4570                               NL80211_FEATURE_DYNAMIC_SMPS))
4571                                 return -EINVAL;
4572                         break;
4573                 default:
4574                         return -EINVAL;
4575                 }
4576         } else {
4577                 params.smps_mode = NL80211_SMPS_OFF;
4578         }
4579
4580         params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
4581         if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
4582                 return -EOPNOTSUPP;
4583
4584         if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
4585                 params.acl = parse_acl_data(&rdev->wiphy, info);
4586                 if (IS_ERR(params.acl))
4587                         return PTR_ERR(params.acl);
4588         }
4589
4590         nl80211_calculate_ap_params(&params);
4591
4592         if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])
4593                 params.flags |= AP_SETTINGS_EXTERNAL_AUTH_SUPPORT;
4594
4595         wdev_lock(wdev);
4596         err = rdev_start_ap(rdev, dev, &params);
4597         if (!err) {
4598                 wdev->preset_chandef = params.chandef;
4599                 wdev->beacon_interval = params.beacon_interval;
4600                 wdev->chandef = params.chandef;
4601                 wdev->ssid_len = params.ssid_len;
4602                 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
4603
4604                 if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
4605                         wdev->conn_owner_nlportid = info->snd_portid;
4606         }
4607         wdev_unlock(wdev);
4608
4609         kfree(params.acl);
4610
4611         return err;
4612 }
4613
4614 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
4615 {
4616         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4617         struct net_device *dev = info->user_ptr[1];
4618         struct wireless_dev *wdev = dev->ieee80211_ptr;
4619         struct cfg80211_beacon_data params;
4620         int err;
4621
4622         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4623             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
4624                 return -EOPNOTSUPP;
4625
4626         if (!rdev->ops->change_beacon)
4627                 return -EOPNOTSUPP;
4628
4629         if (!wdev->beacon_interval)
4630                 return -EINVAL;
4631
4632         err = nl80211_parse_beacon(rdev, info->attrs, &params);
4633         if (err)
4634                 return err;
4635
4636         wdev_lock(wdev);
4637         err = rdev_change_beacon(rdev, dev, &params);
4638         wdev_unlock(wdev);
4639
4640         return err;
4641 }
4642
4643 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
4644 {
4645         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4646         struct net_device *dev = info->user_ptr[1];
4647
4648         return cfg80211_stop_ap(rdev, dev, false);
4649 }
4650
4651 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
4652         [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
4653         [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
4654         [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
4655         [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
4656         [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
4657         [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
4658 };
4659
4660 static int parse_station_flags(struct genl_info *info,
4661                                enum nl80211_iftype iftype,
4662                                struct station_parameters *params)
4663 {
4664         struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
4665         struct nlattr *nla;
4666         int flag;
4667
4668         /*
4669          * Try parsing the new attribute first so userspace
4670          * can specify both for older kernels.
4671          */
4672         nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4673         if (nla) {
4674                 struct nl80211_sta_flag_update *sta_flags;
4675
4676                 sta_flags = nla_data(nla);
4677                 params->sta_flags_mask = sta_flags->mask;
4678                 params->sta_flags_set = sta_flags->set;
4679                 params->sta_flags_set &= params->sta_flags_mask;
4680                 if ((params->sta_flags_mask |
4681                      params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4682                         return -EINVAL;
4683                 return 0;
4684         }
4685
4686         /* if present, parse the old attribute */
4687
4688         nla = info->attrs[NL80211_ATTR_STA_FLAGS];
4689         if (!nla)
4690                 return 0;
4691
4692         if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack))
4693                 return -EINVAL;
4694
4695         /*
4696          * Only allow certain flags for interface types so that
4697          * other attributes are silently ignored. Remember that
4698          * this is backward compatibility code with old userspace
4699          * and shouldn't be hit in other cases anyway.
4700          */
4701         switch (iftype) {
4702         case NL80211_IFTYPE_AP:
4703         case NL80211_IFTYPE_AP_VLAN:
4704         case NL80211_IFTYPE_P2P_GO:
4705                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4706                                          BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4707                                          BIT(NL80211_STA_FLAG_WME) |
4708                                          BIT(NL80211_STA_FLAG_MFP);
4709                 break;
4710         case NL80211_IFTYPE_P2P_CLIENT:
4711         case NL80211_IFTYPE_STATION:
4712                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4713                                          BIT(NL80211_STA_FLAG_TDLS_PEER);
4714                 break;
4715         case NL80211_IFTYPE_MESH_POINT:
4716                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4717                                          BIT(NL80211_STA_FLAG_MFP) |
4718                                          BIT(NL80211_STA_FLAG_AUTHORIZED);
4719                 break;
4720         default:
4721                 return -EINVAL;
4722         }
4723
4724         for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4725                 if (flags[flag]) {
4726                         params->sta_flags_set |= (1<<flag);
4727
4728                         /* no longer support new API additions in old API */
4729                         if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4730                                 return -EINVAL;
4731                 }
4732         }
4733
4734         return 0;
4735 }
4736
4737 bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr)
4738 {
4739         struct nlattr *rate;
4740         u32 bitrate;
4741         u16 bitrate_compat;
4742         enum nl80211_rate_info rate_flg;
4743
4744         rate = nla_nest_start_noflag(msg, attr);
4745         if (!rate)
4746                 return false;
4747
4748         /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4749         bitrate = cfg80211_calculate_bitrate(info);
4750         /* report 16-bit bitrate only if we can */
4751         bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
4752         if (bitrate > 0 &&
4753             nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4754                 return false;
4755         if (bitrate_compat > 0 &&
4756             nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4757                 return false;
4758
4759         switch (info->bw) {
4760         case RATE_INFO_BW_5:
4761                 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4762                 break;
4763         case RATE_INFO_BW_10:
4764                 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4765                 break;
4766         default:
4767                 WARN_ON(1);
4768                 /* fall through */
4769         case RATE_INFO_BW_20:
4770                 rate_flg = 0;
4771                 break;
4772         case RATE_INFO_BW_40:
4773                 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4774                 break;
4775         case RATE_INFO_BW_80:
4776                 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
4777                 break;
4778         case RATE_INFO_BW_160:
4779                 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
4780                 break;
4781         case RATE_INFO_BW_HE_RU:
4782                 rate_flg = 0;
4783                 WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS));
4784         }
4785
4786         if (rate_flg && nla_put_flag(msg, rate_flg))
4787                 return false;
4788
4789         if (info->flags & RATE_INFO_FLAGS_MCS) {
4790                 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
4791                         return false;
4792                 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4793                     nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4794                         return false;
4795         } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
4796                 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
4797                         return false;
4798                 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
4799                         return false;
4800                 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4801                     nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4802                         return false;
4803         } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) {
4804                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs))
4805                         return false;
4806                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss))
4807                         return false;
4808                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi))
4809                         return false;
4810                 if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm))
4811                         return false;
4812                 if (info->bw == RATE_INFO_BW_HE_RU &&
4813                     nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC,
4814                                info->he_ru_alloc))
4815                         return false;
4816         }
4817
4818         nla_nest_end(msg, rate);
4819         return true;
4820 }
4821
4822 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
4823                                int id)
4824 {
4825         void *attr;
4826         int i = 0;
4827
4828         if (!mask)
4829                 return true;
4830
4831         attr = nla_nest_start_noflag(msg, id);
4832         if (!attr)
4833                 return false;
4834
4835         for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
4836                 if (!(mask & BIT(i)))
4837                         continue;
4838
4839                 if (nla_put_u8(msg, i, signal[i]))
4840                         return false;
4841         }
4842
4843         nla_nest_end(msg, attr);
4844
4845         return true;
4846 }
4847
4848 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
4849                                 u32 seq, int flags,
4850                                 struct cfg80211_registered_device *rdev,
4851                                 struct net_device *dev,
4852                                 const u8 *mac_addr, struct station_info *sinfo)
4853 {
4854         void *hdr;
4855         struct nlattr *sinfoattr, *bss_param;
4856
4857         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
4858         if (!hdr)
4859                 return -1;
4860
4861         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4862             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
4863             nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
4864                 goto nla_put_failure;
4865
4866         sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO);
4867         if (!sinfoattr)
4868                 goto nla_put_failure;
4869
4870 #define PUT_SINFO(attr, memb, type) do {                                \
4871         BUILD_BUG_ON(sizeof(type) == sizeof(u64));                      \
4872         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&       \
4873             nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr,            \
4874                              sinfo->memb))                              \
4875                 goto nla_put_failure;                                   \
4876         } while (0)
4877 #define PUT_SINFO_U64(attr, memb) do {                                  \
4878         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) &&       \
4879             nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr,           \
4880                               sinfo->memb, NL80211_STA_INFO_PAD))       \
4881                 goto nla_put_failure;                                   \
4882         } while (0)
4883
4884         PUT_SINFO(CONNECTED_TIME, connected_time, u32);
4885         PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
4886
4887         if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) |
4888                              BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) &&
4889             nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
4890                         (u32)sinfo->rx_bytes))
4891                 goto nla_put_failure;
4892
4893         if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) |
4894                              BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) &&
4895             nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
4896                         (u32)sinfo->tx_bytes))
4897                 goto nla_put_failure;
4898
4899         PUT_SINFO_U64(RX_BYTES64, rx_bytes);
4900         PUT_SINFO_U64(TX_BYTES64, tx_bytes);
4901         PUT_SINFO(LLID, llid, u16);
4902         PUT_SINFO(PLID, plid, u16);
4903         PUT_SINFO(PLINK_STATE, plink_state, u8);
4904         PUT_SINFO_U64(RX_DURATION, rx_duration);
4905         PUT_SINFO_U64(TX_DURATION, tx_duration);
4906
4907         if (wiphy_ext_feature_isset(&rdev->wiphy,
4908                                     NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
4909                 PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16);
4910
4911         switch (rdev->wiphy.signal_type) {
4912         case CFG80211_SIGNAL_TYPE_MBM:
4913                 PUT_SINFO(SIGNAL, signal, u8);
4914                 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
4915                 break;
4916         default:
4917                 break;
4918         }
4919         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) {
4920                 if (!nl80211_put_signal(msg, sinfo->chains,
4921                                         sinfo->chain_signal,
4922                                         NL80211_STA_INFO_CHAIN_SIGNAL))
4923                         goto nla_put_failure;
4924         }
4925         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
4926                 if (!nl80211_put_signal(msg, sinfo->chains,
4927                                         sinfo->chain_signal_avg,
4928                                         NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
4929                         goto nla_put_failure;
4930         }
4931         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) {
4932                 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
4933                                           NL80211_STA_INFO_TX_BITRATE))
4934                         goto nla_put_failure;
4935         }
4936         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) {
4937                 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
4938                                           NL80211_STA_INFO_RX_BITRATE))
4939                         goto nla_put_failure;
4940         }
4941
4942         PUT_SINFO(RX_PACKETS, rx_packets, u32);
4943         PUT_SINFO(TX_PACKETS, tx_packets, u32);
4944         PUT_SINFO(TX_RETRIES, tx_retries, u32);
4945         PUT_SINFO(TX_FAILED, tx_failed, u32);
4946         PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
4947         PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32);
4948         PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
4949         PUT_SINFO(LOCAL_PM, local_pm, u32);
4950         PUT_SINFO(PEER_PM, peer_pm, u32);
4951         PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
4952         PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8);
4953
4954         if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) {
4955                 bss_param = nla_nest_start_noflag(msg,
4956                                                   NL80211_STA_INFO_BSS_PARAM);
4957                 if (!bss_param)
4958                         goto nla_put_failure;
4959
4960                 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
4961                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
4962                     ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
4963                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
4964                     ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
4965                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
4966                     nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
4967                                sinfo->bss_param.dtim_period) ||
4968                     nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
4969                                 sinfo->bss_param.beacon_interval))
4970                         goto nla_put_failure;
4971
4972                 nla_nest_end(msg, bss_param);
4973         }
4974         if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) &&
4975             nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
4976                     sizeof(struct nl80211_sta_flag_update),
4977                     &sinfo->sta_flags))
4978                 goto nla_put_failure;
4979
4980         PUT_SINFO_U64(T_OFFSET, t_offset);
4981         PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
4982         PUT_SINFO_U64(BEACON_RX, rx_beacon);
4983         PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
4984         PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32);
4985         PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32);
4986         if (wiphy_ext_feature_isset(&rdev->wiphy,
4987                                     NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) {
4988                 PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
4989                 PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8);
4990         }
4991
4992 #undef PUT_SINFO
4993 #undef PUT_SINFO_U64
4994
4995         if (sinfo->pertid) {
4996                 struct nlattr *tidsattr;
4997                 int tid;
4998
4999                 tidsattr = nla_nest_start_noflag(msg,
5000                                                  NL80211_STA_INFO_TID_STATS);
5001                 if (!tidsattr)
5002                         goto nla_put_failure;
5003
5004                 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
5005                         struct cfg80211_tid_stats *tidstats;
5006                         struct nlattr *tidattr;
5007
5008                         tidstats = &sinfo->pertid[tid];
5009
5010                         if (!tidstats->filled)
5011                                 continue;
5012
5013                         tidattr = nla_nest_start_noflag(msg, tid + 1);
5014                         if (!tidattr)
5015                                 goto nla_put_failure;
5016
5017 #define PUT_TIDVAL_U64(attr, memb) do {                                 \
5018         if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) &&       \
5019             nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr,          \
5020                               tidstats->memb, NL80211_TID_STATS_PAD))   \
5021                 goto nla_put_failure;                                   \
5022         } while (0)
5023
5024                         PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
5025                         PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
5026                         PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
5027                         PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
5028
5029 #undef PUT_TIDVAL_U64
5030                         if ((tidstats->filled &
5031                              BIT(NL80211_TID_STATS_TXQ_STATS)) &&
5032                             !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
5033                                                    NL80211_TID_STATS_TXQ_STATS))
5034                                 goto nla_put_failure;
5035
5036                         nla_nest_end(msg, tidattr);
5037                 }
5038
5039                 nla_nest_end(msg, tidsattr);
5040         }
5041
5042         nla_nest_end(msg, sinfoattr);
5043
5044         if (sinfo->assoc_req_ies_len &&
5045             nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
5046                     sinfo->assoc_req_ies))
5047                 goto nla_put_failure;
5048
5049         cfg80211_sinfo_release_content(sinfo);
5050         genlmsg_end(msg, hdr);
5051         return 0;
5052
5053  nla_put_failure:
5054         cfg80211_sinfo_release_content(sinfo);
5055         genlmsg_cancel(msg, hdr);
5056         return -EMSGSIZE;
5057 }
5058
5059 static int nl80211_dump_station(struct sk_buff *skb,
5060                                 struct netlink_callback *cb)
5061 {
5062         struct station_info sinfo;
5063         struct cfg80211_registered_device *rdev;
5064         struct wireless_dev *wdev;
5065         u8 mac_addr[ETH_ALEN];
5066         int sta_idx = cb->args[2];
5067         int err;
5068
5069         rtnl_lock();
5070         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
5071         if (err)
5072                 goto out_err;
5073
5074         if (!wdev->netdev) {
5075                 err = -EINVAL;
5076                 goto out_err;
5077         }
5078
5079         if (!rdev->ops->dump_station) {
5080                 err = -EOPNOTSUPP;
5081                 goto out_err;
5082         }
5083
5084         while (1) {
5085                 memset(&sinfo, 0, sizeof(sinfo));
5086                 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
5087                                         mac_addr, &sinfo);
5088                 if (err == -ENOENT)
5089                         break;
5090                 if (err)
5091                         goto out_err;
5092
5093                 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
5094                                 NETLINK_CB(cb->skb).portid,
5095                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
5096                                 rdev, wdev->netdev, mac_addr,
5097                                 &sinfo) < 0)
5098                         goto out;
5099
5100                 sta_idx++;
5101         }
5102
5103  out:
5104         cb->args[2] = sta_idx;
5105         err = skb->len;
5106  out_err:
5107         rtnl_unlock();
5108
5109         return err;
5110 }
5111
5112 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
5113 {
5114         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5115         struct net_device *dev = info->user_ptr[1];
5116         struct station_info sinfo;
5117         struct sk_buff *msg;
5118         u8 *mac_addr = NULL;
5119         int err;
5120
5121         memset(&sinfo, 0, sizeof(sinfo));
5122
5123         if (!info->attrs[NL80211_ATTR_MAC])
5124                 return -EINVAL;
5125
5126         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5127
5128         if (!rdev->ops->get_station)
5129                 return -EOPNOTSUPP;
5130
5131         err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
5132         if (err)
5133                 return err;
5134
5135         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5136         if (!msg) {
5137                 cfg80211_sinfo_release_content(&sinfo);
5138                 return -ENOMEM;
5139         }
5140
5141         if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
5142                                  info->snd_portid, info->snd_seq, 0,
5143                                  rdev, dev, mac_addr, &sinfo) < 0) {
5144                 nlmsg_free(msg);
5145                 return -ENOBUFS;
5146         }
5147
5148         return genlmsg_reply(msg, info);
5149 }
5150
5151 int cfg80211_check_station_change(struct wiphy *wiphy,
5152                                   struct station_parameters *params,
5153                                   enum cfg80211_station_type statype)
5154 {
5155         if (params->listen_interval != -1 &&
5156             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5157                 return -EINVAL;
5158
5159         if (params->support_p2p_ps != -1 &&
5160             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5161                 return -EINVAL;
5162
5163         if (params->aid &&
5164             !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
5165             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
5166                 return -EINVAL;
5167
5168         /* When you run into this, adjust the code below for the new flag */
5169         BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5170
5171         switch (statype) {
5172         case CFG80211_STA_MESH_PEER_KERNEL:
5173         case CFG80211_STA_MESH_PEER_USER:
5174                 /*
5175                  * No ignoring the TDLS flag here -- the userspace mesh
5176                  * code doesn't have the bug of including TDLS in the
5177                  * mask everywhere.
5178                  */
5179                 if (params->sta_flags_mask &
5180                                 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5181                                   BIT(NL80211_STA_FLAG_MFP) |
5182                                   BIT(NL80211_STA_FLAG_AUTHORIZED)))
5183                         return -EINVAL;
5184                 break;
5185         case CFG80211_STA_TDLS_PEER_SETUP:
5186         case CFG80211_STA_TDLS_PEER_ACTIVE:
5187                 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5188                         return -EINVAL;
5189                 /* ignore since it can't change */
5190                 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5191                 break;
5192         default:
5193                 /* disallow mesh-specific things */
5194                 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
5195                         return -EINVAL;
5196                 if (params->local_pm)
5197                         return -EINVAL;
5198                 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
5199                         return -EINVAL;
5200         }
5201
5202         if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
5203             statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
5204                 /* TDLS can't be set, ... */
5205                 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
5206                         return -EINVAL;
5207                 /*
5208                  * ... but don't bother the driver with it. This works around
5209                  * a hostapd/wpa_supplicant issue -- it always includes the
5210                  * TLDS_PEER flag in the mask even for AP mode.
5211                  */
5212                 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5213         }
5214
5215         if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
5216             statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
5217                 /* reject other things that can't change */
5218                 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
5219                         return -EINVAL;
5220                 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
5221                         return -EINVAL;
5222                 if (params->supported_rates)
5223                         return -EINVAL;
5224                 if (params->ext_capab || params->ht_capa || params->vht_capa ||
5225                     params->he_capa)
5226                         return -EINVAL;
5227         }
5228
5229         if (statype != CFG80211_STA_AP_CLIENT &&
5230             statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
5231                 if (params->vlan)
5232                         return -EINVAL;
5233         }
5234
5235         switch (statype) {
5236         case CFG80211_STA_AP_MLME_CLIENT:
5237                 /* Use this only for authorizing/unauthorizing a station */
5238                 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
5239                         return -EOPNOTSUPP;
5240                 break;
5241         case CFG80211_STA_AP_CLIENT:
5242         case CFG80211_STA_AP_CLIENT_UNASSOC:
5243                 /* accept only the listed bits */
5244                 if (params->sta_flags_mask &
5245                                 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
5246                                   BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5247                                   BIT(NL80211_STA_FLAG_ASSOCIATED) |
5248                                   BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
5249                                   BIT(NL80211_STA_FLAG_WME) |
5250                                   BIT(NL80211_STA_FLAG_MFP)))
5251                         return -EINVAL;
5252
5253                 /* but authenticated/associated only if driver handles it */
5254                 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5255                     params->sta_flags_mask &
5256                                 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5257                                  BIT(NL80211_STA_FLAG_ASSOCIATED)))
5258                         return -EINVAL;
5259                 break;
5260         case CFG80211_STA_IBSS:
5261         case CFG80211_STA_AP_STA:
5262                 /* reject any changes other than AUTHORIZED */
5263                 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
5264                         return -EINVAL;
5265                 break;
5266         case CFG80211_STA_TDLS_PEER_SETUP:
5267                 /* reject any changes other than AUTHORIZED or WME */
5268                 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
5269                                                BIT(NL80211_STA_FLAG_WME)))
5270                         return -EINVAL;
5271                 /* force (at least) rates when authorizing */
5272                 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
5273                     !params->supported_rates)
5274                         return -EINVAL;
5275                 break;
5276         case CFG80211_STA_TDLS_PEER_ACTIVE:
5277                 /* reject any changes */
5278                 return -EINVAL;
5279         case CFG80211_STA_MESH_PEER_KERNEL:
5280                 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
5281                         return -EINVAL;
5282                 break;
5283         case CFG80211_STA_MESH_PEER_USER:
5284                 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
5285                     params->plink_action != NL80211_PLINK_ACTION_BLOCK)
5286                         return -EINVAL;
5287                 break;
5288         }
5289
5290         /*
5291          * Older kernel versions ignored this attribute entirely, so don't
5292          * reject attempts to update it but mark it as unused instead so the
5293          * driver won't look at the data.
5294          */
5295         if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
5296             statype != CFG80211_STA_TDLS_PEER_SETUP)
5297                 params->opmode_notif_used = false;
5298
5299         return 0;
5300 }
5301 EXPORT_SYMBOL(cfg80211_check_station_change);
5302
5303 /*
5304  * Get vlan interface making sure it is running and on the right wiphy.
5305  */
5306 static struct net_device *get_vlan(struct genl_info *info,
5307                                    struct cfg80211_registered_device *rdev)
5308 {
5309         struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
5310         struct net_device *v;
5311         int ret;
5312
5313         if (!vlanattr)
5314                 return NULL;
5315
5316         v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
5317         if (!v)
5318                 return ERR_PTR(-ENODEV);
5319
5320         if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
5321                 ret = -EINVAL;
5322                 goto error;
5323         }
5324
5325         if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5326             v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5327             v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
5328                 ret = -EINVAL;
5329                 goto error;
5330         }
5331
5332         if (!netif_running(v)) {
5333                 ret = -ENETDOWN;
5334                 goto error;
5335         }
5336
5337         return v;
5338  error:
5339         dev_put(v);
5340         return ERR_PTR(ret);
5341 }
5342
5343 static const struct nla_policy
5344 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
5345         [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
5346         [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
5347 };
5348
5349 static int nl80211_parse_sta_wme(struct genl_info *info,
5350                                  struct station_parameters *params)
5351 {
5352         struct nlattr *tb[NL80211_STA_WME_MAX + 1];
5353         struct nlattr *nla;
5354         int err;
5355
5356         /* parse WME attributes if present */
5357         if (!info->attrs[NL80211_ATTR_STA_WME])
5358                 return 0;
5359
5360         nla = info->attrs[NL80211_ATTR_STA_WME];
5361         err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla,
5362                                           nl80211_sta_wme_policy,
5363                                           info->extack);
5364         if (err)
5365                 return err;
5366
5367         if (tb[NL80211_STA_WME_UAPSD_QUEUES])
5368                 params->uapsd_queues = nla_get_u8(
5369                         tb[NL80211_STA_WME_UAPSD_QUEUES]);
5370         if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
5371                 return -EINVAL;
5372
5373         if (tb[NL80211_STA_WME_MAX_SP])
5374                 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
5375
5376         if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
5377                 return -EINVAL;
5378
5379         params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
5380
5381         return 0;
5382 }
5383
5384 static int nl80211_parse_sta_channel_info(struct genl_info *info,
5385                                       struct station_parameters *params)
5386 {
5387         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
5388                 params->supported_channels =
5389                      nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
5390                 params->supported_channels_len =
5391                      nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
5392                 /*
5393                  * Need to include at least one (first channel, number of
5394                  * channels) tuple for each subband, and must have proper
5395                  * tuples for the rest of the data as well.
5396                  */
5397                 if (params->supported_channels_len < 2)
5398                         return -EINVAL;
5399                 if (params->supported_channels_len % 2)
5400                         return -EINVAL;
5401         }
5402
5403         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
5404                 params->supported_oper_classes =
5405                  nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
5406                 params->supported_oper_classes_len =
5407                   nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
5408                 /*
5409                  * The value of the Length field of the Supported Operating
5410                  * Classes element is between 2 and 253.
5411                  */
5412                 if (params->supported_oper_classes_len < 2 ||
5413                     params->supported_oper_classes_len > 253)
5414                         return -EINVAL;
5415         }
5416         return 0;
5417 }
5418
5419 static int nl80211_set_station_tdls(struct genl_info *info,
5420                                     struct station_parameters *params)
5421 {
5422         int err;
5423         /* Dummy STA entry gets updated once the peer capabilities are known */
5424         if (info->attrs[NL80211_ATTR_PEER_AID])
5425                 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5426         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5427                 params->ht_capa =
5428                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5429         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5430                 params->vht_capa =
5431                         nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5432         if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
5433                 params->he_capa =
5434                         nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5435                 params->he_capa_len =
5436                         nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5437
5438                 if (params->he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN)
5439                         return -EINVAL;
5440         }
5441
5442         err = nl80211_parse_sta_channel_info(info, params);
5443         if (err)
5444                 return err;
5445
5446         return nl80211_parse_sta_wme(info, params);
5447 }
5448
5449 static int nl80211_parse_sta_txpower_setting(struct genl_info *info,
5450                                              struct station_parameters *params)
5451 {
5452         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5453         int idx;
5454
5455         if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) {
5456                 if (!rdev->ops->set_tx_power ||
5457                     !wiphy_ext_feature_isset(&rdev->wiphy,
5458                                          NL80211_EXT_FEATURE_STA_TX_PWR))
5459                         return -EOPNOTSUPP;
5460
5461                 idx = NL80211_ATTR_STA_TX_POWER_SETTING;
5462                 params->txpwr.type = nla_get_u8(info->attrs[idx]);
5463
5464                 if (params->txpwr.type == NL80211_TX_POWER_LIMITED) {
5465                         idx = NL80211_ATTR_STA_TX_POWER;
5466
5467                         if (info->attrs[idx])
5468                                 params->txpwr.power =
5469                                         nla_get_s16(info->attrs[idx]);
5470                         else
5471                                 return -EINVAL;
5472                 }
5473                 params->sta_modify_mask |= STATION_PARAM_APPLY_STA_TXPOWER;
5474         }
5475
5476         return 0;
5477 }
5478
5479 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
5480 {
5481         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5482         struct net_device *dev = info->user_ptr[1];
5483         struct station_parameters params;
5484         u8 *mac_addr;
5485         int err;
5486
5487         memset(&params, 0, sizeof(params));
5488
5489         if (!rdev->ops->change_station)
5490                 return -EOPNOTSUPP;
5491
5492         /*
5493          * AID and listen_interval properties can be set only for unassociated
5494          * station. Include these parameters here and will check them in
5495          * cfg80211_check_station_change().
5496          */
5497         if (info->attrs[NL80211_ATTR_STA_AID])
5498                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5499
5500         if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5501                 params.listen_interval =
5502                      nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5503         else
5504                 params.listen_interval = -1;
5505
5506         if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS])
5507                 params.support_p2p_ps =
5508                         nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5509         else
5510                 params.support_p2p_ps = -1;
5511
5512         if (!info->attrs[NL80211_ATTR_MAC])
5513                 return -EINVAL;
5514
5515         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5516
5517         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
5518                 params.supported_rates =
5519                         nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5520                 params.supported_rates_len =
5521                         nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5522         }
5523
5524         if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5525                 params.capability =
5526                         nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5527                 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5528         }
5529
5530         if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5531                 params.ext_capab =
5532                         nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5533                 params.ext_capab_len =
5534                         nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5535         }
5536
5537         if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5538                 return -EINVAL;
5539
5540         if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
5541                 params.plink_action =
5542                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5543
5544         if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
5545                 params.plink_state =
5546                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
5547                 if (info->attrs[NL80211_ATTR_MESH_PEER_AID])
5548                         params.peer_aid = nla_get_u16(
5549                                 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
5550                 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
5551         }
5552
5553         if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE])
5554                 params.local_pm = nla_get_u32(
5555                         info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
5556
5557         if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5558                 params.opmode_notif_used = true;
5559                 params.opmode_notif =
5560                         nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5561         }
5562
5563         if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
5564                 params.airtime_weight =
5565                         nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
5566
5567         if (params.airtime_weight &&
5568             !wiphy_ext_feature_isset(&rdev->wiphy,
5569                                      NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
5570                 return -EOPNOTSUPP;
5571
5572         err = nl80211_parse_sta_txpower_setting(info, &params);
5573         if (err)
5574                 return err;
5575
5576         /* Include parameters for TDLS peer (will check later) */
5577         err = nl80211_set_station_tdls(info, &params);
5578         if (err)
5579                 return err;
5580
5581         params.vlan = get_vlan(info, rdev);
5582         if (IS_ERR(params.vlan))
5583                 return PTR_ERR(params.vlan);
5584
5585         switch (dev->ieee80211_ptr->iftype) {
5586         case NL80211_IFTYPE_AP:
5587         case NL80211_IFTYPE_AP_VLAN:
5588         case NL80211_IFTYPE_P2P_GO:
5589         case NL80211_IFTYPE_P2P_CLIENT:
5590         case NL80211_IFTYPE_STATION:
5591         case NL80211_IFTYPE_ADHOC:
5592         case NL80211_IFTYPE_MESH_POINT:
5593                 break;
5594         default:
5595                 err = -EOPNOTSUPP;
5596                 goto out_put_vlan;
5597         }
5598
5599         /* driver will call cfg80211_check_station_change() */
5600         err = rdev_change_station(rdev, dev, mac_addr, &params);
5601
5602  out_put_vlan:
5603         if (params.vlan)
5604                 dev_put(params.vlan);
5605
5606         return err;
5607 }
5608
5609 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
5610 {
5611         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5612         int err;
5613         struct net_device *dev = info->user_ptr[1];
5614         struct station_parameters params;
5615         u8 *mac_addr = NULL;
5616         u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
5617                          BIT(NL80211_STA_FLAG_ASSOCIATED);
5618
5619         memset(&params, 0, sizeof(params));
5620
5621         if (!rdev->ops->add_station)
5622                 return -EOPNOTSUPP;
5623
5624         if (!info->attrs[NL80211_ATTR_MAC])
5625                 return -EINVAL;
5626
5627         if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
5628                 return -EINVAL;
5629
5630         if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
5631                 return -EINVAL;
5632
5633         if (!info->attrs[NL80211_ATTR_STA_AID] &&
5634             !info->attrs[NL80211_ATTR_PEER_AID])
5635                 return -EINVAL;
5636
5637         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
5638         params.supported_rates =
5639                 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5640         params.supported_rates_len =
5641                 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
5642         params.listen_interval =
5643                 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
5644
5645         if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
5646                 params.support_p2p_ps =
5647                         nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
5648         } else {
5649                 /*
5650                  * if not specified, assume it's supported for P2P GO interface,
5651                  * and is NOT supported for AP interface
5652                  */
5653                 params.support_p2p_ps =
5654                         dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
5655         }
5656
5657         if (info->attrs[NL80211_ATTR_PEER_AID])
5658                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
5659         else
5660                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
5661
5662         if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
5663                 params.capability =
5664                         nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
5665                 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
5666         }
5667
5668         if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
5669                 params.ext_capab =
5670                         nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5671                 params.ext_capab_len =
5672                         nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
5673         }
5674
5675         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
5676                 params.ht_capa =
5677                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
5678
5679         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
5680                 params.vht_capa =
5681                         nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
5682
5683         if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
5684                 params.he_capa =
5685                         nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5686                 params.he_capa_len =
5687                         nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
5688
5689                 /* max len is validated in nla policy */
5690                 if (params.he_capa_len < NL80211_HE_MIN_CAPABILITY_LEN)
5691                         return -EINVAL;
5692         }
5693
5694         if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
5695                 params.opmode_notif_used = true;
5696                 params.opmode_notif =
5697                         nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
5698         }
5699
5700         if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
5701                 params.plink_action =
5702                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
5703
5704         if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
5705                 params.airtime_weight =
5706                         nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
5707
5708         if (params.airtime_weight &&
5709             !wiphy_ext_feature_isset(&rdev->wiphy,
5710                                      NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
5711                 return -EOPNOTSUPP;
5712
5713         err = nl80211_parse_sta_txpower_setting(info, &params);
5714         if (err)
5715                 return err;
5716
5717         err = nl80211_parse_sta_channel_info(info, &params);
5718         if (err)
5719                 return err;
5720
5721         err = nl80211_parse_sta_wme(info, &params);
5722         if (err)
5723                 return err;
5724
5725         if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
5726                 return -EINVAL;
5727
5728         /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
5729          * as userspace might just pass through the capabilities from the IEs
5730          * directly, rather than enforcing this restriction and returning an
5731          * error in this case.
5732          */
5733         if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
5734                 params.ht_capa = NULL;
5735                 params.vht_capa = NULL;
5736
5737                 /* HE requires WME */
5738                 if (params.he_capa_len)
5739                         return -EINVAL;
5740         }
5741
5742         /* When you run into this, adjust the code below for the new flag */
5743         BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
5744
5745         switch (dev->ieee80211_ptr->iftype) {
5746         case NL80211_IFTYPE_AP:
5747         case NL80211_IFTYPE_AP_VLAN:
5748         case NL80211_IFTYPE_P2P_GO:
5749                 /* ignore WME attributes if iface/sta is not capable */
5750                 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
5751                     !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
5752                         params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5753
5754                 /* TDLS peers cannot be added */
5755                 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5756                     info->attrs[NL80211_ATTR_PEER_AID])
5757                         return -EINVAL;
5758                 /* but don't bother the driver with it */
5759                 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
5760
5761                 /* allow authenticated/associated only if driver handles it */
5762                 if (!(rdev->wiphy.features &
5763                                 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
5764                     params.sta_flags_mask & auth_assoc)
5765                         return -EINVAL;
5766
5767                 /* Older userspace, or userspace wanting to be compatible with
5768                  * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5769                  * and assoc flags in the mask, but assumes the station will be
5770                  * added as associated anyway since this was the required driver
5771                  * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5772                  * introduced.
5773                  * In order to not bother drivers with this quirk in the API
5774                  * set the flags in both the mask and set for new stations in
5775                  * this case.
5776                  */
5777                 if (!(params.sta_flags_mask & auth_assoc)) {
5778                         params.sta_flags_mask |= auth_assoc;
5779                         params.sta_flags_set |= auth_assoc;
5780                 }
5781
5782                 /* must be last in here for error handling */
5783                 params.vlan = get_vlan(info, rdev);
5784                 if (IS_ERR(params.vlan))
5785                         return PTR_ERR(params.vlan);
5786                 break;
5787         case NL80211_IFTYPE_MESH_POINT:
5788                 /* ignore uAPSD data */
5789                 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5790
5791                 /* associated is disallowed */
5792                 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
5793                         return -EINVAL;
5794                 /* TDLS peers cannot be added */
5795                 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5796                     info->attrs[NL80211_ATTR_PEER_AID])
5797                         return -EINVAL;
5798                 break;
5799         case NL80211_IFTYPE_STATION:
5800         case NL80211_IFTYPE_P2P_CLIENT:
5801                 /* ignore uAPSD data */
5802                 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5803
5804                 /* these are disallowed */
5805                 if (params.sta_flags_mask &
5806                                 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
5807                                  BIT(NL80211_STA_FLAG_AUTHENTICATED)))
5808                         return -EINVAL;
5809                 /* Only TDLS peers can be added */
5810                 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5811                         return -EINVAL;
5812                 /* Can only add if TDLS ... */
5813                 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
5814                         return -EOPNOTSUPP;
5815                 /* ... with external setup is supported */
5816                 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
5817                         return -EOPNOTSUPP;
5818                 /*
5819                  * Older wpa_supplicant versions always mark the TDLS peer
5820                  * as authorized, but it shouldn't yet be.
5821                  */
5822                 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
5823                 break;
5824         default:
5825                 return -EOPNOTSUPP;
5826         }
5827
5828         /* be aware of params.vlan when changing code here */
5829
5830         err = rdev_add_station(rdev, dev, mac_addr, &params);
5831
5832         if (params.vlan)
5833                 dev_put(params.vlan);
5834         return err;
5835 }
5836
5837 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
5838 {
5839         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5840         struct net_device *dev = info->user_ptr[1];
5841         struct station_del_parameters params;
5842
5843         memset(&params, 0, sizeof(params));
5844
5845         if (info->attrs[NL80211_ATTR_MAC])
5846                 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
5847
5848         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5849             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5850             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
5851             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5852                 return -EINVAL;
5853
5854         if (!rdev->ops->del_station)
5855                 return -EOPNOTSUPP;
5856
5857         if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
5858                 params.subtype =
5859                         nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
5860                 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
5861                     params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
5862                         return -EINVAL;
5863         } else {
5864                 /* Default to Deauthentication frame */
5865                 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
5866         }
5867
5868         if (info->attrs[NL80211_ATTR_REASON_CODE]) {
5869                 params.reason_code =
5870                         nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5871                 if (params.reason_code == 0)
5872                         return -EINVAL; /* 0 is reserved */
5873         } else {
5874                 /* Default to reason code 2 */
5875                 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
5876         }
5877
5878         return rdev_del_station(rdev, dev, &params);
5879 }
5880
5881 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
5882                                 int flags, struct net_device *dev,
5883                                 u8 *dst, u8 *next_hop,
5884                                 struct mpath_info *pinfo)
5885 {
5886         void *hdr;
5887         struct nlattr *pinfoattr;
5888
5889         hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
5890         if (!hdr)
5891                 return -1;
5892
5893         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5894             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
5895             nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
5896             nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
5897                 goto nla_put_failure;
5898
5899         pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO);
5900         if (!pinfoattr)
5901                 goto nla_put_failure;
5902         if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
5903             nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
5904                         pinfo->frame_qlen))
5905                 goto nla_put_failure;
5906         if (((pinfo->filled & MPATH_INFO_SN) &&
5907              nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
5908             ((pinfo->filled & MPATH_INFO_METRIC) &&
5909              nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
5910                          pinfo->metric)) ||
5911             ((pinfo->filled & MPATH_INFO_EXPTIME) &&
5912              nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
5913                          pinfo->exptime)) ||
5914             ((pinfo->filled & MPATH_INFO_FLAGS) &&
5915              nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
5916                         pinfo->flags)) ||
5917             ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
5918              nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
5919                          pinfo->discovery_timeout)) ||
5920             ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
5921              nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
5922                         pinfo->discovery_retries)) ||
5923             ((pinfo->filled & MPATH_INFO_HOP_COUNT) &&
5924              nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT,
5925                         pinfo->hop_count)) ||
5926             ((pinfo->filled & MPATH_INFO_PATH_CHANGE) &&
5927              nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE,
5928                          pinfo->path_change_count)))
5929                 goto nla_put_failure;
5930
5931         nla_nest_end(msg, pinfoattr);
5932
5933         genlmsg_end(msg, hdr);
5934         return 0;
5935
5936  nla_put_failure:
5937         genlmsg_cancel(msg, hdr);
5938         return -EMSGSIZE;
5939 }
5940
5941 static int nl80211_dump_mpath(struct sk_buff *skb,
5942                               struct netlink_callback *cb)
5943 {
5944         struct mpath_info pinfo;
5945         struct cfg80211_registered_device *rdev;
5946         struct wireless_dev *wdev;
5947         u8 dst[ETH_ALEN];
5948         u8 next_hop[ETH_ALEN];
5949         int path_idx = cb->args[2];
5950         int err;
5951
5952         rtnl_lock();
5953         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
5954         if (err)
5955                 goto out_err;
5956
5957         if (!rdev->ops->dump_mpath) {
5958                 err = -EOPNOTSUPP;
5959                 goto out_err;
5960         }
5961
5962         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5963                 err = -EOPNOTSUPP;
5964                 goto out_err;
5965         }
5966
5967         while (1) {
5968                 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
5969                                       next_hop, &pinfo);
5970                 if (err == -ENOENT)
5971                         break;
5972                 if (err)
5973                         goto out_err;
5974
5975                 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5976                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
5977                                        wdev->netdev, dst, next_hop,
5978                                        &pinfo) < 0)
5979                         goto out;
5980
5981                 path_idx++;
5982         }
5983
5984  out:
5985         cb->args[2] = path_idx;
5986         err = skb->len;
5987  out_err:
5988         rtnl_unlock();
5989         return err;
5990 }
5991
5992 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
5993 {
5994         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5995         int err;
5996         struct net_device *dev = info->user_ptr[1];
5997         struct mpath_info pinfo;
5998         struct sk_buff *msg;
5999         u8 *dst = NULL;
6000         u8 next_hop[ETH_ALEN];
6001
6002         memset(&pinfo, 0, sizeof(pinfo));
6003
6004         if (!info->attrs[NL80211_ATTR_MAC])
6005                 return -EINVAL;
6006
6007         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6008
6009         if (!rdev->ops->get_mpath)
6010                 return -EOPNOTSUPP;
6011
6012         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6013                 return -EOPNOTSUPP;
6014
6015         err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
6016         if (err)
6017                 return err;
6018
6019         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6020         if (!msg)
6021                 return -ENOMEM;
6022
6023         if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
6024                                  dev, dst, next_hop, &pinfo) < 0) {
6025                 nlmsg_free(msg);
6026                 return -ENOBUFS;
6027         }
6028
6029         return genlmsg_reply(msg, info);
6030 }
6031
6032 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
6033 {
6034         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6035         struct net_device *dev = info->user_ptr[1];
6036         u8 *dst = NULL;
6037         u8 *next_hop = NULL;
6038
6039         if (!info->attrs[NL80211_ATTR_MAC])
6040                 return -EINVAL;
6041
6042         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
6043                 return -EINVAL;
6044
6045         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6046         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
6047
6048         if (!rdev->ops->change_mpath)
6049                 return -EOPNOTSUPP;
6050
6051         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6052                 return -EOPNOTSUPP;
6053
6054         return rdev_change_mpath(rdev, dev, dst, next_hop);
6055 }
6056
6057 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
6058 {
6059         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6060         struct net_device *dev = info->user_ptr[1];
6061         u8 *dst = NULL;
6062         u8 *next_hop = NULL;
6063
6064         if (!info->attrs[NL80211_ATTR_MAC])
6065                 return -EINVAL;
6066
6067         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
6068                 return -EINVAL;
6069
6070         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6071         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
6072
6073         if (!rdev->ops->add_mpath)
6074                 return -EOPNOTSUPP;
6075
6076         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6077                 return -EOPNOTSUPP;
6078
6079         return rdev_add_mpath(rdev, dev, dst, next_hop);
6080 }
6081
6082 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
6083 {
6084         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6085         struct net_device *dev = info->user_ptr[1];
6086         u8 *dst = NULL;
6087
6088         if (info->attrs[NL80211_ATTR_MAC])
6089                 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6090
6091         if (!rdev->ops->del_mpath)
6092                 return -EOPNOTSUPP;
6093
6094         return rdev_del_mpath(rdev, dev, dst);
6095 }
6096
6097 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
6098 {
6099         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6100         int err;
6101         struct net_device *dev = info->user_ptr[1];
6102         struct mpath_info pinfo;
6103         struct sk_buff *msg;
6104         u8 *dst = NULL;
6105         u8 mpp[ETH_ALEN];
6106
6107         memset(&pinfo, 0, sizeof(pinfo));
6108
6109         if (!info->attrs[NL80211_ATTR_MAC])
6110                 return -EINVAL;
6111
6112         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
6113
6114         if (!rdev->ops->get_mpp)
6115                 return -EOPNOTSUPP;
6116
6117         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
6118                 return -EOPNOTSUPP;
6119
6120         err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
6121         if (err)
6122                 return err;
6123
6124         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6125         if (!msg)
6126                 return -ENOMEM;
6127
6128         if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
6129                                dev, dst, mpp, &pinfo) < 0) {
6130                 nlmsg_free(msg);
6131                 return -ENOBUFS;
6132         }
6133
6134         return genlmsg_reply(msg, info);
6135 }
6136
6137 static int nl80211_dump_mpp(struct sk_buff *skb,
6138                             struct netlink_callback *cb)
6139 {
6140         struct mpath_info pinfo;
6141         struct cfg80211_registered_device *rdev;
6142         struct wireless_dev *wdev;
6143         u8 dst[ETH_ALEN];
6144         u8 mpp[ETH_ALEN];
6145         int path_idx = cb->args[2];
6146         int err;
6147
6148         rtnl_lock();
6149         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
6150         if (err)
6151                 goto out_err;
6152
6153         if (!rdev->ops->dump_mpp) {
6154                 err = -EOPNOTSUPP;
6155                 goto out_err;
6156         }
6157
6158         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
6159                 err = -EOPNOTSUPP;
6160                 goto out_err;
6161         }
6162
6163         while (1) {
6164                 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
6165                                     mpp, &pinfo);
6166                 if (err == -ENOENT)
6167                         break;
6168                 if (err)
6169                         goto out_err;
6170
6171                 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
6172                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
6173                                        wdev->netdev, dst, mpp,
6174                                        &pinfo) < 0)
6175                         goto out;
6176
6177                 path_idx++;
6178         }
6179
6180  out:
6181         cb->args[2] = path_idx;
6182         err = skb->len;
6183  out_err:
6184         rtnl_unlock();
6185         return err;
6186 }
6187
6188 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
6189 {
6190         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6191         struct net_device *dev = info->user_ptr[1];
6192         struct wireless_dev *wdev = dev->ieee80211_ptr;
6193         struct bss_parameters params;
6194         int err;
6195
6196         memset(&params, 0, sizeof(params));
6197         /* default to not changing parameters */
6198         params.use_cts_prot = -1;
6199         params.use_short_preamble = -1;
6200         params.use_short_slot_time = -1;
6201         params.ap_isolate = -1;
6202         params.ht_opmode = -1;
6203         params.p2p_ctwindow = -1;
6204         params.p2p_opp_ps = -1;
6205
6206         if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
6207                 params.use_cts_prot =
6208                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
6209         if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
6210                 params.use_short_preamble =
6211                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
6212         if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
6213                 params.use_short_slot_time =
6214                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
6215         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
6216                 params.basic_rates =
6217                         nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
6218                 params.basic_rates_len =
6219                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
6220         }
6221         if (info->attrs[NL80211_ATTR_AP_ISOLATE])
6222                 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
6223         if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
6224                 params.ht_opmode =
6225                         nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
6226
6227         if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
6228                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6229                         return -EINVAL;
6230                 params.p2p_ctwindow =
6231                         nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
6232                 if (params.p2p_ctwindow != 0 &&
6233                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
6234                         return -EINVAL;
6235         }
6236
6237         if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
6238                 u8 tmp;
6239
6240                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6241                         return -EINVAL;
6242                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
6243                 params.p2p_opp_ps = tmp;
6244                 if (params.p2p_opp_ps &&
6245                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
6246                         return -EINVAL;
6247         }
6248
6249         if (!rdev->ops->change_bss)
6250                 return -EOPNOTSUPP;
6251
6252         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
6253             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
6254                 return -EOPNOTSUPP;
6255
6256         wdev_lock(wdev);
6257         err = rdev_change_bss(rdev, dev, &params);
6258         wdev_unlock(wdev);
6259
6260         return err;
6261 }
6262
6263 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
6264 {
6265         char *data = NULL;
6266         bool is_indoor;
6267         enum nl80211_user_reg_hint_type user_reg_hint_type;
6268         u32 owner_nlportid;
6269
6270         /*
6271          * You should only get this when cfg80211 hasn't yet initialized
6272          * completely when built-in to the kernel right between the time
6273          * window between nl80211_init() and regulatory_init(), if that is
6274          * even possible.
6275          */
6276         if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
6277                 return -EINPROGRESS;
6278
6279         if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
6280                 user_reg_hint_type =
6281                   nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
6282         else
6283                 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
6284
6285         switch (user_reg_hint_type) {
6286         case NL80211_USER_REG_HINT_USER:
6287         case NL80211_USER_REG_HINT_CELL_BASE:
6288                 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6289                         return -EINVAL;
6290
6291                 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6292                 return regulatory_hint_user(data, user_reg_hint_type);
6293         case NL80211_USER_REG_HINT_INDOOR:
6294                 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
6295                         owner_nlportid = info->snd_portid;
6296                         is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
6297                 } else {
6298                         owner_nlportid = 0;
6299                         is_indoor = true;
6300                 }
6301
6302                 return regulatory_hint_indoor(is_indoor, owner_nlportid);
6303         default:
6304                 return -EINVAL;
6305         }
6306 }
6307
6308 static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
6309 {
6310         return reg_reload_regdb();
6311 }
6312
6313 static int nl80211_get_mesh_config(struct sk_buff *skb,
6314                                    struct genl_info *info)
6315 {
6316         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6317         struct net_device *dev = info->user_ptr[1];
6318         struct wireless_dev *wdev = dev->ieee80211_ptr;
6319         struct mesh_config cur_params;
6320         int err = 0;
6321         void *hdr;
6322         struct nlattr *pinfoattr;
6323         struct sk_buff *msg;
6324
6325         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6326                 return -EOPNOTSUPP;
6327
6328         if (!rdev->ops->get_mesh_config)
6329                 return -EOPNOTSUPP;
6330
6331         wdev_lock(wdev);
6332         /* If not connected, get default parameters */
6333         if (!wdev->mesh_id_len)
6334                 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
6335         else
6336                 err = rdev_get_mesh_config(rdev, dev, &cur_params);
6337         wdev_unlock(wdev);
6338
6339         if (err)
6340                 return err;
6341
6342         /* Draw up a netlink message to send back */
6343         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6344         if (!msg)
6345                 return -ENOMEM;
6346         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6347                              NL80211_CMD_GET_MESH_CONFIG);
6348         if (!hdr)
6349                 goto out;
6350         pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG);
6351         if (!pinfoattr)
6352                 goto nla_put_failure;
6353         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
6354             nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
6355                         cur_params.dot11MeshRetryTimeout) ||
6356             nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
6357                         cur_params.dot11MeshConfirmTimeout) ||
6358             nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
6359                         cur_params.dot11MeshHoldingTimeout) ||
6360             nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
6361                         cur_params.dot11MeshMaxPeerLinks) ||
6362             nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
6363                        cur_params.dot11MeshMaxRetries) ||
6364             nla_put_u8(msg, NL80211_MESHCONF_TTL,
6365                        cur_params.dot11MeshTTL) ||
6366             nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
6367                        cur_params.element_ttl) ||
6368             nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6369                        cur_params.auto_open_plinks) ||
6370             nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6371                         cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
6372             nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6373                        cur_params.dot11MeshHWMPmaxPREQretries) ||
6374             nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
6375                         cur_params.path_refresh_time) ||
6376             nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6377                         cur_params.min_discovery_timeout) ||
6378             nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6379                         cur_params.dot11MeshHWMPactivePathTimeout) ||
6380             nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6381                         cur_params.dot11MeshHWMPpreqMinInterval) ||
6382             nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6383                         cur_params.dot11MeshHWMPperrMinInterval) ||
6384             nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6385                         cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
6386             nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
6387                        cur_params.dot11MeshHWMPRootMode) ||
6388             nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6389                         cur_params.dot11MeshHWMPRannInterval) ||
6390             nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6391                        cur_params.dot11MeshGateAnnouncementProtocol) ||
6392             nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
6393                        cur_params.dot11MeshForwarding) ||
6394             nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
6395                         cur_params.rssi_threshold) ||
6396             nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
6397                         cur_params.ht_opmode) ||
6398             nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6399                         cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
6400             nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6401                         cur_params.dot11MeshHWMProotInterval) ||
6402             nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6403                         cur_params.dot11MeshHWMPconfirmationInterval) ||
6404             nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
6405                         cur_params.power_mode) ||
6406             nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
6407                         cur_params.dot11MeshAwakeWindowDuration) ||
6408             nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
6409                         cur_params.plink_timeout) ||
6410             nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE,
6411                        cur_params.dot11MeshConnectedToMeshGate))
6412                 goto nla_put_failure;
6413         nla_nest_end(msg, pinfoattr);
6414         genlmsg_end(msg, hdr);
6415         return genlmsg_reply(msg, info);
6416
6417  nla_put_failure:
6418  out:
6419         nlmsg_free(msg);
6420         return -ENOBUFS;
6421 }
6422
6423 static const struct nla_policy
6424 nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
6425         [NL80211_MESHCONF_RETRY_TIMEOUT] =
6426                 NLA_POLICY_RANGE(NLA_U16, 1, 255),
6427         [NL80211_MESHCONF_CONFIRM_TIMEOUT] =
6428                 NLA_POLICY_RANGE(NLA_U16, 1, 255),
6429         [NL80211_MESHCONF_HOLDING_TIMEOUT] =
6430                 NLA_POLICY_RANGE(NLA_U16, 1, 255),
6431         [NL80211_MESHCONF_MAX_PEER_LINKS] =
6432                 NLA_POLICY_RANGE(NLA_U16, 0, 255),
6433         [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16),
6434         [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
6435         [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
6436         [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1),
6437         [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] =
6438                 NLA_POLICY_RANGE(NLA_U32, 1, 255),
6439         [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
6440         [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
6441         [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1),
6442         [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
6443         [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] =
6444                 NLA_POLICY_MIN(NLA_U16, 1),
6445         [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] =
6446                 NLA_POLICY_MIN(NLA_U16, 1),
6447         [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] =
6448                 NLA_POLICY_MIN(NLA_U16, 1),
6449         [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4),
6450         [NL80211_MESHCONF_HWMP_RANN_INTERVAL] =
6451                 NLA_POLICY_MIN(NLA_U16, 1),
6452         [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1),
6453         [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1),
6454         [NL80211_MESHCONF_RSSI_THRESHOLD] =
6455                 NLA_POLICY_RANGE(NLA_S32, -255, 0),
6456         [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
6457         [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
6458         [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] =
6459                 NLA_POLICY_MIN(NLA_U16, 1),
6460         [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] =
6461                 NLA_POLICY_MIN(NLA_U16, 1),
6462         [NL80211_MESHCONF_POWER_MODE] =
6463                 NLA_POLICY_RANGE(NLA_U32,
6464                                  NL80211_MESH_POWER_ACTIVE,
6465                                  NL80211_MESH_POWER_MAX),
6466         [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
6467         [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
6468         [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
6469 };
6470
6471 static const struct nla_policy
6472         nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
6473         [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
6474         [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
6475         [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
6476         [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
6477         [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
6478         [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
6479         [NL80211_MESH_SETUP_IE] =
6480                 NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
6481                                        IEEE80211_MAX_DATA_LEN),
6482         [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
6483 };
6484
6485 static int nl80211_parse_mesh_config(struct genl_info *info,
6486                                      struct mesh_config *cfg,
6487                                      u32 *mask_out)
6488 {
6489         struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
6490         u32 mask = 0;
6491         u16 ht_opmode;
6492
6493 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn)       \
6494 do {                                                                    \
6495         if (tb[attr]) {                                                 \
6496                 cfg->param = fn(tb[attr]);                              \
6497                 mask |= BIT((attr) - 1);                                \
6498         }                                                               \
6499 } while (0)
6500
6501         if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
6502                 return -EINVAL;
6503         if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack))
6504                 return -EINVAL;
6505
6506         /* This makes sure that there aren't more than 32 mesh config
6507          * parameters (otherwise our bitfield scheme would not work.) */
6508         BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
6509
6510         /* Fill in the params struct */
6511         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask,
6512                                   NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
6513         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask,
6514                                   NL80211_MESHCONF_CONFIRM_TIMEOUT,
6515                                   nla_get_u16);
6516         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask,
6517                                   NL80211_MESHCONF_HOLDING_TIMEOUT,
6518                                   nla_get_u16);
6519         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask,
6520                                   NL80211_MESHCONF_MAX_PEER_LINKS,
6521                                   nla_get_u16);
6522         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask,
6523                                   NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
6524         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask,
6525                                   NL80211_MESHCONF_TTL, nla_get_u8);
6526         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask,
6527                                   NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8);
6528         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask,
6529                                   NL80211_MESHCONF_AUTO_OPEN_PLINKS,
6530                                   nla_get_u8);
6531         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
6532                                   mask,
6533                                   NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
6534                                   nla_get_u32);
6535         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask,
6536                                   NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
6537                                   nla_get_u8);
6538         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask,
6539                                   NL80211_MESHCONF_PATH_REFRESH_TIME,
6540                                   nla_get_u32);
6541         if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) &&
6542             (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535))
6543                 return -EINVAL;
6544         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask,
6545                                   NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
6546                                   nla_get_u16);
6547         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
6548                                   mask,
6549                                   NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
6550                                   nla_get_u32);
6551         if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) &&
6552             (cfg->dot11MeshHWMPactivePathTimeout < 1 ||
6553              cfg->dot11MeshHWMPactivePathTimeout > 65535))
6554                 return -EINVAL;
6555         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask,
6556                                   NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
6557                                   nla_get_u16);
6558         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask,
6559                                   NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
6560                                   nla_get_u16);
6561         FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6562                                   dot11MeshHWMPnetDiameterTraversalTime, mask,
6563                                   NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
6564                                   nla_get_u16);
6565         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask,
6566                                   NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8);
6567         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask,
6568                                   NL80211_MESHCONF_HWMP_RANN_INTERVAL,
6569                                   nla_get_u16);
6570         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol,
6571                                   mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
6572                                   nla_get_u8);
6573         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask,
6574                                   NL80211_MESHCONF_FORWARDING, nla_get_u8);
6575         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask,
6576                                   NL80211_MESHCONF_RSSI_THRESHOLD,
6577                                   nla_get_s32);
6578         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask,
6579                                   NL80211_MESHCONF_CONNECTED_TO_GATE,
6580                                   nla_get_u8);
6581         /*
6582          * Check HT operation mode based on
6583          * IEEE 802.11-2016 9.4.2.57 HT Operation element.
6584          */
6585         if (tb[NL80211_MESHCONF_HT_OPMODE]) {
6586                 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
6587
6588                 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
6589                                   IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
6590                                   IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
6591                         return -EINVAL;
6592
6593                 /* NON_HT_STA bit is reserved, but some programs set it */
6594                 ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
6595
6596                 cfg->ht_opmode = ht_opmode;
6597                 mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
6598         }
6599         FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
6600                                   dot11MeshHWMPactivePathToRootTimeout, mask,
6601                                   NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
6602                                   nla_get_u32);
6603         if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) &&
6604             (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 ||
6605              cfg->dot11MeshHWMPactivePathToRootTimeout > 65535))
6606                 return -EINVAL;
6607         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask,
6608                                   NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
6609                                   nla_get_u16);
6610         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval,
6611                                   mask,
6612                                   NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
6613                                   nla_get_u16);
6614         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask,
6615                                   NL80211_MESHCONF_POWER_MODE, nla_get_u32);
6616         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask,
6617                                   NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
6618         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask,
6619                                   NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32);
6620         if (mask_out)
6621                 *mask_out = mask;
6622
6623         return 0;
6624
6625 #undef FILL_IN_MESH_PARAM_IF_SET
6626 }
6627
6628 static int nl80211_parse_mesh_setup(struct genl_info *info,
6629                                      struct mesh_setup *setup)
6630 {
6631         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6632         struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
6633
6634         if (!info->attrs[NL80211_ATTR_MESH_SETUP])
6635                 return -EINVAL;
6636         if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack))
6637                 return -EINVAL;
6638
6639         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
6640                 setup->sync_method =
6641                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
6642                  IEEE80211_SYNC_METHOD_VENDOR :
6643                  IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
6644
6645         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
6646                 setup->path_sel_proto =
6647                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
6648                  IEEE80211_PATH_PROTOCOL_VENDOR :
6649                  IEEE80211_PATH_PROTOCOL_HWMP;
6650
6651         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
6652                 setup->path_metric =
6653                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
6654                  IEEE80211_PATH_METRIC_VENDOR :
6655                  IEEE80211_PATH_METRIC_AIRTIME;
6656
6657         if (tb[NL80211_MESH_SETUP_IE]) {
6658                 struct nlattr *ieattr =
6659                         tb[NL80211_MESH_SETUP_IE];
6660                 setup->ie = nla_data(ieattr);
6661                 setup->ie_len = nla_len(ieattr);
6662         }
6663         if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
6664             !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
6665                 return -EINVAL;
6666         setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
6667         setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
6668         setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
6669         if (setup->is_secure)
6670                 setup->user_mpm = true;
6671
6672         if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
6673                 if (!setup->user_mpm)
6674                         return -EINVAL;
6675                 setup->auth_id =
6676                         nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
6677         }
6678
6679         return 0;
6680 }
6681
6682 static int nl80211_update_mesh_config(struct sk_buff *skb,
6683                                       struct genl_info *info)
6684 {
6685         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6686         struct net_device *dev = info->user_ptr[1];
6687         struct wireless_dev *wdev = dev->ieee80211_ptr;
6688         struct mesh_config cfg;
6689         u32 mask;
6690         int err;
6691
6692         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
6693                 return -EOPNOTSUPP;
6694
6695         if (!rdev->ops->update_mesh_config)
6696                 return -EOPNOTSUPP;
6697
6698         err = nl80211_parse_mesh_config(info, &cfg, &mask);
6699         if (err)
6700                 return err;
6701
6702         wdev_lock(wdev);
6703         if (!wdev->mesh_id_len)
6704                 err = -ENOLINK;
6705
6706         if (!err)
6707                 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
6708
6709         wdev_unlock(wdev);
6710
6711         return err;
6712 }
6713
6714 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
6715                               struct sk_buff *msg)
6716 {
6717         struct nlattr *nl_reg_rules;
6718         unsigned int i;
6719
6720         if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6721             (regdom->dfs_region &&
6722              nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
6723                 goto nla_put_failure;
6724
6725         nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES);
6726         if (!nl_reg_rules)
6727                 goto nla_put_failure;
6728
6729         for (i = 0; i < regdom->n_reg_rules; i++) {
6730                 struct nlattr *nl_reg_rule;
6731                 const struct ieee80211_reg_rule *reg_rule;
6732                 const struct ieee80211_freq_range *freq_range;
6733                 const struct ieee80211_power_rule *power_rule;
6734                 unsigned int max_bandwidth_khz;
6735
6736                 reg_rule = &regdom->reg_rules[i];
6737                 freq_range = &reg_rule->freq_range;
6738                 power_rule = &reg_rule->power_rule;
6739
6740                 nl_reg_rule = nla_nest_start_noflag(msg, i);
6741                 if (!nl_reg_rule)
6742                         goto nla_put_failure;
6743
6744                 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6745                 if (!max_bandwidth_khz)
6746                         max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6747                                                                   reg_rule);
6748
6749                 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6750                                 reg_rule->flags) ||
6751                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6752                                 freq_range->start_freq_khz) ||
6753                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6754                                 freq_range->end_freq_khz) ||
6755                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
6756                                 max_bandwidth_khz) ||
6757                     nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6758                                 power_rule->max_antenna_gain) ||
6759                     nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
6760                                 power_rule->max_eirp) ||
6761                     nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6762                                 reg_rule->dfs_cac_ms))
6763                         goto nla_put_failure;
6764
6765                 nla_nest_end(msg, nl_reg_rule);
6766         }
6767
6768         nla_nest_end(msg, nl_reg_rules);
6769         return 0;
6770
6771 nla_put_failure:
6772         return -EMSGSIZE;
6773 }
6774
6775 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
6776 {
6777         const struct ieee80211_regdomain *regdom = NULL;
6778         struct cfg80211_registered_device *rdev;
6779         struct wiphy *wiphy = NULL;
6780         struct sk_buff *msg;
6781         void *hdr;
6782
6783         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6784         if (!msg)
6785                 return -ENOBUFS;
6786
6787         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6788                              NL80211_CMD_GET_REG);
6789         if (!hdr)
6790                 goto put_failure;
6791
6792         if (info->attrs[NL80211_ATTR_WIPHY]) {
6793                 bool self_managed;
6794
6795                 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
6796                 if (IS_ERR(rdev)) {
6797                         nlmsg_free(msg);
6798                         return PTR_ERR(rdev);
6799                 }
6800
6801                 wiphy = &rdev->wiphy;
6802                 self_managed = wiphy->regulatory_flags &
6803                                REGULATORY_WIPHY_SELF_MANAGED;
6804                 regdom = get_wiphy_regdom(wiphy);
6805
6806                 /* a self-managed-reg device must have a private regdom */
6807                 if (WARN_ON(!regdom && self_managed)) {
6808                         nlmsg_free(msg);
6809                         return -EINVAL;
6810                 }
6811
6812                 if (regdom &&
6813                     nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6814                         goto nla_put_failure;
6815         }
6816
6817         if (!wiphy && reg_last_request_cell_base() &&
6818             nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6819                         NL80211_USER_REG_HINT_CELL_BASE))
6820                 goto nla_put_failure;
6821
6822         rcu_read_lock();
6823
6824         if (!regdom)
6825                 regdom = rcu_dereference(cfg80211_regdomain);
6826
6827         if (nl80211_put_regdom(regdom, msg))
6828                 goto nla_put_failure_rcu;
6829
6830         rcu_read_unlock();
6831
6832         genlmsg_end(msg, hdr);
6833         return genlmsg_reply(msg, info);
6834
6835 nla_put_failure_rcu:
6836         rcu_read_unlock();
6837 nla_put_failure:
6838 put_failure:
6839         nlmsg_free(msg);
6840         return -EMSGSIZE;
6841 }
6842
6843 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
6844                                u32 seq, int flags, struct wiphy *wiphy,
6845                                const struct ieee80211_regdomain *regdom)
6846 {
6847         void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
6848                                    NL80211_CMD_GET_REG);
6849
6850         if (!hdr)
6851                 return -1;
6852
6853         genl_dump_check_consistent(cb, hdr);
6854
6855         if (nl80211_put_regdom(regdom, msg))
6856                 goto nla_put_failure;
6857
6858         if (!wiphy && reg_last_request_cell_base() &&
6859             nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6860                         NL80211_USER_REG_HINT_CELL_BASE))
6861                 goto nla_put_failure;
6862
6863         if (wiphy &&
6864             nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6865                 goto nla_put_failure;
6866
6867         if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
6868             nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
6869                 goto nla_put_failure;
6870
6871         genlmsg_end(msg, hdr);
6872         return 0;
6873
6874 nla_put_failure:
6875         genlmsg_cancel(msg, hdr);
6876         return -EMSGSIZE;
6877 }
6878
6879 static int nl80211_get_reg_dump(struct sk_buff *skb,
6880                                 struct netlink_callback *cb)
6881 {
6882         const struct ieee80211_regdomain *regdom = NULL;
6883         struct cfg80211_registered_device *rdev;
6884         int err, reg_idx, start = cb->args[2];
6885
6886         rtnl_lock();
6887
6888         if (cfg80211_regdomain && start == 0) {
6889                 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6890                                           NLM_F_MULTI, NULL,
6891                                           rtnl_dereference(cfg80211_regdomain));
6892                 if (err < 0)
6893                         goto out_err;
6894         }
6895
6896         /* the global regdom is idx 0 */
6897         reg_idx = 1;
6898         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
6899                 regdom = get_wiphy_regdom(&rdev->wiphy);
6900                 if (!regdom)
6901                         continue;
6902
6903                 if (++reg_idx <= start)
6904                         continue;
6905
6906                 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6907                                           NLM_F_MULTI, &rdev->wiphy, regdom);
6908                 if (err < 0) {
6909                         reg_idx--;
6910                         break;
6911                 }
6912         }
6913
6914         cb->args[2] = reg_idx;
6915         err = skb->len;
6916 out_err:
6917         rtnl_unlock();
6918         return err;
6919 }
6920
6921 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
6922 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
6923         [NL80211_ATTR_REG_RULE_FLAGS]           = { .type = NLA_U32 },
6924         [NL80211_ATTR_FREQ_RANGE_START]         = { .type = NLA_U32 },
6925         [NL80211_ATTR_FREQ_RANGE_END]           = { .type = NLA_U32 },
6926         [NL80211_ATTR_FREQ_RANGE_MAX_BW]        = { .type = NLA_U32 },
6927         [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]  = { .type = NLA_U32 },
6928         [NL80211_ATTR_POWER_RULE_MAX_EIRP]      = { .type = NLA_U32 },
6929         [NL80211_ATTR_DFS_CAC_TIME]             = { .type = NLA_U32 },
6930 };
6931
6932 static int parse_reg_rule(struct nlattr *tb[],
6933         struct ieee80211_reg_rule *reg_rule)
6934 {
6935         struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
6936         struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
6937
6938         if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
6939                 return -EINVAL;
6940         if (!tb[NL80211_ATTR_FREQ_RANGE_START])
6941                 return -EINVAL;
6942         if (!tb[NL80211_ATTR_FREQ_RANGE_END])
6943                 return -EINVAL;
6944         if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
6945                 return -EINVAL;
6946         if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
6947                 return -EINVAL;
6948
6949         reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
6950
6951         freq_range->start_freq_khz =
6952                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
6953         freq_range->end_freq_khz =
6954                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
6955         freq_range->max_bandwidth_khz =
6956                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
6957
6958         power_rule->max_eirp =
6959                 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
6960
6961         if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
6962                 power_rule->max_antenna_gain =
6963                         nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
6964
6965         if (tb[NL80211_ATTR_DFS_CAC_TIME])
6966                 reg_rule->dfs_cac_ms =
6967                         nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
6968
6969         return 0;
6970 }
6971
6972 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
6973 {
6974         struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
6975         struct nlattr *nl_reg_rule;
6976         char *alpha2;
6977         int rem_reg_rules, r;
6978         u32 num_rules = 0, rule_idx = 0;
6979         enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
6980         struct ieee80211_regdomain *rd;
6981
6982         if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6983                 return -EINVAL;
6984
6985         if (!info->attrs[NL80211_ATTR_REG_RULES])
6986                 return -EINVAL;
6987
6988         alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6989
6990         if (info->attrs[NL80211_ATTR_DFS_REGION])
6991                 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
6992
6993         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
6994                             rem_reg_rules) {
6995                 num_rules++;
6996                 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
6997                         return -EINVAL;
6998         }
6999
7000         if (!reg_is_valid_request(alpha2))
7001                 return -EINVAL;
7002
7003         rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL);
7004         if (!rd)
7005                 return -ENOMEM;
7006
7007         rd->n_reg_rules = num_rules;
7008         rd->alpha2[0] = alpha2[0];
7009         rd->alpha2[1] = alpha2[1];
7010
7011         /*
7012          * Disable DFS master mode if the DFS region was
7013          * not supported or known on this kernel.
7014          */
7015         if (reg_supported_dfs_region(dfs_region))
7016                 rd->dfs_region = dfs_region;
7017
7018         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
7019                             rem_reg_rules) {
7020                 r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX,
7021                                                 nl_reg_rule, reg_rule_policy,
7022                                                 info->extack);
7023                 if (r)
7024                         goto bad_reg;
7025                 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
7026                 if (r)
7027                         goto bad_reg;
7028
7029                 rule_idx++;
7030
7031                 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
7032                         r = -EINVAL;
7033                         goto bad_reg;
7034                 }
7035         }
7036
7037         /* set_regdom takes ownership of rd */
7038         return set_regdom(rd, REGD_SOURCE_CRDA);
7039  bad_reg:
7040         kfree(rd);
7041         return r;
7042 }
7043 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
7044
7045 static int validate_scan_freqs(struct nlattr *freqs)
7046 {
7047         struct nlattr *attr1, *attr2;
7048         int n_channels = 0, tmp1, tmp2;
7049
7050         nla_for_each_nested(attr1, freqs, tmp1)
7051                 if (nla_len(attr1) != sizeof(u32))
7052                         return 0;
7053
7054         nla_for_each_nested(attr1, freqs, tmp1) {
7055                 n_channels++;
7056                 /*
7057                  * Some hardware has a limited channel list for
7058                  * scanning, and it is pretty much nonsensical
7059                  * to scan for a channel twice, so disallow that
7060                  * and don't require drivers to check that the
7061                  * channel list they get isn't longer than what
7062                  * they can scan, as long as they can scan all
7063                  * the channels they registered at once.
7064                  */
7065                 nla_for_each_nested(attr2, freqs, tmp2)
7066                         if (attr1 != attr2 &&
7067                             nla_get_u32(attr1) == nla_get_u32(attr2))
7068                                 return 0;
7069         }
7070
7071         return n_channels;
7072 }
7073
7074 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
7075 {
7076         return b < NUM_NL80211_BANDS && wiphy->bands[b];
7077 }
7078
7079 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
7080                             struct cfg80211_bss_selection *bss_select)
7081 {
7082         struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
7083         struct nlattr *nest;
7084         int err;
7085         bool found = false;
7086         int i;
7087
7088         /* only process one nested attribute */
7089         nest = nla_data(nla);
7090         if (!nla_ok(nest, nla_len(nest)))
7091                 return -EINVAL;
7092
7093         err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX,
7094                                           nest, nl80211_bss_select_policy,
7095                                           NULL);
7096         if (err)
7097                 return err;
7098
7099         /* only one attribute may be given */
7100         for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
7101                 if (attr[i]) {
7102                         if (found)
7103                                 return -EINVAL;
7104                         found = true;
7105                 }
7106         }
7107
7108         bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
7109
7110         if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
7111                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
7112
7113         if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
7114                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
7115                 bss_select->param.band_pref =
7116                         nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
7117                 if (!is_band_valid(wiphy, bss_select->param.band_pref))
7118                         return -EINVAL;
7119         }
7120
7121         if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
7122                 struct nl80211_bss_select_rssi_adjust *adj_param;
7123
7124                 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
7125                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
7126                 bss_select->param.adjust.band = adj_param->band;
7127                 bss_select->param.adjust.delta = adj_param->delta;
7128                 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
7129                         return -EINVAL;
7130         }
7131
7132         /* user-space did not provide behaviour attribute */
7133         if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
7134                 return -EINVAL;
7135
7136         if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
7137                 return -EINVAL;
7138
7139         return 0;
7140 }
7141
7142 int nl80211_parse_random_mac(struct nlattr **attrs,
7143                              u8 *mac_addr, u8 *mac_addr_mask)
7144 {
7145         int i;
7146
7147         if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
7148                 eth_zero_addr(mac_addr);
7149                 eth_zero_addr(mac_addr_mask);
7150                 mac_addr[0] = 0x2;
7151                 mac_addr_mask[0] = 0x3;
7152
7153                 return 0;
7154         }
7155
7156         /* need both or none */
7157         if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
7158                 return -EINVAL;
7159
7160         memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
7161         memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
7162
7163         /* don't allow or configure an mcast address */
7164         if (!is_multicast_ether_addr(mac_addr_mask) ||
7165             is_multicast_ether_addr(mac_addr))
7166                 return -EINVAL;
7167
7168         /*
7169          * allow users to pass a MAC address that has bits set outside
7170          * of the mask, but don't bother drivers with having to deal
7171          * with such bits
7172          */
7173         for (i = 0; i < ETH_ALEN; i++)
7174                 mac_addr[i] &= mac_addr_mask[i];
7175
7176         return 0;
7177 }
7178
7179 static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
7180 {
7181         ASSERT_WDEV_LOCK(wdev);
7182
7183         if (!cfg80211_beaconing_iface_active(wdev))
7184                 return true;
7185
7186         if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
7187                 return true;
7188
7189         return regulatory_pre_cac_allowed(wdev->wiphy);
7190 }
7191
7192 static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag,
7193                                     enum nl80211_ext_feature_index feat)
7194 {
7195         if (!(flags & flag))
7196                 return true;
7197         if (wiphy_ext_feature_isset(wiphy, feat))
7198                 return true;
7199         return false;
7200 }
7201
7202 static int
7203 nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
7204                          void *request, struct nlattr **attrs,
7205                          bool is_sched_scan)
7206 {
7207         u8 *mac_addr, *mac_addr_mask;
7208         u32 *flags;
7209         enum nl80211_feature_flags randomness_flag;
7210
7211         if (!attrs[NL80211_ATTR_SCAN_FLAGS])
7212                 return 0;
7213
7214         if (is_sched_scan) {
7215                 struct cfg80211_sched_scan_request *req = request;
7216
7217                 randomness_flag = wdev ?
7218                                   NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
7219                                   NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
7220                 flags = &req->flags;
7221                 mac_addr = req->mac_addr;
7222                 mac_addr_mask = req->mac_addr_mask;
7223         } else {
7224                 struct cfg80211_scan_request *req = request;
7225
7226                 randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
7227                 flags = &req->flags;
7228                 mac_addr = req->mac_addr;
7229                 mac_addr_mask = req->mac_addr_mask;
7230         }
7231
7232         *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
7233
7234         if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
7235              !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
7236             !nl80211_check_scan_feat(wiphy, *flags,
7237                                      NL80211_SCAN_FLAG_LOW_SPAN,
7238                                      NL80211_EXT_FEATURE_LOW_SPAN_SCAN) ||
7239             !nl80211_check_scan_feat(wiphy, *flags,
7240                                      NL80211_SCAN_FLAG_LOW_POWER,
7241                                      NL80211_EXT_FEATURE_LOW_POWER_SCAN) ||
7242             !nl80211_check_scan_feat(wiphy, *flags,
7243                                      NL80211_SCAN_FLAG_HIGH_ACCURACY,
7244                                      NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) ||
7245             !nl80211_check_scan_feat(wiphy, *flags,
7246                                      NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME,
7247                                      NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) ||
7248             !nl80211_check_scan_feat(wiphy, *flags,
7249                                      NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP,
7250                                      NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) ||
7251             !nl80211_check_scan_feat(wiphy, *flags,
7252                                      NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION,
7253                                      NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) ||
7254             !nl80211_check_scan_feat(wiphy, *flags,
7255                                      NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE,
7256                                      NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) ||
7257             !nl80211_check_scan_feat(wiphy, *flags,
7258                                      NL80211_SCAN_FLAG_RANDOM_SN,
7259                                      NL80211_EXT_FEATURE_SCAN_RANDOM_SN) ||
7260             !nl80211_check_scan_feat(wiphy, *flags,
7261                                      NL80211_SCAN_FLAG_MIN_PREQ_CONTENT,
7262                                      NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT))
7263                 return -EOPNOTSUPP;
7264
7265         if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
7266                 int err;
7267
7268                 if (!(wiphy->features & randomness_flag) ||
7269                     (wdev && wdev->current_bss))
7270                         return -EOPNOTSUPP;
7271
7272                 err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
7273                 if (err)
7274                         return err;
7275         }
7276
7277         return 0;
7278 }
7279
7280 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
7281 {
7282         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7283         struct wireless_dev *wdev = info->user_ptr[1];
7284         struct cfg80211_scan_request *request;
7285         struct nlattr *attr;
7286         struct wiphy *wiphy;
7287         int err, tmp, n_ssids = 0, n_channels, i;
7288         size_t ie_len;
7289
7290         wiphy = &rdev->wiphy;
7291
7292         if (wdev->iftype == NL80211_IFTYPE_NAN)
7293                 return -EOPNOTSUPP;
7294
7295         if (!rdev->ops->scan)
7296                 return -EOPNOTSUPP;
7297
7298         if (rdev->scan_req || rdev->scan_msg) {
7299                 err = -EBUSY;
7300                 goto unlock;
7301         }
7302
7303         if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7304                 n_channels = validate_scan_freqs(
7305                                 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7306                 if (!n_channels) {
7307                         err = -EINVAL;
7308                         goto unlock;
7309                 }
7310         } else {
7311                 n_channels = ieee80211_get_num_supported_channels(wiphy);
7312         }
7313
7314         if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
7315                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
7316                         n_ssids++;
7317
7318         if (n_ssids > wiphy->max_scan_ssids) {
7319                 err = -EINVAL;
7320                 goto unlock;
7321         }
7322
7323         if (info->attrs[NL80211_ATTR_IE])
7324                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7325         else
7326                 ie_len = 0;
7327
7328         if (ie_len > wiphy->max_scan_ie_len) {
7329                 err = -EINVAL;
7330                 goto unlock;
7331         }
7332
7333         request = kzalloc(sizeof(*request)
7334                         + sizeof(*request->ssids) * n_ssids
7335                         + sizeof(*request->channels) * n_channels
7336                         + ie_len, GFP_KERNEL);
7337         if (!request) {
7338                 err = -ENOMEM;
7339                 goto unlock;
7340         }
7341
7342         if (n_ssids)
7343                 request->ssids = (void *)&request->channels[n_channels];
7344         request->n_ssids = n_ssids;
7345         if (ie_len) {
7346                 if (n_ssids)
7347                         request->ie = (void *)(request->ssids + n_ssids);
7348                 else
7349                         request->ie = (void *)(request->channels + n_channels);
7350         }
7351
7352         i = 0;
7353         if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7354                 /* user specified, bail out if channel not found */
7355                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
7356                         struct ieee80211_channel *chan;
7357
7358                         chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7359
7360                         if (!chan) {
7361                                 err = -EINVAL;
7362                                 goto out_free;
7363                         }
7364
7365                         /* ignore disabled channels */
7366                         if (chan->flags & IEEE80211_CHAN_DISABLED)
7367                                 continue;
7368
7369                         request->channels[i] = chan;
7370                         i++;
7371                 }
7372         } else {
7373                 enum nl80211_band band;
7374
7375                 /* all channels */
7376                 for (band = 0; band < NUM_NL80211_BANDS; band++) {
7377                         int j;
7378
7379                         if (!wiphy->bands[band])
7380                                 continue;
7381                         for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7382                                 struct ieee80211_channel *chan;
7383
7384                                 chan = &wiphy->bands[band]->channels[j];
7385
7386                                 if (chan->flags & IEEE80211_CHAN_DISABLED)
7387                                         continue;
7388
7389                                 request->channels[i] = chan;
7390                                 i++;
7391                         }
7392                 }
7393         }
7394
7395         if (!i) {
7396                 err = -EINVAL;
7397                 goto out_free;
7398         }
7399
7400         request->n_channels = i;
7401
7402         wdev_lock(wdev);
7403         if (!cfg80211_off_channel_oper_allowed(wdev)) {
7404                 struct ieee80211_channel *chan;
7405
7406                 if (request->n_channels != 1) {
7407                         wdev_unlock(wdev);
7408                         err = -EBUSY;
7409                         goto out_free;
7410                 }
7411
7412                 chan = request->channels[0];
7413                 if (chan->center_freq != wdev->chandef.chan->center_freq) {
7414                         wdev_unlock(wdev);
7415                         err = -EBUSY;
7416                         goto out_free;
7417                 }
7418         }
7419         wdev_unlock(wdev);
7420
7421         i = 0;
7422         if (n_ssids) {
7423                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
7424                         if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7425                                 err = -EINVAL;
7426                                 goto out_free;
7427                         }
7428                         request->ssids[i].ssid_len = nla_len(attr);
7429                         memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
7430                         i++;
7431                 }
7432         }
7433
7434         if (info->attrs[NL80211_ATTR_IE]) {
7435                 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7436                 memcpy((void *)request->ie,
7437                        nla_data(info->attrs[NL80211_ATTR_IE]),
7438                        request->ie_len);
7439         }
7440
7441         for (i = 0; i < NUM_NL80211_BANDS; i++)
7442                 if (wiphy->bands[i])
7443                         request->rates[i] =
7444                                 (1 << wiphy->bands[i]->n_bitrates) - 1;
7445
7446         if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
7447                 nla_for_each_nested(attr,
7448                                     info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
7449                                     tmp) {
7450                         enum nl80211_band band = nla_type(attr);
7451
7452                         if (band < 0 || band >= NUM_NL80211_BANDS) {
7453                                 err = -EINVAL;
7454                                 goto out_free;
7455                         }
7456
7457                         if (!wiphy->bands[band])
7458                                 continue;
7459
7460                         err = ieee80211_get_ratemask(wiphy->bands[band],
7461                                                      nla_data(attr),
7462                                                      nla_len(attr),
7463                                                      &request->rates[band]);
7464                         if (err)
7465                                 goto out_free;
7466                 }
7467         }
7468
7469         if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
7470                 if (!wiphy_ext_feature_isset(wiphy,
7471                                         NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
7472                         err = -EOPNOTSUPP;
7473                         goto out_free;
7474                 }
7475
7476                 request->duration =
7477                         nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
7478                 request->duration_mandatory =
7479                         nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
7480         }
7481
7482         err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
7483                                        false);
7484         if (err)
7485                 goto out_free;
7486
7487         request->no_cck =
7488                 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
7489
7490         /* Initial implementation used NL80211_ATTR_MAC to set the specific
7491          * BSSID to scan for. This was problematic because that same attribute
7492          * was already used for another purpose (local random MAC address). The
7493          * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
7494          * compatibility with older userspace components, also use the
7495          * NL80211_ATTR_MAC value here if it can be determined to be used for
7496          * the specific BSSID use case instead of the random MAC address
7497          * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
7498          */
7499         if (info->attrs[NL80211_ATTR_BSSID])
7500                 memcpy(request->bssid,
7501                        nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
7502         else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
7503                  info->attrs[NL80211_ATTR_MAC])
7504                 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
7505                        ETH_ALEN);
7506         else
7507                 eth_broadcast_addr(request->bssid);
7508
7509         request->wdev = wdev;
7510         request->wiphy = &rdev->wiphy;
7511         request->scan_start = jiffies;
7512
7513         rdev->scan_req = request;
7514         err = rdev_scan(rdev, request);
7515
7516         if (!err) {
7517                 nl80211_send_scan_start(rdev, wdev);
7518                 if (wdev->netdev)
7519                         dev_hold(wdev->netdev);
7520         } else {
7521  out_free:
7522                 rdev->scan_req = NULL;
7523                 kfree(request);
7524         }
7525
7526  unlock:
7527         return err;
7528 }
7529
7530 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
7531 {
7532         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7533         struct wireless_dev *wdev = info->user_ptr[1];
7534
7535         if (!rdev->ops->abort_scan)
7536                 return -EOPNOTSUPP;
7537
7538         if (rdev->scan_msg)
7539                 return 0;
7540
7541         if (!rdev->scan_req)
7542                 return -ENOENT;
7543
7544         rdev_abort_scan(rdev, wdev);
7545         return 0;
7546 }
7547
7548 static int
7549 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
7550                                struct cfg80211_sched_scan_request *request,
7551                                struct nlattr **attrs)
7552 {
7553         int tmp, err, i = 0;
7554         struct nlattr *attr;
7555
7556         if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7557                 u32 interval;
7558
7559                 /*
7560                  * If scan plans are not specified,
7561                  * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
7562                  * case one scan plan will be set with the specified scan
7563                  * interval and infinite number of iterations.
7564                  */
7565                 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
7566                 if (!interval)
7567                         return -EINVAL;
7568
7569                 request->scan_plans[0].interval =
7570                         DIV_ROUND_UP(interval, MSEC_PER_SEC);
7571                 if (!request->scan_plans[0].interval)
7572                         return -EINVAL;
7573
7574                 if (request->scan_plans[0].interval >
7575                     wiphy->max_sched_scan_plan_interval)
7576                         request->scan_plans[0].interval =
7577                                 wiphy->max_sched_scan_plan_interval;
7578
7579                 return 0;
7580         }
7581
7582         nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
7583                 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
7584
7585                 if (WARN_ON(i >= n_plans))
7586                         return -EINVAL;
7587
7588                 err = nla_parse_nested_deprecated(plan,
7589                                                   NL80211_SCHED_SCAN_PLAN_MAX,
7590                                                   attr, nl80211_plan_policy,
7591                                                   NULL);
7592                 if (err)
7593                         return err;
7594
7595                 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
7596                         return -EINVAL;
7597
7598                 request->scan_plans[i].interval =
7599                         nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
7600                 if (!request->scan_plans[i].interval ||
7601                     request->scan_plans[i].interval >
7602                     wiphy->max_sched_scan_plan_interval)
7603                         return -EINVAL;
7604
7605                 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
7606                         request->scan_plans[i].iterations =
7607                                 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
7608                         if (!request->scan_plans[i].iterations ||
7609                             (request->scan_plans[i].iterations >
7610                              wiphy->max_sched_scan_plan_iterations))
7611                                 return -EINVAL;
7612                 } else if (i < n_plans - 1) {
7613                         /*
7614                          * All scan plans but the last one must specify
7615                          * a finite number of iterations
7616                          */
7617                         return -EINVAL;
7618                 }
7619
7620                 i++;
7621         }
7622
7623         /*
7624          * The last scan plan must not specify the number of
7625          * iterations, it is supposed to run infinitely
7626          */
7627         if (request->scan_plans[n_plans - 1].iterations)
7628                 return  -EINVAL;
7629
7630         return 0;
7631 }
7632
7633 static int
7634 nl80211_parse_sched_scan_per_band_rssi(struct wiphy *wiphy,
7635                                        struct cfg80211_match_set *match_sets,
7636                                        struct nlattr *tb_band_rssi,
7637                                        s32 rssi_thold)
7638 {
7639         struct nlattr *attr;
7640         int i, tmp, ret = 0;
7641
7642         if (!wiphy_ext_feature_isset(wiphy,
7643                     NL80211_EXT_FEATURE_SCHED_SCAN_BAND_SPECIFIC_RSSI_THOLD)) {
7644                 if (tb_band_rssi)
7645                         ret = -EOPNOTSUPP;
7646                 else
7647                         for (i = 0; i < NUM_NL80211_BANDS; i++)
7648                                 match_sets->per_band_rssi_thold[i] =
7649                                         NL80211_SCAN_RSSI_THOLD_OFF;
7650                 return ret;
7651         }
7652
7653         for (i = 0; i < NUM_NL80211_BANDS; i++)
7654                 match_sets->per_band_rssi_thold[i] = rssi_thold;
7655
7656         nla_for_each_nested(attr, tb_band_rssi, tmp) {
7657                 enum nl80211_band band = nla_type(attr);
7658
7659                 if (band < 0 || band >= NUM_NL80211_BANDS)
7660                         return -EINVAL;
7661
7662                 match_sets->per_band_rssi_thold[band] = nla_get_s32(attr);
7663         }
7664
7665         return 0;
7666 }
7667
7668 static struct cfg80211_sched_scan_request *
7669 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
7670                          struct nlattr **attrs, int max_match_sets)
7671 {
7672         struct cfg80211_sched_scan_request *request;
7673         struct nlattr *attr;
7674         int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
7675         enum nl80211_band band;
7676         size_t ie_len;
7677         struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
7678         s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
7679
7680         if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7681                 n_channels = validate_scan_freqs(
7682                                 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
7683                 if (!n_channels)
7684                         return ERR_PTR(-EINVAL);
7685         } else {
7686                 n_channels = ieee80211_get_num_supported_channels(wiphy);
7687         }
7688
7689         if (attrs[NL80211_ATTR_SCAN_SSIDS])
7690                 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7691                                     tmp)
7692                         n_ssids++;
7693
7694         if (n_ssids > wiphy->max_sched_scan_ssids)
7695                 return ERR_PTR(-EINVAL);
7696
7697         /*
7698          * First, count the number of 'real' matchsets. Due to an issue with
7699          * the old implementation, matchsets containing only the RSSI attribute
7700          * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
7701          * RSSI for all matchsets, rather than their own matchset for reporting
7702          * all APs with a strong RSSI. This is needed to be compatible with
7703          * older userspace that treated a matchset with only the RSSI as the
7704          * global RSSI for all other matchsets - if there are other matchsets.
7705          */
7706         if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7707                 nla_for_each_nested(attr,
7708                                     attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7709                                     tmp) {
7710                         struct nlattr *rssi;
7711
7712                         err = nla_parse_nested_deprecated(tb,
7713                                                           NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7714                                                           attr,
7715                                                           nl80211_match_policy,
7716                                                           NULL);
7717                         if (err)
7718                                 return ERR_PTR(err);
7719
7720                         /* SSID and BSSID are mutually exclusive */
7721                         if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
7722                             tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
7723                                 return ERR_PTR(-EINVAL);
7724
7725                         /* add other standalone attributes here */
7726                         if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
7727                             tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
7728                                 n_match_sets++;
7729                                 continue;
7730                         }
7731                         rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7732                         if (rssi)
7733                                 default_match_rssi = nla_get_s32(rssi);
7734                 }
7735         }
7736
7737         /* However, if there's no other matchset, add the RSSI one */
7738         if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
7739                 n_match_sets = 1;
7740
7741         if (n_match_sets > max_match_sets)
7742                 return ERR_PTR(-EINVAL);
7743
7744         if (attrs[NL80211_ATTR_IE])
7745                 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
7746         else
7747                 ie_len = 0;
7748
7749         if (ie_len > wiphy->max_sched_scan_ie_len)
7750                 return ERR_PTR(-EINVAL);
7751
7752         if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
7753                 /*
7754                  * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
7755                  * each scan plan already specifies its own interval
7756                  */
7757                 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7758                         return ERR_PTR(-EINVAL);
7759
7760                 nla_for_each_nested(attr,
7761                                     attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
7762                         n_plans++;
7763         } else {
7764                 /*
7765                  * The scan interval attribute is kept for backward
7766                  * compatibility. If no scan plans are specified and sched scan
7767                  * interval is specified, one scan plan will be set with this
7768                  * scan interval and infinite number of iterations.
7769                  */
7770                 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
7771                         return ERR_PTR(-EINVAL);
7772
7773                 n_plans = 1;
7774         }
7775
7776         if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
7777                 return ERR_PTR(-EINVAL);
7778
7779         if (!wiphy_ext_feature_isset(
7780                     wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
7781             (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
7782              attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
7783                 return ERR_PTR(-EINVAL);
7784
7785         request = kzalloc(sizeof(*request)
7786                         + sizeof(*request->ssids) * n_ssids
7787                         + sizeof(*request->match_sets) * n_match_sets
7788                         + sizeof(*request->scan_plans) * n_plans
7789                         + sizeof(*request->channels) * n_channels
7790                         + ie_len, GFP_KERNEL);
7791         if (!request)
7792                 return ERR_PTR(-ENOMEM);
7793
7794         if (n_ssids)
7795                 request->ssids = (void *)&request->channels[n_channels];
7796         request->n_ssids = n_ssids;
7797         if (ie_len) {
7798                 if (n_ssids)
7799                         request->ie = (void *)(request->ssids + n_ssids);
7800                 else
7801                         request->ie = (void *)(request->channels + n_channels);
7802         }
7803
7804         if (n_match_sets) {
7805                 if (request->ie)
7806                         request->match_sets = (void *)(request->ie + ie_len);
7807                 else if (n_ssids)
7808                         request->match_sets =
7809                                 (void *)(request->ssids + n_ssids);
7810                 else
7811                         request->match_sets =
7812                                 (void *)(request->channels + n_channels);
7813         }
7814         request->n_match_sets = n_match_sets;
7815
7816         if (n_match_sets)
7817                 request->scan_plans = (void *)(request->match_sets +
7818                                                n_match_sets);
7819         else if (request->ie)
7820                 request->scan_plans = (void *)(request->ie + ie_len);
7821         else if (n_ssids)
7822                 request->scan_plans = (void *)(request->ssids + n_ssids);
7823         else
7824                 request->scan_plans = (void *)(request->channels + n_channels);
7825
7826         request->n_scan_plans = n_plans;
7827
7828         i = 0;
7829         if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
7830                 /* user specified, bail out if channel not found */
7831                 nla_for_each_nested(attr,
7832                                     attrs[NL80211_ATTR_SCAN_FREQUENCIES],
7833                                     tmp) {
7834                         struct ieee80211_channel *chan;
7835
7836                         chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
7837
7838                         if (!chan) {
7839                                 err = -EINVAL;
7840                                 goto out_free;
7841                         }
7842
7843                         /* ignore disabled channels */
7844                         if (chan->flags & IEEE80211_CHAN_DISABLED)
7845                                 continue;
7846
7847                         request->channels[i] = chan;
7848                         i++;
7849                 }
7850         } else {
7851                 /* all channels */
7852                 for (band = 0; band < NUM_NL80211_BANDS; band++) {
7853                         int j;
7854
7855                         if (!wiphy->bands[band])
7856                                 continue;
7857                         for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
7858                                 struct ieee80211_channel *chan;
7859
7860                                 chan = &wiphy->bands[band]->channels[j];
7861
7862                                 if (chan->flags & IEEE80211_CHAN_DISABLED)
7863                                         continue;
7864
7865                                 request->channels[i] = chan;
7866                                 i++;
7867                         }
7868                 }
7869         }
7870
7871         if (!i) {
7872                 err = -EINVAL;
7873                 goto out_free;
7874         }
7875
7876         request->n_channels = i;
7877
7878         i = 0;
7879         if (n_ssids) {
7880                 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7881                                     tmp) {
7882                         if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7883                                 err = -EINVAL;
7884                                 goto out_free;
7885                         }
7886                         request->ssids[i].ssid_len = nla_len(attr);
7887                         memcpy(request->ssids[i].ssid, nla_data(attr),
7888                                nla_len(attr));
7889                         i++;
7890                 }
7891         }
7892
7893         i = 0;
7894         if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7895                 nla_for_each_nested(attr,
7896                                     attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7897                                     tmp) {
7898                         struct nlattr *ssid, *bssid, *rssi;
7899
7900                         err = nla_parse_nested_deprecated(tb,
7901                                                           NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7902                                                           attr,
7903                                                           nl80211_match_policy,
7904                                                           NULL);
7905                         if (err)
7906                                 goto out_free;
7907                         ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
7908                         bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
7909
7910                         if (!ssid && !bssid) {
7911                                 i++;
7912                                 continue;
7913                         }
7914
7915                         if (WARN_ON(i >= n_match_sets)) {
7916                                 /* this indicates a programming error,
7917                                  * the loop above should have verified
7918                                  * things properly
7919                                  */
7920                                 err = -EINVAL;
7921                                 goto out_free;
7922                         }
7923
7924                         if (ssid) {
7925                                 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
7926                                         err = -EINVAL;
7927                                         goto out_free;
7928                                 }
7929                                 memcpy(request->match_sets[i].ssid.ssid,
7930                                        nla_data(ssid), nla_len(ssid));
7931                                 request->match_sets[i].ssid.ssid_len =
7932                                         nla_len(ssid);
7933                         }
7934                         if (bssid) {
7935                                 if (nla_len(bssid) != ETH_ALEN) {
7936                                         err = -EINVAL;
7937                                         goto out_free;
7938                                 }
7939                                 memcpy(request->match_sets[i].bssid,
7940                                        nla_data(bssid), ETH_ALEN);
7941                         }
7942
7943                         /* special attribute - old implementation w/a */
7944                         request->match_sets[i].rssi_thold = default_match_rssi;
7945                         rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7946                         if (rssi)
7947                                 request->match_sets[i].rssi_thold =
7948                                         nla_get_s32(rssi);
7949
7950                         /* Parse per band RSSI attribute */
7951                         err = nl80211_parse_sched_scan_per_band_rssi(wiphy,
7952                                 &request->match_sets[i],
7953                                 tb[NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI],
7954                                 request->match_sets[i].rssi_thold);
7955                         if (err)
7956                                 goto out_free;
7957
7958                         i++;
7959                 }
7960
7961                 /* there was no other matchset, so the RSSI one is alone */
7962                 if (i == 0 && n_match_sets)
7963                         request->match_sets[0].rssi_thold = default_match_rssi;
7964
7965                 request->min_rssi_thold = INT_MAX;
7966                 for (i = 0; i < n_match_sets; i++)
7967                         request->min_rssi_thold =
7968                                 min(request->match_sets[i].rssi_thold,
7969                                     request->min_rssi_thold);
7970         } else {
7971                 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
7972         }
7973
7974         if (ie_len) {
7975                 request->ie_len = ie_len;
7976                 memcpy((void *)request->ie,
7977                        nla_data(attrs[NL80211_ATTR_IE]),
7978                        request->ie_len);
7979         }
7980
7981         err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
7982         if (err)
7983                 goto out_free;
7984
7985         if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
7986                 request->delay =
7987                         nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
7988
7989         if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
7990                 request->relative_rssi = nla_get_s8(
7991                         attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
7992                 request->relative_rssi_set = true;
7993         }
7994
7995         if (request->relative_rssi_set &&
7996             attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
7997                 struct nl80211_bss_select_rssi_adjust *rssi_adjust;
7998
7999                 rssi_adjust = nla_data(
8000                         attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
8001                 request->rssi_adjust.band = rssi_adjust->band;
8002                 request->rssi_adjust.delta = rssi_adjust->delta;
8003                 if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
8004                         err = -EINVAL;
8005                         goto out_free;
8006                 }
8007         }
8008
8009         err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
8010         if (err)
8011                 goto out_free;
8012
8013         request->scan_start = jiffies;
8014
8015         return request;
8016
8017 out_free:
8018         kfree(request);
8019         return ERR_PTR(err);
8020 }
8021
8022 static int nl80211_start_sched_scan(struct sk_buff *skb,
8023                                     struct genl_info *info)
8024 {
8025         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8026         struct net_device *dev = info->user_ptr[1];
8027         struct wireless_dev *wdev = dev->ieee80211_ptr;
8028         struct cfg80211_sched_scan_request *sched_scan_req;
8029         bool want_multi;
8030         int err;
8031
8032         if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
8033                 return -EOPNOTSUPP;
8034
8035         want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
8036         err = cfg80211_sched_scan_req_possible(rdev, want_multi);
8037         if (err)
8038                 return err;
8039
8040         sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
8041                                                   info->attrs,
8042                                                   rdev->wiphy.max_match_sets);
8043
8044         err = PTR_ERR_OR_ZERO(sched_scan_req);
8045         if (err)
8046                 goto out_err;
8047
8048         /* leave request id zero for legacy request
8049          * or if driver does not support multi-scheduled scan
8050          */
8051         if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) {
8052                 while (!sched_scan_req->reqid)
8053                         sched_scan_req->reqid = cfg80211_assign_cookie(rdev);
8054         }
8055
8056         err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
8057         if (err)
8058                 goto out_free;
8059
8060         sched_scan_req->dev = dev;
8061         sched_scan_req->wiphy = &rdev->wiphy;
8062
8063         if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
8064                 sched_scan_req->owner_nlportid = info->snd_portid;
8065
8066         cfg80211_add_sched_scan_req(rdev, sched_scan_req);
8067
8068         nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
8069         return 0;
8070
8071 out_free:
8072         kfree(sched_scan_req);
8073 out_err:
8074         return err;
8075 }
8076
8077 static int nl80211_stop_sched_scan(struct sk_buff *skb,
8078                                    struct genl_info *info)
8079 {
8080         struct cfg80211_sched_scan_request *req;
8081         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8082         u64 cookie;
8083
8084         if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
8085                 return -EOPNOTSUPP;
8086
8087         if (info->attrs[NL80211_ATTR_COOKIE]) {
8088                 cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
8089                 return __cfg80211_stop_sched_scan(rdev, cookie, false);
8090         }
8091
8092         req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
8093                                      struct cfg80211_sched_scan_request,
8094                                      list);
8095         if (!req || req->reqid ||
8096             (req->owner_nlportid &&
8097              req->owner_nlportid != info->snd_portid))
8098                 return -ENOENT;
8099
8100         return cfg80211_stop_sched_scan_req(rdev, req, false);
8101 }
8102
8103 static int nl80211_start_radar_detection(struct sk_buff *skb,
8104                                          struct genl_info *info)
8105 {
8106         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8107         struct net_device *dev = info->user_ptr[1];
8108         struct wireless_dev *wdev = dev->ieee80211_ptr;
8109         struct wiphy *wiphy = wdev->wiphy;
8110         struct cfg80211_chan_def chandef;
8111         enum nl80211_dfs_regions dfs_region;
8112         unsigned int cac_time_ms;
8113         int err;
8114
8115         dfs_region = reg_get_dfs_region(wiphy);
8116         if (dfs_region == NL80211_DFS_UNSET)
8117                 return -EINVAL;
8118
8119         err = nl80211_parse_chandef(rdev, info, &chandef);
8120         if (err)
8121                 return err;
8122
8123         if (netif_carrier_ok(dev))
8124                 return -EBUSY;
8125
8126         if (wdev->cac_started)
8127                 return -EBUSY;
8128
8129         err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
8130         if (err < 0)
8131                 return err;
8132
8133         if (err == 0)
8134                 return -EINVAL;
8135
8136         if (!cfg80211_chandef_dfs_usable(wiphy, &chandef))
8137                 return -EINVAL;
8138
8139         /* CAC start is offloaded to HW and can't be started manually */
8140         if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD))
8141                 return -EOPNOTSUPP;
8142
8143         if (!rdev->ops->start_radar_detection)
8144                 return -EOPNOTSUPP;
8145
8146         cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
8147         if (WARN_ON(!cac_time_ms))
8148                 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
8149
8150         err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
8151         if (!err) {
8152                 wdev->chandef = chandef;
8153                 wdev->cac_started = true;
8154                 wdev->cac_start_time = jiffies;
8155                 wdev->cac_time_ms = cac_time_ms;
8156         }
8157         return err;
8158 }
8159
8160 static int nl80211_notify_radar_detection(struct sk_buff *skb,
8161                                           struct genl_info *info)
8162 {
8163         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8164         struct net_device *dev = info->user_ptr[1];
8165         struct wireless_dev *wdev = dev->ieee80211_ptr;
8166         struct wiphy *wiphy = wdev->wiphy;
8167         struct cfg80211_chan_def chandef;
8168         enum nl80211_dfs_regions dfs_region;
8169         int err;
8170
8171         dfs_region = reg_get_dfs_region(wiphy);
8172         if (dfs_region == NL80211_DFS_UNSET) {
8173                 GENL_SET_ERR_MSG(info,
8174                                  "DFS Region is not set. Unexpected Radar indication");
8175                 return -EINVAL;
8176         }
8177
8178         err = nl80211_parse_chandef(rdev, info, &chandef);
8179         if (err) {
8180                 GENL_SET_ERR_MSG(info, "Unable to extract chandef info");
8181                 return err;
8182         }
8183
8184         err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
8185         if (err < 0) {
8186                 GENL_SET_ERR_MSG(info, "chandef is invalid");
8187                 return err;
8188         }
8189
8190         if (err == 0) {
8191                 GENL_SET_ERR_MSG(info,
8192                                  "Unexpected Radar indication for chandef/iftype");
8193                 return -EINVAL;
8194         }
8195
8196         /* Do not process this notification if radar is already detected
8197          * by kernel on this channel, and return success.
8198          */
8199         if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE)
8200                 return 0;
8201
8202         cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE);
8203
8204         cfg80211_sched_dfs_chan_update(rdev);
8205
8206         rdev->radar_chandef = chandef;
8207
8208         /* Propagate this notification to other radios as well */
8209         queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk);
8210
8211         return 0;
8212 }
8213
8214 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
8215 {
8216         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8217         struct net_device *dev = info->user_ptr[1];
8218         struct wireless_dev *wdev = dev->ieee80211_ptr;
8219         struct cfg80211_csa_settings params;
8220         /* csa_attrs is defined static to avoid waste of stack size - this
8221          * function is called under RTNL lock, so this should not be a problem.
8222          */
8223         static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
8224         int err;
8225         bool need_new_beacon = false;
8226         bool need_handle_dfs_flag = true;
8227         int len, i;
8228         u32 cs_count;
8229
8230         if (!rdev->ops->channel_switch ||
8231             !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
8232                 return -EOPNOTSUPP;
8233
8234         switch (dev->ieee80211_ptr->iftype) {
8235         case NL80211_IFTYPE_AP:
8236         case NL80211_IFTYPE_P2P_GO:
8237                 need_new_beacon = true;
8238                 /* For all modes except AP the handle_dfs flag needs to be
8239                  * supplied to tell the kernel that userspace will handle radar
8240                  * events when they happen. Otherwise a switch to a channel
8241                  * requiring DFS will be rejected.
8242                  */
8243                 need_handle_dfs_flag = false;
8244
8245                 /* useless if AP is not running */
8246                 if (!wdev->beacon_interval)
8247                         return -ENOTCONN;
8248                 break;
8249         case NL80211_IFTYPE_ADHOC:
8250                 if (!wdev->ssid_len)
8251                         return -ENOTCONN;
8252                 break;
8253         case NL80211_IFTYPE_MESH_POINT:
8254                 if (!wdev->mesh_id_len)
8255                         return -ENOTCONN;
8256                 break;
8257         default:
8258                 return -EOPNOTSUPP;
8259         }
8260
8261         memset(&params, 0, sizeof(params));
8262         params.beacon_csa.ftm_responder = -1;
8263
8264         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
8265             !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
8266                 return -EINVAL;
8267
8268         /* only important for AP, IBSS and mesh create IEs internally */
8269         if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
8270                 return -EINVAL;
8271
8272         /* Even though the attribute is u32, the specification says
8273          * u8, so let's make sure we don't overflow.
8274          */
8275         cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
8276         if (cs_count > 255)
8277                 return -EINVAL;
8278
8279         params.count = cs_count;
8280
8281         if (!need_new_beacon)
8282                 goto skip_beacons;
8283
8284         err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_after);
8285         if (err)
8286                 return err;
8287
8288         err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX,
8289                                           info->attrs[NL80211_ATTR_CSA_IES],
8290                                           nl80211_policy, info->extack);
8291         if (err)
8292                 return err;
8293
8294         err = nl80211_parse_beacon(rdev, csa_attrs, &params.beacon_csa);
8295         if (err)
8296                 return err;
8297
8298         if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
8299                 return -EINVAL;
8300
8301         len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
8302         if (!len || (len % sizeof(u16)))
8303                 return -EINVAL;
8304
8305         params.n_counter_offsets_beacon = len / sizeof(u16);
8306         if (rdev->wiphy.max_num_csa_counters &&
8307             (params.n_counter_offsets_beacon >
8308              rdev->wiphy.max_num_csa_counters))
8309                 return -EINVAL;
8310
8311         params.counter_offsets_beacon =
8312                 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
8313
8314         /* sanity checks - counters should fit and be the same */
8315         for (i = 0; i < params.n_counter_offsets_beacon; i++) {
8316                 u16 offset = params.counter_offsets_beacon[i];
8317
8318                 if (offset >= params.beacon_csa.tail_len)
8319                         return -EINVAL;
8320
8321                 if (params.beacon_csa.tail[offset] != params.count)
8322                         return -EINVAL;
8323         }
8324
8325         if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
8326                 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
8327                 if (!len || (len % sizeof(u16)))
8328                         return -EINVAL;
8329
8330                 params.n_counter_offsets_presp = len / sizeof(u16);
8331                 if (rdev->wiphy.max_num_csa_counters &&
8332                     (params.n_counter_offsets_presp >
8333                      rdev->wiphy.max_num_csa_counters))
8334                         return -EINVAL;
8335
8336                 params.counter_offsets_presp =
8337                         nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
8338
8339                 /* sanity checks - counters should fit and be the same */
8340                 for (i = 0; i < params.n_counter_offsets_presp; i++) {
8341                         u16 offset = params.counter_offsets_presp[i];
8342
8343                         if (offset >= params.beacon_csa.probe_resp_len)
8344                                 return -EINVAL;
8345
8346                         if (params.beacon_csa.probe_resp[offset] !=
8347                             params.count)
8348                                 return -EINVAL;
8349                 }
8350         }
8351
8352 skip_beacons:
8353         err = nl80211_parse_chandef(rdev, info, &params.chandef);
8354         if (err)
8355                 return err;
8356
8357         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
8358                                            wdev->iftype))
8359                 return -EINVAL;
8360
8361         err = cfg80211_chandef_dfs_required(wdev->wiphy,
8362                                             &params.chandef,
8363                                             wdev->iftype);
8364         if (err < 0)
8365                 return err;
8366
8367         if (err > 0) {
8368                 params.radar_required = true;
8369                 if (need_handle_dfs_flag &&
8370                     !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
8371                         return -EINVAL;
8372                 }
8373         }
8374
8375         if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
8376                 params.block_tx = true;
8377
8378         wdev_lock(wdev);
8379         err = rdev_channel_switch(rdev, dev, &params);
8380         wdev_unlock(wdev);
8381
8382         return err;
8383 }
8384
8385 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
8386                             u32 seq, int flags,
8387                             struct cfg80211_registered_device *rdev,
8388                             struct wireless_dev *wdev,
8389                             struct cfg80211_internal_bss *intbss)
8390 {
8391         struct cfg80211_bss *res = &intbss->pub;
8392         const struct cfg80211_bss_ies *ies;
8393         void *hdr;
8394         struct nlattr *bss;
8395
8396         ASSERT_WDEV_LOCK(wdev);
8397
8398         hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
8399                              NL80211_CMD_NEW_SCAN_RESULTS);
8400         if (!hdr)
8401                 return -1;
8402
8403         genl_dump_check_consistent(cb, hdr);
8404
8405         if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
8406                 goto nla_put_failure;
8407         if (wdev->netdev &&
8408             nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
8409                 goto nla_put_failure;
8410         if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
8411                               NL80211_ATTR_PAD))
8412                 goto nla_put_failure;
8413
8414         bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS);
8415         if (!bss)
8416                 goto nla_put_failure;
8417         if ((!is_zero_ether_addr(res->bssid) &&
8418              nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
8419                 goto nla_put_failure;
8420
8421         rcu_read_lock();
8422         /* indicate whether we have probe response data or not */
8423         if (rcu_access_pointer(res->proberesp_ies) &&
8424             nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
8425                 goto fail_unlock_rcu;
8426
8427         /* this pointer prefers to be pointed to probe response data
8428          * but is always valid
8429          */
8430         ies = rcu_dereference(res->ies);
8431         if (ies) {
8432                 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
8433                                       NL80211_BSS_PAD))
8434                         goto fail_unlock_rcu;
8435                 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
8436                                         ies->len, ies->data))
8437                         goto fail_unlock_rcu;
8438         }
8439
8440         /* and this pointer is always (unless driver didn't know) beacon data */
8441         ies = rcu_dereference(res->beacon_ies);
8442         if (ies && ies->from_beacon) {
8443                 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
8444                                       NL80211_BSS_PAD))
8445                         goto fail_unlock_rcu;
8446                 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
8447                                         ies->len, ies->data))
8448                         goto fail_unlock_rcu;
8449         }
8450         rcu_read_unlock();
8451
8452         if (res->beacon_interval &&
8453             nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
8454                 goto nla_put_failure;
8455         if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
8456             nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
8457             nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
8458             nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
8459                         jiffies_to_msecs(jiffies - intbss->ts)))
8460                 goto nla_put_failure;
8461
8462         if (intbss->parent_tsf &&
8463             (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
8464                                intbss->parent_tsf, NL80211_BSS_PAD) ||
8465              nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
8466                      intbss->parent_bssid)))
8467                 goto nla_put_failure;
8468
8469         if (intbss->ts_boottime &&
8470             nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
8471                               intbss->ts_boottime, NL80211_BSS_PAD))
8472                 goto nla_put_failure;
8473
8474         if (!nl80211_put_signal(msg, intbss->pub.chains,
8475                                 intbss->pub.chain_signal,
8476                                 NL80211_BSS_CHAIN_SIGNAL))
8477                 goto nla_put_failure;
8478
8479         switch (rdev->wiphy.signal_type) {
8480         case CFG80211_SIGNAL_TYPE_MBM:
8481                 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
8482                         goto nla_put_failure;
8483                 break;
8484         case CFG80211_SIGNAL_TYPE_UNSPEC:
8485                 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
8486                         goto nla_put_failure;
8487                 break;
8488         default:
8489                 break;
8490         }
8491
8492         switch (wdev->iftype) {
8493         case NL80211_IFTYPE_P2P_CLIENT:
8494         case NL80211_IFTYPE_STATION:
8495                 if (intbss == wdev->current_bss &&
8496                     nla_put_u32(msg, NL80211_BSS_STATUS,
8497                                 NL80211_BSS_STATUS_ASSOCIATED))
8498                         goto nla_put_failure;
8499                 break;
8500         case NL80211_IFTYPE_ADHOC:
8501                 if (intbss == wdev->current_bss &&
8502                     nla_put_u32(msg, NL80211_BSS_STATUS,
8503                                 NL80211_BSS_STATUS_IBSS_JOINED))
8504                         goto nla_put_failure;
8505                 break;
8506         default:
8507                 break;
8508         }
8509
8510         nla_nest_end(msg, bss);
8511
8512         genlmsg_end(msg, hdr);
8513         return 0;
8514
8515  fail_unlock_rcu:
8516         rcu_read_unlock();
8517  nla_put_failure:
8518         genlmsg_cancel(msg, hdr);
8519         return -EMSGSIZE;
8520 }
8521
8522 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
8523 {
8524         struct cfg80211_registered_device *rdev;
8525         struct cfg80211_internal_bss *scan;
8526         struct wireless_dev *wdev;
8527         int start = cb->args[2], idx = 0;
8528         int err;
8529
8530         rtnl_lock();
8531         err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
8532         if (err) {
8533                 rtnl_unlock();
8534                 return err;
8535         }
8536
8537         wdev_lock(wdev);
8538         spin_lock_bh(&rdev->bss_lock);
8539
8540         /*
8541          * dump_scan will be called multiple times to break up the scan results
8542          * into multiple messages.  It is unlikely that any more bss-es will be
8543          * expired after the first call, so only call only call this on the
8544          * first dump_scan invocation.
8545          */
8546         if (start == 0)
8547                 cfg80211_bss_expire(rdev);
8548
8549         cb->seq = rdev->bss_generation;
8550
8551         list_for_each_entry(scan, &rdev->bss_list, list) {
8552                 if (++idx <= start)
8553                         continue;
8554                 if (nl80211_send_bss(skb, cb,
8555                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8556                                 rdev, wdev, scan) < 0) {
8557                         idx--;
8558                         break;
8559                 }
8560         }
8561
8562         spin_unlock_bh(&rdev->bss_lock);
8563         wdev_unlock(wdev);
8564
8565         cb->args[2] = idx;
8566         rtnl_unlock();
8567
8568         return skb->len;
8569 }
8570
8571 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
8572                                int flags, struct net_device *dev,
8573                                bool allow_radio_stats,
8574                                struct survey_info *survey)
8575 {
8576         void *hdr;
8577         struct nlattr *infoattr;
8578
8579         /* skip radio stats if userspace didn't request them */
8580         if (!survey->channel && !allow_radio_stats)
8581                 return 0;
8582
8583         hdr = nl80211hdr_put(msg, portid, seq, flags,
8584                              NL80211_CMD_NEW_SURVEY_RESULTS);
8585         if (!hdr)
8586                 return -ENOMEM;
8587
8588         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
8589                 goto nla_put_failure;
8590
8591         infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO);
8592         if (!infoattr)
8593                 goto nla_put_failure;
8594
8595         if (survey->channel &&
8596             nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
8597                         survey->channel->center_freq))
8598                 goto nla_put_failure;
8599
8600         if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
8601             nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
8602                 goto nla_put_failure;
8603         if ((survey->filled & SURVEY_INFO_IN_USE) &&
8604             nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
8605                 goto nla_put_failure;
8606         if ((survey->filled & SURVEY_INFO_TIME) &&
8607             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
8608                         survey->time, NL80211_SURVEY_INFO_PAD))
8609                 goto nla_put_failure;
8610         if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
8611             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
8612                               survey->time_busy, NL80211_SURVEY_INFO_PAD))
8613                 goto nla_put_failure;
8614         if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
8615             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
8616                               survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
8617                 goto nla_put_failure;
8618         if ((survey->filled & SURVEY_INFO_TIME_RX) &&
8619             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
8620                               survey->time_rx, NL80211_SURVEY_INFO_PAD))
8621                 goto nla_put_failure;
8622         if ((survey->filled & SURVEY_INFO_TIME_TX) &&
8623             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
8624                               survey->time_tx, NL80211_SURVEY_INFO_PAD))
8625                 goto nla_put_failure;
8626         if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
8627             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
8628                               survey->time_scan, NL80211_SURVEY_INFO_PAD))
8629                 goto nla_put_failure;
8630
8631         nla_nest_end(msg, infoattr);
8632
8633         genlmsg_end(msg, hdr);
8634         return 0;
8635
8636  nla_put_failure:
8637         genlmsg_cancel(msg, hdr);
8638         return -EMSGSIZE;
8639 }
8640
8641 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
8642 {
8643         struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
8644         struct survey_info survey;
8645         struct cfg80211_registered_device *rdev;
8646         struct wireless_dev *wdev;
8647         int survey_idx = cb->args[2];
8648         int res;
8649         bool radio_stats;
8650
8651         rtnl_lock();
8652         res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev);
8653         if (res)
8654                 goto out_err;
8655
8656         /* prepare_wdev_dump parsed the attributes */
8657         radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
8658
8659         if (!wdev->netdev) {
8660                 res = -EINVAL;
8661                 goto out_err;
8662         }
8663
8664         if (!rdev->ops->dump_survey) {
8665                 res = -EOPNOTSUPP;
8666                 goto out_err;
8667         }
8668
8669         while (1) {
8670                 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
8671                 if (res == -ENOENT)
8672                         break;
8673                 if (res)
8674                         goto out_err;
8675
8676                 /* don't send disabled channels, but do send non-channel data */
8677                 if (survey.channel &&
8678                     survey.channel->flags & IEEE80211_CHAN_DISABLED) {
8679                         survey_idx++;
8680                         continue;
8681                 }
8682
8683                 if (nl80211_send_survey(skb,
8684                                 NETLINK_CB(cb->skb).portid,
8685                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
8686                                 wdev->netdev, radio_stats, &survey) < 0)
8687                         goto out;
8688                 survey_idx++;
8689         }
8690
8691  out:
8692         cb->args[2] = survey_idx;
8693         res = skb->len;
8694  out_err:
8695         rtnl_unlock();
8696         return res;
8697 }
8698
8699 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
8700 {
8701         return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
8702                                   NL80211_WPA_VERSION_2));
8703 }
8704
8705 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
8706 {
8707         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8708         struct net_device *dev = info->user_ptr[1];
8709         struct ieee80211_channel *chan;
8710         const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
8711         int err, ssid_len, ie_len = 0, auth_data_len = 0;
8712         enum nl80211_auth_type auth_type;
8713         struct key_parse key;
8714         bool local_state_change;
8715
8716         if (!info->attrs[NL80211_ATTR_MAC])
8717                 return -EINVAL;
8718
8719         if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
8720                 return -EINVAL;
8721
8722         if (!info->attrs[NL80211_ATTR_SSID])
8723                 return -EINVAL;
8724
8725         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
8726                 return -EINVAL;
8727
8728         err = nl80211_parse_key(info, &key);
8729         if (err)
8730                 return err;
8731
8732         if (key.idx >= 0) {
8733                 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
8734                         return -EINVAL;
8735                 if (!key.p.key || !key.p.key_len)
8736                         return -EINVAL;
8737                 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
8738                      key.p.key_len != WLAN_KEY_LEN_WEP40) &&
8739                     (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
8740                      key.p.key_len != WLAN_KEY_LEN_WEP104))
8741                         return -EINVAL;
8742                 if (key.idx > 3)
8743                         return -EINVAL;
8744         } else {
8745                 key.p.key_len = 0;
8746                 key.p.key = NULL;
8747         }
8748
8749         if (key.idx >= 0) {
8750                 int i;
8751                 bool ok = false;
8752
8753                 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
8754                         if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
8755                                 ok = true;
8756                                 break;
8757                         }
8758                 }
8759                 if (!ok)
8760                         return -EINVAL;
8761         }
8762
8763         if (!rdev->ops->auth)
8764                 return -EOPNOTSUPP;
8765
8766         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8767             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8768                 return -EOPNOTSUPP;
8769
8770         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8771         chan = nl80211_get_valid_chan(&rdev->wiphy,
8772                                       info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8773         if (!chan)
8774                 return -EINVAL;
8775
8776         ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8777         ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8778
8779         if (info->attrs[NL80211_ATTR_IE]) {
8780                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8781                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8782         }
8783
8784         auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
8785         if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
8786                 return -EINVAL;
8787
8788         if ((auth_type == NL80211_AUTHTYPE_SAE ||
8789              auth_type == NL80211_AUTHTYPE_FILS_SK ||
8790              auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
8791              auth_type == NL80211_AUTHTYPE_FILS_PK) &&
8792             !info->attrs[NL80211_ATTR_AUTH_DATA])
8793                 return -EINVAL;
8794
8795         if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
8796                 if (auth_type != NL80211_AUTHTYPE_SAE &&
8797                     auth_type != NL80211_AUTHTYPE_FILS_SK &&
8798                     auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
8799                     auth_type != NL80211_AUTHTYPE_FILS_PK)
8800                         return -EINVAL;
8801                 auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
8802                 auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
8803                 /* need to include at least Auth Transaction and Status Code */
8804                 if (auth_data_len < 4)
8805                         return -EINVAL;
8806         }
8807
8808         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8809
8810         /*
8811          * Since we no longer track auth state, ignore
8812          * requests to only change local state.
8813          */
8814         if (local_state_change)
8815                 return 0;
8816
8817         wdev_lock(dev->ieee80211_ptr);
8818         err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
8819                                  ssid, ssid_len, ie, ie_len,
8820                                  key.p.key, key.p.key_len, key.idx,
8821                                  auth_data, auth_data_len);
8822         wdev_unlock(dev->ieee80211_ptr);
8823         return err;
8824 }
8825
8826 static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
8827                                      struct genl_info *info)
8828 {
8829         if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
8830                 GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
8831                 return -EINVAL;
8832         }
8833
8834         if (!rdev->ops->tx_control_port ||
8835             !wiphy_ext_feature_isset(&rdev->wiphy,
8836                                      NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
8837                 return -EOPNOTSUPP;
8838
8839         return 0;
8840 }
8841
8842 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
8843                                    struct genl_info *info,
8844                                    struct cfg80211_crypto_settings *settings,
8845                                    int cipher_limit)
8846 {
8847         memset(settings, 0, sizeof(*settings));
8848
8849         settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
8850
8851         if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
8852                 u16 proto;
8853
8854                 proto = nla_get_u16(
8855                         info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
8856                 settings->control_port_ethertype = cpu_to_be16(proto);
8857                 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
8858                     proto != ETH_P_PAE)
8859                         return -EINVAL;
8860                 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
8861                         settings->control_port_no_encrypt = true;
8862         } else
8863                 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
8864
8865         if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
8866                 int r = validate_pae_over_nl80211(rdev, info);
8867
8868                 if (r < 0)
8869                         return r;
8870
8871                 settings->control_port_over_nl80211 = true;
8872         }
8873
8874         if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
8875                 void *data;
8876                 int len, i;
8877
8878                 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8879                 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
8880                 settings->n_ciphers_pairwise = len / sizeof(u32);
8881
8882                 if (len % sizeof(u32))
8883                         return -EINVAL;
8884
8885                 if (settings->n_ciphers_pairwise > cipher_limit)
8886                         return -EINVAL;
8887
8888                 memcpy(settings->ciphers_pairwise, data, len);
8889
8890                 for (i = 0; i < settings->n_ciphers_pairwise; i++)
8891                         if (!cfg80211_supported_cipher_suite(
8892                                         &rdev->wiphy,
8893                                         settings->ciphers_pairwise[i]))
8894                                 return -EINVAL;
8895         }
8896
8897         if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
8898                 settings->cipher_group =
8899                         nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
8900                 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
8901                                                      settings->cipher_group))
8902                         return -EINVAL;
8903         }
8904
8905         if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
8906                 settings->wpa_versions =
8907                         nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
8908                 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
8909                         return -EINVAL;
8910         }
8911
8912         if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
8913                 void *data;
8914                 int len;
8915
8916                 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
8917                 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
8918                 settings->n_akm_suites = len / sizeof(u32);
8919
8920                 if (len % sizeof(u32))
8921                         return -EINVAL;
8922
8923                 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
8924                         return -EINVAL;
8925
8926                 memcpy(settings->akm_suites, data, len);
8927         }
8928
8929         if (info->attrs[NL80211_ATTR_PMK]) {
8930                 if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
8931                         return -EINVAL;
8932                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8933                                              NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK))
8934                         return -EINVAL;
8935                 settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
8936         }
8937
8938         return 0;
8939 }
8940
8941 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
8942 {
8943         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8944         struct net_device *dev = info->user_ptr[1];
8945         struct ieee80211_channel *chan;
8946         struct cfg80211_assoc_request req = {};
8947         const u8 *bssid, *ssid;
8948         int err, ssid_len = 0;
8949
8950         if (dev->ieee80211_ptr->conn_owner_nlportid &&
8951             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
8952                 return -EPERM;
8953
8954         if (!info->attrs[NL80211_ATTR_MAC] ||
8955             !info->attrs[NL80211_ATTR_SSID] ||
8956             !info->attrs[NL80211_ATTR_WIPHY_FREQ])
8957                 return -EINVAL;
8958
8959         if (!rdev->ops->assoc)
8960                 return -EOPNOTSUPP;
8961
8962         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8963             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8964                 return -EOPNOTSUPP;
8965
8966         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8967
8968         chan = nl80211_get_valid_chan(&rdev->wiphy,
8969                                       info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8970         if (!chan)
8971                 return -EINVAL;
8972
8973         ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8974         ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8975
8976         if (info->attrs[NL80211_ATTR_IE]) {
8977                 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8978                 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8979         }
8980
8981         if (info->attrs[NL80211_ATTR_USE_MFP]) {
8982                 enum nl80211_mfp mfp =
8983                         nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8984                 if (mfp == NL80211_MFP_REQUIRED)
8985                         req.use_mfp = true;
8986                 else if (mfp != NL80211_MFP_NO)
8987                         return -EINVAL;
8988         }
8989
8990         if (info->attrs[NL80211_ATTR_PREV_BSSID])
8991                 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8992
8993         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8994                 req.flags |= ASSOC_REQ_DISABLE_HT;
8995
8996         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8997                 memcpy(&req.ht_capa_mask,
8998                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8999                        sizeof(req.ht_capa_mask));
9000
9001         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9002                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9003                         return -EINVAL;
9004                 memcpy(&req.ht_capa,
9005                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9006                        sizeof(req.ht_capa));
9007         }
9008
9009         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
9010                 req.flags |= ASSOC_REQ_DISABLE_VHT;
9011
9012         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9013                 memcpy(&req.vht_capa_mask,
9014                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
9015                        sizeof(req.vht_capa_mask));
9016
9017         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
9018                 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9019                         return -EINVAL;
9020                 memcpy(&req.vht_capa,
9021                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
9022                        sizeof(req.vht_capa));
9023         }
9024
9025         if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
9026                 if (!((rdev->wiphy.features &
9027                         NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
9028                        (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
9029                     !wiphy_ext_feature_isset(&rdev->wiphy,
9030                                              NL80211_EXT_FEATURE_RRM))
9031                         return -EINVAL;
9032                 req.flags |= ASSOC_REQ_USE_RRM;
9033         }
9034
9035         if (info->attrs[NL80211_ATTR_FILS_KEK]) {
9036                 req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
9037                 req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
9038                 if (!info->attrs[NL80211_ATTR_FILS_NONCES])
9039                         return -EINVAL;
9040                 req.fils_nonces =
9041                         nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
9042         }
9043
9044         err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
9045         if (!err) {
9046                 wdev_lock(dev->ieee80211_ptr);
9047
9048                 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
9049                                           ssid, ssid_len, &req);
9050
9051                 if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9052                         dev->ieee80211_ptr->conn_owner_nlportid =
9053                                 info->snd_portid;
9054                         memcpy(dev->ieee80211_ptr->disconnect_bssid,
9055                                bssid, ETH_ALEN);
9056                 }
9057
9058                 wdev_unlock(dev->ieee80211_ptr);
9059         }
9060
9061         return err;
9062 }
9063
9064 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
9065 {
9066         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9067         struct net_device *dev = info->user_ptr[1];
9068         const u8 *ie = NULL, *bssid;
9069         int ie_len = 0, err;
9070         u16 reason_code;
9071         bool local_state_change;
9072
9073         if (dev->ieee80211_ptr->conn_owner_nlportid &&
9074             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9075                 return -EPERM;
9076
9077         if (!info->attrs[NL80211_ATTR_MAC])
9078                 return -EINVAL;
9079
9080         if (!info->attrs[NL80211_ATTR_REASON_CODE])
9081                 return -EINVAL;
9082
9083         if (!rdev->ops->deauth)
9084                 return -EOPNOTSUPP;
9085
9086         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9087             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9088                 return -EOPNOTSUPP;
9089
9090         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9091
9092         reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9093         if (reason_code == 0) {
9094                 /* Reason Code 0 is reserved */
9095                 return -EINVAL;
9096         }
9097
9098         if (info->attrs[NL80211_ATTR_IE]) {
9099                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9100                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9101         }
9102
9103         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9104
9105         wdev_lock(dev->ieee80211_ptr);
9106         err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
9107                                    local_state_change);
9108         wdev_unlock(dev->ieee80211_ptr);
9109         return err;
9110 }
9111
9112 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
9113 {
9114         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9115         struct net_device *dev = info->user_ptr[1];
9116         const u8 *ie = NULL, *bssid;
9117         int ie_len = 0, err;
9118         u16 reason_code;
9119         bool local_state_change;
9120
9121         if (dev->ieee80211_ptr->conn_owner_nlportid &&
9122             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9123                 return -EPERM;
9124
9125         if (!info->attrs[NL80211_ATTR_MAC])
9126                 return -EINVAL;
9127
9128         if (!info->attrs[NL80211_ATTR_REASON_CODE])
9129                 return -EINVAL;
9130
9131         if (!rdev->ops->disassoc)
9132                 return -EOPNOTSUPP;
9133
9134         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9135             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9136                 return -EOPNOTSUPP;
9137
9138         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9139
9140         reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9141         if (reason_code == 0) {
9142                 /* Reason Code 0 is reserved */
9143                 return -EINVAL;
9144         }
9145
9146         if (info->attrs[NL80211_ATTR_IE]) {
9147                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9148                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9149         }
9150
9151         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
9152
9153         wdev_lock(dev->ieee80211_ptr);
9154         err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
9155                                      local_state_change);
9156         wdev_unlock(dev->ieee80211_ptr);
9157         return err;
9158 }
9159
9160 static bool
9161 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
9162                          int mcast_rate[NUM_NL80211_BANDS],
9163                          int rateval)
9164 {
9165         struct wiphy *wiphy = &rdev->wiphy;
9166         bool found = false;
9167         int band, i;
9168
9169         for (band = 0; band < NUM_NL80211_BANDS; band++) {
9170                 struct ieee80211_supported_band *sband;
9171
9172                 sband = wiphy->bands[band];
9173                 if (!sband)
9174                         continue;
9175
9176                 for (i = 0; i < sband->n_bitrates; i++) {
9177                         if (sband->bitrates[i].bitrate == rateval) {
9178                                 mcast_rate[band] = i + 1;
9179                                 found = true;
9180                                 break;
9181                         }
9182                 }
9183         }
9184
9185         return found;
9186 }
9187
9188 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
9189 {
9190         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9191         struct net_device *dev = info->user_ptr[1];
9192         struct cfg80211_ibss_params ibss;
9193         struct wiphy *wiphy;
9194         struct cfg80211_cached_keys *connkeys = NULL;
9195         int err;
9196
9197         memset(&ibss, 0, sizeof(ibss));
9198
9199         if (!info->attrs[NL80211_ATTR_SSID] ||
9200             !nla_len(info->attrs[NL80211_ATTR_SSID]))
9201                 return -EINVAL;
9202
9203         ibss.beacon_interval = 100;
9204
9205         if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
9206                 ibss.beacon_interval =
9207                         nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
9208
9209         err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
9210                                            ibss.beacon_interval);
9211         if (err)
9212                 return err;
9213
9214         if (!rdev->ops->join_ibss)
9215                 return -EOPNOTSUPP;
9216
9217         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
9218                 return -EOPNOTSUPP;
9219
9220         wiphy = &rdev->wiphy;
9221
9222         if (info->attrs[NL80211_ATTR_MAC]) {
9223                 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9224
9225                 if (!is_valid_ether_addr(ibss.bssid))
9226                         return -EINVAL;
9227         }
9228         ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9229         ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9230
9231         if (info->attrs[NL80211_ATTR_IE]) {
9232                 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9233                 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9234         }
9235
9236         err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
9237         if (err)
9238                 return err;
9239
9240         if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
9241                                      NL80211_IFTYPE_ADHOC))
9242                 return -EINVAL;
9243
9244         switch (ibss.chandef.width) {
9245         case NL80211_CHAN_WIDTH_5:
9246         case NL80211_CHAN_WIDTH_10:
9247         case NL80211_CHAN_WIDTH_20_NOHT:
9248                 break;
9249         case NL80211_CHAN_WIDTH_20:
9250         case NL80211_CHAN_WIDTH_40:
9251                 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
9252                         return -EINVAL;
9253                 break;
9254         case NL80211_CHAN_WIDTH_80:
9255         case NL80211_CHAN_WIDTH_80P80:
9256         case NL80211_CHAN_WIDTH_160:
9257                 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
9258                         return -EINVAL;
9259                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
9260                                              NL80211_EXT_FEATURE_VHT_IBSS))
9261                         return -EINVAL;
9262                 break;
9263         default:
9264                 return -EINVAL;
9265         }
9266
9267         ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
9268         ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
9269
9270         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
9271                 u8 *rates =
9272                         nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9273                 int n_rates =
9274                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9275                 struct ieee80211_supported_band *sband =
9276                         wiphy->bands[ibss.chandef.chan->band];
9277
9278                 err = ieee80211_get_ratemask(sband, rates, n_rates,
9279                                              &ibss.basic_rates);
9280                 if (err)
9281                         return err;
9282         }
9283
9284         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9285                 memcpy(&ibss.ht_capa_mask,
9286                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9287                        sizeof(ibss.ht_capa_mask));
9288
9289         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9290                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9291                         return -EINVAL;
9292                 memcpy(&ibss.ht_capa,
9293                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9294                        sizeof(ibss.ht_capa));
9295         }
9296
9297         if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
9298             !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
9299                         nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
9300                 return -EINVAL;
9301
9302         if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
9303                 bool no_ht = false;
9304
9305                 connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
9306                 if (IS_ERR(connkeys))
9307                         return PTR_ERR(connkeys);
9308
9309                 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
9310                     no_ht) {
9311                         kzfree(connkeys);
9312                         return -EINVAL;
9313                 }
9314         }
9315
9316         ibss.control_port =
9317                 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
9318
9319         if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
9320                 int r = validate_pae_over_nl80211(rdev, info);
9321
9322                 if (r < 0) {
9323                         kzfree(connkeys);
9324                         return r;
9325                 }
9326
9327                 ibss.control_port_over_nl80211 = true;
9328         }
9329
9330         ibss.userspace_handles_dfs =
9331                 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
9332
9333         wdev_lock(dev->ieee80211_ptr);
9334         err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
9335         if (err)
9336                 kzfree(connkeys);
9337         else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
9338                 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9339         wdev_unlock(dev->ieee80211_ptr);
9340
9341         return err;
9342 }
9343
9344 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
9345 {
9346         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9347         struct net_device *dev = info->user_ptr[1];
9348
9349         if (!rdev->ops->leave_ibss)
9350                 return -EOPNOTSUPP;
9351
9352         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
9353                 return -EOPNOTSUPP;
9354
9355         return cfg80211_leave_ibss(rdev, dev, false);
9356 }
9357
9358 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
9359 {
9360         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9361         struct net_device *dev = info->user_ptr[1];
9362         int mcast_rate[NUM_NL80211_BANDS];
9363         u32 nla_rate;
9364         int err;
9365
9366         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
9367             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
9368             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
9369                 return -EOPNOTSUPP;
9370
9371         if (!rdev->ops->set_mcast_rate)
9372                 return -EOPNOTSUPP;
9373
9374         memset(mcast_rate, 0, sizeof(mcast_rate));
9375
9376         if (!info->attrs[NL80211_ATTR_MCAST_RATE])
9377                 return -EINVAL;
9378
9379         nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
9380         if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
9381                 return -EINVAL;
9382
9383         err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
9384
9385         return err;
9386 }
9387
9388 static struct sk_buff *
9389 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
9390                             struct wireless_dev *wdev, int approxlen,
9391                             u32 portid, u32 seq, enum nl80211_commands cmd,
9392                             enum nl80211_attrs attr,
9393                             const struct nl80211_vendor_cmd_info *info,
9394                             gfp_t gfp)
9395 {
9396         struct sk_buff *skb;
9397         void *hdr;
9398         struct nlattr *data;
9399
9400         skb = nlmsg_new(approxlen + 100, gfp);
9401         if (!skb)
9402                 return NULL;
9403
9404         hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
9405         if (!hdr) {
9406                 kfree_skb(skb);
9407                 return NULL;
9408         }
9409
9410         if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
9411                 goto nla_put_failure;
9412
9413         if (info) {
9414                 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
9415                                 info->vendor_id))
9416                         goto nla_put_failure;
9417                 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
9418                                 info->subcmd))
9419                         goto nla_put_failure;
9420         }
9421
9422         if (wdev) {
9423                 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
9424                                       wdev_id(wdev), NL80211_ATTR_PAD))
9425                         goto nla_put_failure;
9426                 if (wdev->netdev &&
9427                     nla_put_u32(skb, NL80211_ATTR_IFINDEX,
9428                                 wdev->netdev->ifindex))
9429                         goto nla_put_failure;
9430         }
9431
9432         data = nla_nest_start_noflag(skb, attr);
9433         if (!data)
9434                 goto nla_put_failure;
9435
9436         ((void **)skb->cb)[0] = rdev;
9437         ((void **)skb->cb)[1] = hdr;
9438         ((void **)skb->cb)[2] = data;
9439
9440         return skb;
9441
9442  nla_put_failure:
9443         kfree_skb(skb);
9444         return NULL;
9445 }
9446
9447 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
9448                                            struct wireless_dev *wdev,
9449                                            enum nl80211_commands cmd,
9450                                            enum nl80211_attrs attr,
9451                                            unsigned int portid,
9452                                            int vendor_event_idx,
9453                                            int approxlen, gfp_t gfp)
9454 {
9455         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
9456         const struct nl80211_vendor_cmd_info *info;
9457
9458         switch (cmd) {
9459         case NL80211_CMD_TESTMODE:
9460                 if (WARN_ON(vendor_event_idx != -1))
9461                         return NULL;
9462                 info = NULL;
9463                 break;
9464         case NL80211_CMD_VENDOR:
9465                 if (WARN_ON(vendor_event_idx < 0 ||
9466                             vendor_event_idx >= wiphy->n_vendor_events))
9467                         return NULL;
9468                 info = &wiphy->vendor_events[vendor_event_idx];
9469                 break;
9470         default:
9471                 WARN_ON(1);
9472                 return NULL;
9473         }
9474
9475         return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0,
9476                                            cmd, attr, info, gfp);
9477 }
9478 EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
9479
9480 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
9481 {
9482         struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
9483         void *hdr = ((void **)skb->cb)[1];
9484         struct nlmsghdr *nlhdr = nlmsg_hdr(skb);
9485         struct nlattr *data = ((void **)skb->cb)[2];
9486         enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
9487
9488         /* clear CB data for netlink core to own from now on */
9489         memset(skb->cb, 0, sizeof(skb->cb));
9490
9491         nla_nest_end(skb, data);
9492         genlmsg_end(skb, hdr);
9493
9494         if (nlhdr->nlmsg_pid) {
9495                 genlmsg_unicast(wiphy_net(&rdev->wiphy), skb,
9496                                 nlhdr->nlmsg_pid);
9497         } else {
9498                 if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
9499                         mcgrp = NL80211_MCGRP_VENDOR;
9500
9501                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
9502                                         skb, 0, mcgrp, gfp);
9503         }
9504 }
9505 EXPORT_SYMBOL(__cfg80211_send_event_skb);
9506
9507 #ifdef CONFIG_NL80211_TESTMODE
9508 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
9509 {
9510         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9511         struct wireless_dev *wdev =
9512                 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
9513         int err;
9514
9515         if (!rdev->ops->testmode_cmd)
9516                 return -EOPNOTSUPP;
9517
9518         if (IS_ERR(wdev)) {
9519                 err = PTR_ERR(wdev);
9520                 if (err != -EINVAL)
9521                         return err;
9522                 wdev = NULL;
9523         } else if (wdev->wiphy != &rdev->wiphy) {
9524                 return -EINVAL;
9525         }
9526
9527         if (!info->attrs[NL80211_ATTR_TESTDATA])
9528                 return -EINVAL;
9529
9530         rdev->cur_cmd_info = info;
9531         err = rdev_testmode_cmd(rdev, wdev,
9532                                 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
9533                                 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
9534         rdev->cur_cmd_info = NULL;
9535
9536         return err;
9537 }
9538
9539 static int nl80211_testmode_dump(struct sk_buff *skb,
9540                                  struct netlink_callback *cb)
9541 {
9542         struct cfg80211_registered_device *rdev;
9543         int err;
9544         long phy_idx;
9545         void *data = NULL;
9546         int data_len = 0;
9547
9548         rtnl_lock();
9549
9550         if (cb->args[0]) {
9551                 /*
9552                  * 0 is a valid index, but not valid for args[0],
9553                  * so we need to offset by 1.
9554                  */
9555                 phy_idx = cb->args[0] - 1;
9556
9557                 rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
9558                 if (!rdev) {
9559                         err = -ENOENT;
9560                         goto out_err;
9561                 }
9562         } else {
9563                 struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
9564
9565                 err = nlmsg_parse_deprecated(cb->nlh,
9566                                              GENL_HDRLEN + nl80211_fam.hdrsize,
9567                                              attrbuf, nl80211_fam.maxattr,
9568                                              nl80211_policy, NULL);
9569                 if (err)
9570                         goto out_err;
9571
9572                 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
9573                 if (IS_ERR(rdev)) {
9574                         err = PTR_ERR(rdev);
9575                         goto out_err;
9576                 }
9577                 phy_idx = rdev->wiphy_idx;
9578
9579                 if (attrbuf[NL80211_ATTR_TESTDATA])
9580                         cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
9581         }
9582
9583         if (cb->args[1]) {
9584                 data = nla_data((void *)cb->args[1]);
9585                 data_len = nla_len((void *)cb->args[1]);
9586         }
9587
9588         if (!rdev->ops->testmode_dump) {
9589                 err = -EOPNOTSUPP;
9590                 goto out_err;
9591         }
9592
9593         while (1) {
9594                 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
9595                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
9596                                            NL80211_CMD_TESTMODE);
9597                 struct nlattr *tmdata;
9598
9599                 if (!hdr)
9600                         break;
9601
9602                 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
9603                         genlmsg_cancel(skb, hdr);
9604                         break;
9605                 }
9606
9607                 tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA);
9608                 if (!tmdata) {
9609                         genlmsg_cancel(skb, hdr);
9610                         break;
9611                 }
9612                 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
9613                 nla_nest_end(skb, tmdata);
9614
9615                 if (err == -ENOBUFS || err == -ENOENT) {
9616                         genlmsg_cancel(skb, hdr);
9617                         break;
9618                 } else if (err) {
9619                         genlmsg_cancel(skb, hdr);
9620                         goto out_err;
9621                 }
9622
9623                 genlmsg_end(skb, hdr);
9624         }
9625
9626         err = skb->len;
9627         /* see above */
9628         cb->args[0] = phy_idx + 1;
9629  out_err:
9630         rtnl_unlock();
9631         return err;
9632 }
9633 #endif
9634
9635 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
9636 {
9637         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9638         struct net_device *dev = info->user_ptr[1];
9639         struct cfg80211_connect_params connect;
9640         struct wiphy *wiphy;
9641         struct cfg80211_cached_keys *connkeys = NULL;
9642         int err;
9643
9644         memset(&connect, 0, sizeof(connect));
9645
9646         if (!info->attrs[NL80211_ATTR_SSID] ||
9647             !nla_len(info->attrs[NL80211_ATTR_SSID]))
9648                 return -EINVAL;
9649
9650         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
9651                 connect.auth_type =
9652                         nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9653                 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
9654                                              NL80211_CMD_CONNECT))
9655                         return -EINVAL;
9656         } else
9657                 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
9658
9659         connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
9660
9661         if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
9662             !wiphy_ext_feature_isset(&rdev->wiphy,
9663                                      NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
9664                 return -EINVAL;
9665         connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
9666
9667         err = nl80211_crypto_settings(rdev, info, &connect.crypto,
9668                                       NL80211_MAX_NR_CIPHER_SUITES);
9669         if (err)
9670                 return err;
9671
9672         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9673             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9674                 return -EOPNOTSUPP;
9675
9676         wiphy = &rdev->wiphy;
9677
9678         connect.bg_scan_period = -1;
9679         if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
9680                 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
9681                 connect.bg_scan_period =
9682                         nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
9683         }
9684
9685         if (info->attrs[NL80211_ATTR_MAC])
9686                 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
9687         else if (info->attrs[NL80211_ATTR_MAC_HINT])
9688                 connect.bssid_hint =
9689                         nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
9690         connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
9691         connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
9692
9693         if (info->attrs[NL80211_ATTR_IE]) {
9694                 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9695                 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9696         }
9697
9698         if (info->attrs[NL80211_ATTR_USE_MFP]) {
9699                 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
9700                 if (connect.mfp == NL80211_MFP_OPTIONAL &&
9701                     !wiphy_ext_feature_isset(&rdev->wiphy,
9702                                              NL80211_EXT_FEATURE_MFP_OPTIONAL))
9703                         return -EOPNOTSUPP;
9704         } else {
9705                 connect.mfp = NL80211_MFP_NO;
9706         }
9707
9708         if (info->attrs[NL80211_ATTR_PREV_BSSID])
9709                 connect.prev_bssid =
9710                         nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
9711
9712         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9713                 connect.channel = nl80211_get_valid_chan(
9714                         wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
9715                 if (!connect.channel)
9716                         return -EINVAL;
9717         } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
9718                 connect.channel_hint = nl80211_get_valid_chan(
9719                         wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
9720                 if (!connect.channel_hint)
9721                         return -EINVAL;
9722         }
9723
9724         if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
9725                 connkeys = nl80211_parse_connkeys(rdev, info, NULL);
9726                 if (IS_ERR(connkeys))
9727                         return PTR_ERR(connkeys);
9728         }
9729
9730         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
9731                 connect.flags |= ASSOC_REQ_DISABLE_HT;
9732
9733         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
9734                 memcpy(&connect.ht_capa_mask,
9735                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
9736                        sizeof(connect.ht_capa_mask));
9737
9738         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
9739                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
9740                         kzfree(connkeys);
9741                         return -EINVAL;
9742                 }
9743                 memcpy(&connect.ht_capa,
9744                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
9745                        sizeof(connect.ht_capa));
9746         }
9747
9748         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
9749                 connect.flags |= ASSOC_REQ_DISABLE_VHT;
9750
9751         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
9752                 memcpy(&connect.vht_capa_mask,
9753                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
9754                        sizeof(connect.vht_capa_mask));
9755
9756         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
9757                 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
9758                         kzfree(connkeys);
9759                         return -EINVAL;
9760                 }
9761                 memcpy(&connect.vht_capa,
9762                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
9763                        sizeof(connect.vht_capa));
9764         }
9765
9766         if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
9767                 if (!((rdev->wiphy.features &
9768                         NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
9769                        (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
9770                     !wiphy_ext_feature_isset(&rdev->wiphy,
9771                                              NL80211_EXT_FEATURE_RRM)) {
9772                         kzfree(connkeys);
9773                         return -EINVAL;
9774                 }
9775                 connect.flags |= ASSOC_REQ_USE_RRM;
9776         }
9777
9778         connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
9779         if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
9780                 kzfree(connkeys);
9781                 return -EOPNOTSUPP;
9782         }
9783
9784         if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
9785                 /* bss selection makes no sense if bssid is set */
9786                 if (connect.bssid) {
9787                         kzfree(connkeys);
9788                         return -EINVAL;
9789                 }
9790
9791                 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
9792                                        wiphy, &connect.bss_select);
9793                 if (err) {
9794                         kzfree(connkeys);
9795                         return err;
9796                 }
9797         }
9798
9799         if (wiphy_ext_feature_isset(&rdev->wiphy,
9800                                     NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
9801             info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
9802             info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
9803             info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
9804             info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9805                 connect.fils_erp_username =
9806                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9807                 connect.fils_erp_username_len =
9808                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9809                 connect.fils_erp_realm =
9810                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9811                 connect.fils_erp_realm_len =
9812                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9813                 connect.fils_erp_next_seq_num =
9814                         nla_get_u16(
9815                            info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
9816                 connect.fils_erp_rrk =
9817                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9818                 connect.fils_erp_rrk_len =
9819                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9820         } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
9821                    info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
9822                    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
9823                    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9824                 kzfree(connkeys);
9825                 return -EINVAL;
9826         }
9827
9828         if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
9829                 if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9830                         kzfree(connkeys);
9831                         GENL_SET_ERR_MSG(info,
9832                                          "external auth requires connection ownership");
9833                         return -EINVAL;
9834                 }
9835                 connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
9836         }
9837
9838         wdev_lock(dev->ieee80211_ptr);
9839
9840         err = cfg80211_connect(rdev, dev, &connect, connkeys,
9841                                connect.prev_bssid);
9842         if (err)
9843                 kzfree(connkeys);
9844
9845         if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
9846                 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
9847                 if (connect.bssid)
9848                         memcpy(dev->ieee80211_ptr->disconnect_bssid,
9849                                connect.bssid, ETH_ALEN);
9850                 else
9851                         memset(dev->ieee80211_ptr->disconnect_bssid,
9852                                0, ETH_ALEN);
9853         }
9854
9855         wdev_unlock(dev->ieee80211_ptr);
9856
9857         return err;
9858 }
9859
9860 static int nl80211_update_connect_params(struct sk_buff *skb,
9861                                          struct genl_info *info)
9862 {
9863         struct cfg80211_connect_params connect = {};
9864         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9865         struct net_device *dev = info->user_ptr[1];
9866         struct wireless_dev *wdev = dev->ieee80211_ptr;
9867         bool fils_sk_offload;
9868         u32 auth_type;
9869         u32 changed = 0;
9870         int ret;
9871
9872         if (!rdev->ops->update_connect_params)
9873                 return -EOPNOTSUPP;
9874
9875         if (info->attrs[NL80211_ATTR_IE]) {
9876                 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
9877                 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
9878                 changed |= UPDATE_ASSOC_IES;
9879         }
9880
9881         fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy,
9882                                                   NL80211_EXT_FEATURE_FILS_SK_OFFLOAD);
9883
9884         /*
9885          * when driver supports fils-sk offload all attributes must be
9886          * provided. So the else covers "fils-sk-not-all" and
9887          * "no-fils-sk-any".
9888          */
9889         if (fils_sk_offload &&
9890             info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
9891             info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
9892             info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
9893             info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9894                 connect.fils_erp_username =
9895                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9896                 connect.fils_erp_username_len =
9897                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
9898                 connect.fils_erp_realm =
9899                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9900                 connect.fils_erp_realm_len =
9901                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
9902                 connect.fils_erp_next_seq_num =
9903                         nla_get_u16(
9904                            info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
9905                 connect.fils_erp_rrk =
9906                         nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9907                 connect.fils_erp_rrk_len =
9908                         nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
9909                 changed |= UPDATE_FILS_ERP_INFO;
9910         } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
9911                    info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
9912                    info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
9913                    info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
9914                 return -EINVAL;
9915         }
9916
9917         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
9918                 auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
9919                 if (!nl80211_valid_auth_type(rdev, auth_type,
9920                                              NL80211_CMD_CONNECT))
9921                         return -EINVAL;
9922
9923                 if (auth_type == NL80211_AUTHTYPE_FILS_SK &&
9924                     fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO))
9925                         return -EINVAL;
9926
9927                 connect.auth_type = auth_type;
9928                 changed |= UPDATE_AUTH_TYPE;
9929         }
9930
9931         wdev_lock(dev->ieee80211_ptr);
9932         if (!wdev->current_bss)
9933                 ret = -ENOLINK;
9934         else
9935                 ret = rdev_update_connect_params(rdev, dev, &connect, changed);
9936         wdev_unlock(dev->ieee80211_ptr);
9937
9938         return ret;
9939 }
9940
9941 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
9942 {
9943         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9944         struct net_device *dev = info->user_ptr[1];
9945         u16 reason;
9946         int ret;
9947
9948         if (dev->ieee80211_ptr->conn_owner_nlportid &&
9949             dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
9950                 return -EPERM;
9951
9952         if (!info->attrs[NL80211_ATTR_REASON_CODE])
9953                 reason = WLAN_REASON_DEAUTH_LEAVING;
9954         else
9955                 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
9956
9957         if (reason == 0)
9958                 return -EINVAL;
9959
9960         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
9961             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
9962                 return -EOPNOTSUPP;
9963
9964         wdev_lock(dev->ieee80211_ptr);
9965         ret = cfg80211_disconnect(rdev, dev, reason, true);
9966         wdev_unlock(dev->ieee80211_ptr);
9967         return ret;
9968 }
9969
9970 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
9971 {
9972         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9973         struct net *net;
9974         int err;
9975
9976         if (info->attrs[NL80211_ATTR_PID]) {
9977                 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
9978
9979                 net = get_net_ns_by_pid(pid);
9980         } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
9981                 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
9982
9983                 net = get_net_ns_by_fd(fd);
9984         } else {
9985                 return -EINVAL;
9986         }
9987
9988         if (IS_ERR(net))
9989                 return PTR_ERR(net);
9990
9991         err = 0;
9992
9993         /* check if anything to do */
9994         if (!net_eq(wiphy_net(&rdev->wiphy), net))
9995                 err = cfg80211_switch_netns(rdev, net);
9996
9997         put_net(net);
9998         return err;
9999 }
10000
10001 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
10002 {
10003         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10004         int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
10005                         struct cfg80211_pmksa *pmksa) = NULL;
10006         struct net_device *dev = info->user_ptr[1];
10007         struct cfg80211_pmksa pmksa;
10008
10009         memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
10010
10011         if (!info->attrs[NL80211_ATTR_PMKID])
10012                 return -EINVAL;
10013
10014         pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
10015
10016         if (info->attrs[NL80211_ATTR_MAC]) {
10017                 pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
10018         } else if (info->attrs[NL80211_ATTR_SSID] &&
10019                    info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
10020                    (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
10021                     info->attrs[NL80211_ATTR_PMK])) {
10022                 pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
10023                 pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
10024                 pmksa.cache_id =
10025                         nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
10026         } else {
10027                 return -EINVAL;
10028         }
10029         if (info->attrs[NL80211_ATTR_PMK]) {
10030                 pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
10031                 pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
10032         }
10033
10034         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10035             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
10036             !(dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP &&
10037               wiphy_ext_feature_isset(&rdev->wiphy,
10038                                       NL80211_EXT_FEATURE_AP_PMKSA_CACHING)))
10039                 return -EOPNOTSUPP;
10040
10041         switch (info->genlhdr->cmd) {
10042         case NL80211_CMD_SET_PMKSA:
10043                 rdev_ops = rdev->ops->set_pmksa;
10044                 break;
10045         case NL80211_CMD_DEL_PMKSA:
10046                 rdev_ops = rdev->ops->del_pmksa;
10047                 break;
10048         default:
10049                 WARN_ON(1);
10050                 break;
10051         }
10052
10053         if (!rdev_ops)
10054                 return -EOPNOTSUPP;
10055
10056         return rdev_ops(&rdev->wiphy, dev, &pmksa);
10057 }
10058
10059 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
10060 {
10061         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10062         struct net_device *dev = info->user_ptr[1];
10063
10064         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
10065             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
10066                 return -EOPNOTSUPP;
10067
10068         if (!rdev->ops->flush_pmksa)
10069                 return -EOPNOTSUPP;
10070
10071         return rdev_flush_pmksa(rdev, dev);
10072 }
10073
10074 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
10075 {
10076         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10077         struct net_device *dev = info->user_ptr[1];
10078         u8 action_code, dialog_token;
10079         u32 peer_capability = 0;
10080         u16 status_code;
10081         u8 *peer;
10082         bool initiator;
10083
10084         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
10085             !rdev->ops->tdls_mgmt)
10086                 return -EOPNOTSUPP;
10087
10088         if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
10089             !info->attrs[NL80211_ATTR_STATUS_CODE] ||
10090             !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
10091             !info->attrs[NL80211_ATTR_IE] ||
10092             !info->attrs[NL80211_ATTR_MAC])
10093                 return -EINVAL;
10094
10095         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
10096         action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
10097         status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
10098         dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
10099         initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
10100         if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
10101                 peer_capability =
10102                         nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
10103
10104         return rdev_tdls_mgmt(rdev, dev, peer, action_code,
10105                               dialog_token, status_code, peer_capability,
10106                               initiator,
10107                               nla_data(info->attrs[NL80211_ATTR_IE]),
10108                               nla_len(info->attrs[NL80211_ATTR_IE]));
10109 }
10110
10111 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
10112 {
10113         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10114         struct net_device *dev = info->user_ptr[1];
10115         enum nl80211_tdls_operation operation;
10116         u8 *peer;
10117
10118         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
10119             !rdev->ops->tdls_oper)
10120                 return -EOPNOTSUPP;
10121
10122         if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
10123             !info->attrs[NL80211_ATTR_MAC])
10124                 return -EINVAL;
10125
10126         operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
10127         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
10128
10129         return rdev_tdls_oper(rdev, dev, peer, operation);
10130 }
10131
10132 static int nl80211_remain_on_channel(struct sk_buff *skb,
10133                                      struct genl_info *info)
10134 {
10135         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10136         struct wireless_dev *wdev = info->user_ptr[1];
10137         struct cfg80211_chan_def chandef;
10138         const struct cfg80211_chan_def *compat_chandef;
10139         struct sk_buff *msg;
10140         void *hdr;
10141         u64 cookie;
10142         u32 duration;
10143         int err;
10144
10145         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
10146             !info->attrs[NL80211_ATTR_DURATION])
10147                 return -EINVAL;
10148
10149         duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
10150
10151         if (!rdev->ops->remain_on_channel ||
10152             !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
10153                 return -EOPNOTSUPP;
10154
10155         /*
10156          * We should be on that channel for at least a minimum amount of
10157          * time (10ms) but no longer than the driver supports.
10158          */
10159         if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
10160             duration > rdev->wiphy.max_remain_on_channel_duration)
10161                 return -EINVAL;
10162
10163         err = nl80211_parse_chandef(rdev, info, &chandef);
10164         if (err)
10165                 return err;
10166
10167         wdev_lock(wdev);
10168         if (!cfg80211_off_channel_oper_allowed(wdev) &&
10169             !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
10170                 compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
10171                                                              &chandef);
10172                 if (compat_chandef != &chandef) {
10173                         wdev_unlock(wdev);
10174                         return -EBUSY;
10175                 }
10176         }
10177         wdev_unlock(wdev);
10178
10179         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10180         if (!msg)
10181                 return -ENOMEM;
10182
10183         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10184                              NL80211_CMD_REMAIN_ON_CHANNEL);
10185         if (!hdr) {
10186                 err = -ENOBUFS;
10187                 goto free_msg;
10188         }
10189
10190         err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
10191                                      duration, &cookie);
10192
10193         if (err)
10194                 goto free_msg;
10195
10196         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10197                               NL80211_ATTR_PAD))
10198                 goto nla_put_failure;
10199
10200         genlmsg_end(msg, hdr);
10201
10202         return genlmsg_reply(msg, info);
10203
10204  nla_put_failure:
10205         err = -ENOBUFS;
10206  free_msg:
10207         nlmsg_free(msg);
10208         return err;
10209 }
10210
10211 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
10212                                             struct genl_info *info)
10213 {
10214         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10215         struct wireless_dev *wdev = info->user_ptr[1];
10216         u64 cookie;
10217
10218         if (!info->attrs[NL80211_ATTR_COOKIE])
10219                 return -EINVAL;
10220
10221         if (!rdev->ops->cancel_remain_on_channel)
10222                 return -EOPNOTSUPP;
10223
10224         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10225
10226         return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
10227 }
10228
10229 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
10230                                        struct genl_info *info)
10231 {
10232         struct cfg80211_bitrate_mask mask;
10233         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10234         struct net_device *dev = info->user_ptr[1];
10235         int err;
10236
10237         if (!rdev->ops->set_bitrate_mask)
10238                 return -EOPNOTSUPP;
10239
10240         err = nl80211_parse_tx_bitrate_mask(info, &mask);
10241         if (err)
10242                 return err;
10243
10244         return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
10245 }
10246
10247 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
10248 {
10249         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10250         struct wireless_dev *wdev = info->user_ptr[1];
10251         u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
10252
10253         if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
10254                 return -EINVAL;
10255
10256         if (info->attrs[NL80211_ATTR_FRAME_TYPE])
10257                 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
10258
10259         switch (wdev->iftype) {
10260         case NL80211_IFTYPE_STATION:
10261         case NL80211_IFTYPE_ADHOC:
10262         case NL80211_IFTYPE_P2P_CLIENT:
10263         case NL80211_IFTYPE_AP:
10264         case NL80211_IFTYPE_AP_VLAN:
10265         case NL80211_IFTYPE_MESH_POINT:
10266         case NL80211_IFTYPE_P2P_GO:
10267         case NL80211_IFTYPE_P2P_DEVICE:
10268                 break;
10269         case NL80211_IFTYPE_NAN:
10270         default:
10271                 return -EOPNOTSUPP;
10272         }
10273
10274         /* not much point in registering if we can't reply */
10275         if (!rdev->ops->mgmt_tx)
10276                 return -EOPNOTSUPP;
10277
10278         return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
10279                         nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
10280                         nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
10281 }
10282
10283 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
10284 {
10285         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10286         struct wireless_dev *wdev = info->user_ptr[1];
10287         struct cfg80211_chan_def chandef;
10288         int err;
10289         void *hdr = NULL;
10290         u64 cookie;
10291         struct sk_buff *msg = NULL;
10292         struct cfg80211_mgmt_tx_params params = {
10293                 .dont_wait_for_ack =
10294                         info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
10295         };
10296
10297         if (!info->attrs[NL80211_ATTR_FRAME])
10298                 return -EINVAL;
10299
10300         if (!rdev->ops->mgmt_tx)
10301                 return -EOPNOTSUPP;
10302
10303         switch (wdev->iftype) {
10304         case NL80211_IFTYPE_P2P_DEVICE:
10305                 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
10306                         return -EINVAL;
10307         case NL80211_IFTYPE_STATION:
10308         case NL80211_IFTYPE_ADHOC:
10309         case NL80211_IFTYPE_P2P_CLIENT:
10310         case NL80211_IFTYPE_AP:
10311         case NL80211_IFTYPE_AP_VLAN:
10312         case NL80211_IFTYPE_MESH_POINT:
10313         case NL80211_IFTYPE_P2P_GO:
10314                 break;
10315         case NL80211_IFTYPE_NAN:
10316         default:
10317                 return -EOPNOTSUPP;
10318         }
10319
10320         if (info->attrs[NL80211_ATTR_DURATION]) {
10321                 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
10322                         return -EINVAL;
10323                 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
10324
10325                 /*
10326                  * We should wait on the channel for at least a minimum amount
10327                  * of time (10ms) but no longer than the driver supports.
10328                  */
10329                 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
10330                     params.wait > rdev->wiphy.max_remain_on_channel_duration)
10331                         return -EINVAL;
10332         }
10333
10334         params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
10335
10336         if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
10337                 return -EINVAL;
10338
10339         params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
10340
10341         /* get the channel if any has been specified, otherwise pass NULL to
10342          * the driver. The latter will use the current one
10343          */
10344         chandef.chan = NULL;
10345         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
10346                 err = nl80211_parse_chandef(rdev, info, &chandef);
10347                 if (err)
10348                         return err;
10349         }
10350
10351         if (!chandef.chan && params.offchan)
10352                 return -EINVAL;
10353
10354         wdev_lock(wdev);
10355         if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
10356                 wdev_unlock(wdev);
10357                 return -EBUSY;
10358         }
10359         wdev_unlock(wdev);
10360
10361         params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
10362         params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
10363
10364         if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
10365                 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
10366                 int i;
10367
10368                 if (len % sizeof(u16))
10369                         return -EINVAL;
10370
10371                 params.n_csa_offsets = len / sizeof(u16);
10372                 params.csa_offsets =
10373                         nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
10374
10375                 /* check that all the offsets fit the frame */
10376                 for (i = 0; i < params.n_csa_offsets; i++) {
10377                         if (params.csa_offsets[i] >= params.len)
10378                                 return -EINVAL;
10379                 }
10380         }
10381
10382         if (!params.dont_wait_for_ack) {
10383                 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10384                 if (!msg)
10385                         return -ENOMEM;
10386
10387                 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10388                                      NL80211_CMD_FRAME);
10389                 if (!hdr) {
10390                         err = -ENOBUFS;
10391                         goto free_msg;
10392                 }
10393         }
10394
10395         params.chan = chandef.chan;
10396         err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
10397         if (err)
10398                 goto free_msg;
10399
10400         if (msg) {
10401                 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10402                                       NL80211_ATTR_PAD))
10403                         goto nla_put_failure;
10404
10405                 genlmsg_end(msg, hdr);
10406                 return genlmsg_reply(msg, info);
10407         }
10408
10409         return 0;
10410
10411  nla_put_failure:
10412         err = -ENOBUFS;
10413  free_msg:
10414         nlmsg_free(msg);
10415         return err;
10416 }
10417
10418 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
10419 {
10420         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10421         struct wireless_dev *wdev = info->user_ptr[1];
10422         u64 cookie;
10423
10424         if (!info->attrs[NL80211_ATTR_COOKIE])
10425                 return -EINVAL;
10426
10427         if (!rdev->ops->mgmt_tx_cancel_wait)
10428                 return -EOPNOTSUPP;
10429
10430         switch (wdev->iftype) {
10431         case NL80211_IFTYPE_STATION:
10432         case NL80211_IFTYPE_ADHOC:
10433         case NL80211_IFTYPE_P2P_CLIENT:
10434         case NL80211_IFTYPE_AP:
10435         case NL80211_IFTYPE_AP_VLAN:
10436         case NL80211_IFTYPE_P2P_GO:
10437         case NL80211_IFTYPE_P2P_DEVICE:
10438                 break;
10439         case NL80211_IFTYPE_NAN:
10440         default:
10441                 return -EOPNOTSUPP;
10442         }
10443
10444         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10445
10446         return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
10447 }
10448
10449 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
10450 {
10451         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10452         struct wireless_dev *wdev;
10453         struct net_device *dev = info->user_ptr[1];
10454         u8 ps_state;
10455         bool state;
10456         int err;
10457
10458         if (!info->attrs[NL80211_ATTR_PS_STATE])
10459                 return -EINVAL;
10460
10461         ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
10462
10463         wdev = dev->ieee80211_ptr;
10464
10465         if (!rdev->ops->set_power_mgmt)
10466                 return -EOPNOTSUPP;
10467
10468         state = (ps_state == NL80211_PS_ENABLED) ? true : false;
10469
10470         if (state == wdev->ps)
10471                 return 0;
10472
10473         err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
10474         if (!err)
10475                 wdev->ps = state;
10476         return err;
10477 }
10478
10479 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
10480 {
10481         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10482         enum nl80211_ps_state ps_state;
10483         struct wireless_dev *wdev;
10484         struct net_device *dev = info->user_ptr[1];
10485         struct sk_buff *msg;
10486         void *hdr;
10487         int err;
10488
10489         wdev = dev->ieee80211_ptr;
10490
10491         if (!rdev->ops->set_power_mgmt)
10492                 return -EOPNOTSUPP;
10493
10494         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10495         if (!msg)
10496                 return -ENOMEM;
10497
10498         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10499                              NL80211_CMD_GET_POWER_SAVE);
10500         if (!hdr) {
10501                 err = -ENOBUFS;
10502                 goto free_msg;
10503         }
10504
10505         if (wdev->ps)
10506                 ps_state = NL80211_PS_ENABLED;
10507         else
10508                 ps_state = NL80211_PS_DISABLED;
10509
10510         if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
10511                 goto nla_put_failure;
10512
10513         genlmsg_end(msg, hdr);
10514         return genlmsg_reply(msg, info);
10515
10516  nla_put_failure:
10517         err = -ENOBUFS;
10518  free_msg:
10519         nlmsg_free(msg);
10520         return err;
10521 }
10522
10523 static const struct nla_policy
10524 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
10525         [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
10526         [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
10527         [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
10528         [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
10529         [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
10530         [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
10531         [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
10532 };
10533
10534 static int nl80211_set_cqm_txe(struct genl_info *info,
10535                                u32 rate, u32 pkts, u32 intvl)
10536 {
10537         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10538         struct net_device *dev = info->user_ptr[1];
10539         struct wireless_dev *wdev = dev->ieee80211_ptr;
10540
10541         if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
10542                 return -EINVAL;
10543
10544         if (!rdev->ops->set_cqm_txe_config)
10545                 return -EOPNOTSUPP;
10546
10547         if (wdev->iftype != NL80211_IFTYPE_STATION &&
10548             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
10549                 return -EOPNOTSUPP;
10550
10551         return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
10552 }
10553
10554 static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
10555                                     struct net_device *dev)
10556 {
10557         struct wireless_dev *wdev = dev->ieee80211_ptr;
10558         s32 last, low, high;
10559         u32 hyst;
10560         int i, n, low_index;
10561         int err;
10562
10563         /* RSSI reporting disabled? */
10564         if (!wdev->cqm_config)
10565                 return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
10566
10567         /*
10568          * Obtain current RSSI value if possible, if not and no RSSI threshold
10569          * event has been received yet, we should receive an event after a
10570          * connection is established and enough beacons received to calculate
10571          * the average.
10572          */
10573         if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
10574             rdev->ops->get_station) {
10575                 struct station_info sinfo = {};
10576                 u8 *mac_addr;
10577
10578                 mac_addr = wdev->current_bss->pub.bssid;
10579
10580                 err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
10581                 if (err)
10582                         return err;
10583
10584                 if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
10585                         wdev->cqm_config->last_rssi_event_value =
10586                                 (s8) sinfo.rx_beacon_signal_avg;
10587         }
10588
10589         last = wdev->cqm_config->last_rssi_event_value;
10590         hyst = wdev->cqm_config->rssi_hyst;
10591         n = wdev->cqm_config->n_rssi_thresholds;
10592
10593         for (i = 0; i < n; i++)
10594                 if (last < wdev->cqm_config->rssi_thresholds[i])
10595                         break;
10596
10597         low_index = i - 1;
10598         if (low_index >= 0) {
10599                 low_index = array_index_nospec(low_index, n);
10600                 low = wdev->cqm_config->rssi_thresholds[low_index] - hyst;
10601         } else {
10602                 low = S32_MIN;
10603         }
10604         if (i < n) {
10605                 i = array_index_nospec(i, n);
10606                 high = wdev->cqm_config->rssi_thresholds[i] + hyst - 1;
10607         } else {
10608                 high = S32_MAX;
10609         }
10610
10611         return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
10612 }
10613
10614 static int nl80211_set_cqm_rssi(struct genl_info *info,
10615                                 const s32 *thresholds, int n_thresholds,
10616                                 u32 hysteresis)
10617 {
10618         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10619         struct net_device *dev = info->user_ptr[1];
10620         struct wireless_dev *wdev = dev->ieee80211_ptr;
10621         int i, err;
10622         s32 prev = S32_MIN;
10623
10624         /* Check all values negative and sorted */
10625         for (i = 0; i < n_thresholds; i++) {
10626                 if (thresholds[i] > 0 || thresholds[i] <= prev)
10627                         return -EINVAL;
10628
10629                 prev = thresholds[i];
10630         }
10631
10632         if (wdev->iftype != NL80211_IFTYPE_STATION &&
10633             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
10634                 return -EOPNOTSUPP;
10635
10636         wdev_lock(wdev);
10637         cfg80211_cqm_config_free(wdev);
10638         wdev_unlock(wdev);
10639
10640         if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
10641                 if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
10642                         return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
10643
10644                 return rdev_set_cqm_rssi_config(rdev, dev,
10645                                                 thresholds[0], hysteresis);
10646         }
10647
10648         if (!wiphy_ext_feature_isset(&rdev->wiphy,
10649                                      NL80211_EXT_FEATURE_CQM_RSSI_LIST))
10650                 return -EOPNOTSUPP;
10651
10652         if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
10653                 n_thresholds = 0;
10654
10655         wdev_lock(wdev);
10656         if (n_thresholds) {
10657                 struct cfg80211_cqm_config *cqm_config;
10658
10659                 cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
10660                                      n_thresholds * sizeof(s32), GFP_KERNEL);
10661                 if (!cqm_config) {
10662                         err = -ENOMEM;
10663                         goto unlock;
10664                 }
10665
10666                 cqm_config->rssi_hyst = hysteresis;
10667                 cqm_config->n_rssi_thresholds = n_thresholds;
10668                 memcpy(cqm_config->rssi_thresholds, thresholds,
10669                        n_thresholds * sizeof(s32));
10670
10671                 wdev->cqm_config = cqm_config;
10672         }
10673
10674         err = cfg80211_cqm_rssi_update(rdev, dev);
10675
10676 unlock:
10677         wdev_unlock(wdev);
10678
10679         return err;
10680 }
10681
10682 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
10683 {
10684         struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
10685         struct nlattr *cqm;
10686         int err;
10687
10688         cqm = info->attrs[NL80211_ATTR_CQM];
10689         if (!cqm)
10690                 return -EINVAL;
10691
10692         err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm,
10693                                           nl80211_attr_cqm_policy,
10694                                           info->extack);
10695         if (err)
10696                 return err;
10697
10698         if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
10699             attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
10700                 const s32 *thresholds =
10701                         nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
10702                 int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
10703                 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
10704
10705                 if (len % 4)
10706                         return -EINVAL;
10707
10708                 return nl80211_set_cqm_rssi(info, thresholds, len / 4,
10709                                             hysteresis);
10710         }
10711
10712         if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
10713             attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
10714             attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
10715                 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
10716                 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
10717                 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
10718
10719                 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
10720         }
10721
10722         return -EINVAL;
10723 }
10724
10725 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
10726 {
10727         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10728         struct net_device *dev = info->user_ptr[1];
10729         struct ocb_setup setup = {};
10730         int err;
10731
10732         err = nl80211_parse_chandef(rdev, info, &setup.chandef);
10733         if (err)
10734                 return err;
10735
10736         return cfg80211_join_ocb(rdev, dev, &setup);
10737 }
10738
10739 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
10740 {
10741         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10742         struct net_device *dev = info->user_ptr[1];
10743
10744         return cfg80211_leave_ocb(rdev, dev);
10745 }
10746
10747 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
10748 {
10749         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10750         struct net_device *dev = info->user_ptr[1];
10751         struct mesh_config cfg;
10752         struct mesh_setup setup;
10753         int err;
10754
10755         /* start with default */
10756         memcpy(&cfg, &default_mesh_config, sizeof(cfg));
10757         memcpy(&setup, &default_mesh_setup, sizeof(setup));
10758
10759         if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
10760                 /* and parse parameters if given */
10761                 err = nl80211_parse_mesh_config(info, &cfg, NULL);
10762                 if (err)
10763                         return err;
10764         }
10765
10766         if (!info->attrs[NL80211_ATTR_MESH_ID] ||
10767             !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
10768                 return -EINVAL;
10769
10770         setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
10771         setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
10772
10773         if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
10774             !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
10775                             nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
10776                         return -EINVAL;
10777
10778         if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
10779                 setup.beacon_interval =
10780                         nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
10781
10782                 err = cfg80211_validate_beacon_int(rdev,
10783                                                    NL80211_IFTYPE_MESH_POINT,
10784                                                    setup.beacon_interval);
10785                 if (err)
10786                         return err;
10787         }
10788
10789         if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
10790                 setup.dtim_period =
10791                         nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
10792                 if (setup.dtim_period < 1 || setup.dtim_period > 100)
10793                         return -EINVAL;
10794         }
10795
10796         if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
10797                 /* parse additional setup parameters if given */
10798                 err = nl80211_parse_mesh_setup(info, &setup);
10799                 if (err)
10800                         return err;
10801         }
10802
10803         if (setup.user_mpm)
10804                 cfg.auto_open_plinks = false;
10805
10806         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
10807                 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
10808                 if (err)
10809                         return err;
10810         } else {
10811                 /* __cfg80211_join_mesh() will sort it out */
10812                 setup.chandef.chan = NULL;
10813         }
10814
10815         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
10816                 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
10817                 int n_rates =
10818                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
10819                 struct ieee80211_supported_band *sband;
10820
10821                 if (!setup.chandef.chan)
10822                         return -EINVAL;
10823
10824                 sband = rdev->wiphy.bands[setup.chandef.chan->band];
10825
10826                 err = ieee80211_get_ratemask(sband, rates, n_rates,
10827                                              &setup.basic_rates);
10828                 if (err)
10829                         return err;
10830         }
10831
10832         if (info->attrs[NL80211_ATTR_TX_RATES]) {
10833                 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
10834                 if (err)
10835                         return err;
10836
10837                 if (!setup.chandef.chan)
10838                         return -EINVAL;
10839
10840                 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
10841                                               &setup.beacon_rate);
10842                 if (err)
10843                         return err;
10844         }
10845
10846         setup.userspace_handles_dfs =
10847                 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
10848
10849         if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
10850                 int r = validate_pae_over_nl80211(rdev, info);
10851
10852                 if (r < 0)
10853                         return r;
10854
10855                 setup.control_port_over_nl80211 = true;
10856         }
10857
10858         wdev_lock(dev->ieee80211_ptr);
10859         err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
10860         if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
10861                 dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
10862         wdev_unlock(dev->ieee80211_ptr);
10863
10864         return err;
10865 }
10866
10867 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
10868 {
10869         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10870         struct net_device *dev = info->user_ptr[1];
10871
10872         return cfg80211_leave_mesh(rdev, dev);
10873 }
10874
10875 #ifdef CONFIG_PM
10876 static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
10877                                         struct cfg80211_registered_device *rdev)
10878 {
10879         struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
10880         struct nlattr *nl_pats, *nl_pat;
10881         int i, pat_len;
10882
10883         if (!wowlan->n_patterns)
10884                 return 0;
10885
10886         nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
10887         if (!nl_pats)
10888                 return -ENOBUFS;
10889
10890         for (i = 0; i < wowlan->n_patterns; i++) {
10891                 nl_pat = nla_nest_start_noflag(msg, i + 1);
10892                 if (!nl_pat)
10893                         return -ENOBUFS;
10894                 pat_len = wowlan->patterns[i].pattern_len;
10895                 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
10896                             wowlan->patterns[i].mask) ||
10897                     nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10898                             wowlan->patterns[i].pattern) ||
10899                     nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10900                                 wowlan->patterns[i].pkt_offset))
10901                         return -ENOBUFS;
10902                 nla_nest_end(msg, nl_pat);
10903         }
10904         nla_nest_end(msg, nl_pats);
10905
10906         return 0;
10907 }
10908
10909 static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
10910                                    struct cfg80211_wowlan_tcp *tcp)
10911 {
10912         struct nlattr *nl_tcp;
10913
10914         if (!tcp)
10915                 return 0;
10916
10917         nl_tcp = nla_nest_start_noflag(msg,
10918                                        NL80211_WOWLAN_TRIG_TCP_CONNECTION);
10919         if (!nl_tcp)
10920                 return -ENOBUFS;
10921
10922         if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
10923             nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
10924             nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
10925             nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
10926             nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
10927             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
10928                     tcp->payload_len, tcp->payload) ||
10929             nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
10930                         tcp->data_interval) ||
10931             nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
10932                     tcp->wake_len, tcp->wake_data) ||
10933             nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
10934                     DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
10935                 return -ENOBUFS;
10936
10937         if (tcp->payload_seq.len &&
10938             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
10939                     sizeof(tcp->payload_seq), &tcp->payload_seq))
10940                 return -ENOBUFS;
10941
10942         if (tcp->payload_tok.len &&
10943             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
10944                     sizeof(tcp->payload_tok) + tcp->tokens_size,
10945                     &tcp->payload_tok))
10946                 return -ENOBUFS;
10947
10948         nla_nest_end(msg, nl_tcp);
10949
10950         return 0;
10951 }
10952
10953 static int nl80211_send_wowlan_nd(struct sk_buff *msg,
10954                                   struct cfg80211_sched_scan_request *req)
10955 {
10956         struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
10957         int i;
10958
10959         if (!req)
10960                 return 0;
10961
10962         nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
10963         if (!nd)
10964                 return -ENOBUFS;
10965
10966         if (req->n_scan_plans == 1 &&
10967             nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
10968                         req->scan_plans[0].interval * 1000))
10969                 return -ENOBUFS;
10970
10971         if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
10972                 return -ENOBUFS;
10973
10974         if (req->relative_rssi_set) {
10975                 struct nl80211_bss_select_rssi_adjust rssi_adjust;
10976
10977                 if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
10978                                req->relative_rssi))
10979                         return -ENOBUFS;
10980
10981                 rssi_adjust.band = req->rssi_adjust.band;
10982                 rssi_adjust.delta = req->rssi_adjust.delta;
10983                 if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
10984                             sizeof(rssi_adjust), &rssi_adjust))
10985                         return -ENOBUFS;
10986         }
10987
10988         freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
10989         if (!freqs)
10990                 return -ENOBUFS;
10991
10992         for (i = 0; i < req->n_channels; i++) {
10993                 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
10994                         return -ENOBUFS;
10995         }
10996
10997         nla_nest_end(msg, freqs);
10998
10999         if (req->n_match_sets) {
11000                 matches = nla_nest_start_noflag(msg,
11001                                                 NL80211_ATTR_SCHED_SCAN_MATCH);
11002                 if (!matches)
11003                         return -ENOBUFS;
11004
11005                 for (i = 0; i < req->n_match_sets; i++) {
11006                         match = nla_nest_start_noflag(msg, i);
11007                         if (!match)
11008                                 return -ENOBUFS;
11009
11010                         if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
11011                                     req->match_sets[i].ssid.ssid_len,
11012                                     req->match_sets[i].ssid.ssid))
11013                                 return -ENOBUFS;
11014                         nla_nest_end(msg, match);
11015                 }
11016                 nla_nest_end(msg, matches);
11017         }
11018
11019         scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
11020         if (!scan_plans)
11021                 return -ENOBUFS;
11022
11023         for (i = 0; i < req->n_scan_plans; i++) {
11024                 scan_plan = nla_nest_start_noflag(msg, i + 1);
11025                 if (!scan_plan)
11026                         return -ENOBUFS;
11027
11028                 if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
11029                                 req->scan_plans[i].interval) ||
11030                     (req->scan_plans[i].iterations &&
11031                      nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
11032                                  req->scan_plans[i].iterations)))
11033                         return -ENOBUFS;
11034                 nla_nest_end(msg, scan_plan);
11035         }
11036         nla_nest_end(msg, scan_plans);
11037
11038         nla_nest_end(msg, nd);
11039
11040         return 0;
11041 }
11042
11043 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
11044 {
11045         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11046         struct sk_buff *msg;
11047         void *hdr;
11048         u32 size = NLMSG_DEFAULT_SIZE;
11049
11050         if (!rdev->wiphy.wowlan)
11051                 return -EOPNOTSUPP;
11052
11053         if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
11054                 /* adjust size to have room for all the data */
11055                 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
11056                         rdev->wiphy.wowlan_config->tcp->payload_len +
11057                         rdev->wiphy.wowlan_config->tcp->wake_len +
11058                         rdev->wiphy.wowlan_config->tcp->wake_len / 8;
11059         }
11060
11061         msg = nlmsg_new(size, GFP_KERNEL);
11062         if (!msg)
11063                 return -ENOMEM;
11064
11065         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11066                              NL80211_CMD_GET_WOWLAN);
11067         if (!hdr)
11068                 goto nla_put_failure;
11069
11070         if (rdev->wiphy.wowlan_config) {
11071                 struct nlattr *nl_wowlan;
11072
11073                 nl_wowlan = nla_nest_start_noflag(msg,
11074                                                   NL80211_ATTR_WOWLAN_TRIGGERS);
11075                 if (!nl_wowlan)
11076                         goto nla_put_failure;
11077
11078                 if ((rdev->wiphy.wowlan_config->any &&
11079                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
11080                     (rdev->wiphy.wowlan_config->disconnect &&
11081                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
11082                     (rdev->wiphy.wowlan_config->magic_pkt &&
11083                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
11084                     (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
11085                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
11086                     (rdev->wiphy.wowlan_config->eap_identity_req &&
11087                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
11088                     (rdev->wiphy.wowlan_config->four_way_handshake &&
11089                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
11090                     (rdev->wiphy.wowlan_config->rfkill_release &&
11091                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
11092                         goto nla_put_failure;
11093
11094                 if (nl80211_send_wowlan_patterns(msg, rdev))
11095                         goto nla_put_failure;
11096
11097                 if (nl80211_send_wowlan_tcp(msg,
11098                                             rdev->wiphy.wowlan_config->tcp))
11099                         goto nla_put_failure;
11100
11101                 if (nl80211_send_wowlan_nd(
11102                             msg,
11103                             rdev->wiphy.wowlan_config->nd_config))
11104                         goto nla_put_failure;
11105
11106                 nla_nest_end(msg, nl_wowlan);
11107         }
11108
11109         genlmsg_end(msg, hdr);
11110         return genlmsg_reply(msg, info);
11111
11112 nla_put_failure:
11113         nlmsg_free(msg);
11114         return -ENOBUFS;
11115 }
11116
11117 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
11118                                     struct nlattr *attr,
11119                                     struct cfg80211_wowlan *trig)
11120 {
11121         struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
11122         struct cfg80211_wowlan_tcp *cfg;
11123         struct nl80211_wowlan_tcp_data_token *tok = NULL;
11124         struct nl80211_wowlan_tcp_data_seq *seq = NULL;
11125         u32 size;
11126         u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
11127         int err, port;
11128
11129         if (!rdev->wiphy.wowlan->tcp)
11130                 return -EINVAL;
11131
11132         err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr,
11133                                           nl80211_wowlan_tcp_policy, NULL);
11134         if (err)
11135                 return err;
11136
11137         if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
11138             !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
11139             !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
11140             !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
11141             !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
11142             !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
11143             !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
11144             !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
11145                 return -EINVAL;
11146
11147         data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
11148         if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
11149                 return -EINVAL;
11150
11151         if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
11152                         rdev->wiphy.wowlan->tcp->data_interval_max ||
11153             nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
11154                 return -EINVAL;
11155
11156         wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
11157         if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
11158                 return -EINVAL;
11159
11160         wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
11161         if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
11162                 return -EINVAL;
11163
11164         if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
11165                 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
11166
11167                 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
11168                 tokens_size = tokln - sizeof(*tok);
11169
11170                 if (!tok->len || tokens_size % tok->len)
11171                         return -EINVAL;
11172                 if (!rdev->wiphy.wowlan->tcp->tok)
11173                         return -EINVAL;
11174                 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
11175                         return -EINVAL;
11176                 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
11177                         return -EINVAL;
11178                 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
11179                         return -EINVAL;
11180                 if (tok->offset + tok->len > data_size)
11181                         return -EINVAL;
11182         }
11183
11184         if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
11185                 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
11186                 if (!rdev->wiphy.wowlan->tcp->seq)
11187                         return -EINVAL;
11188                 if (seq->len == 0 || seq->len > 4)
11189                         return -EINVAL;
11190                 if (seq->len + seq->offset > data_size)
11191                         return -EINVAL;
11192         }
11193
11194         size = sizeof(*cfg);
11195         size += data_size;
11196         size += wake_size + wake_mask_size;
11197         size += tokens_size;
11198
11199         cfg = kzalloc(size, GFP_KERNEL);
11200         if (!cfg)
11201                 return -ENOMEM;
11202         cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
11203         cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
11204         memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
11205                ETH_ALEN);
11206         if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
11207                 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
11208         else
11209                 port = 0;
11210 #ifdef CONFIG_INET
11211         /* allocate a socket and port for it and use it */
11212         err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
11213                             IPPROTO_TCP, &cfg->sock, 1);
11214         if (err) {
11215                 kfree(cfg);
11216                 return err;
11217         }
11218         if (inet_csk_get_port(cfg->sock->sk, port)) {
11219                 sock_release(cfg->sock);
11220                 kfree(cfg);
11221                 return -EADDRINUSE;
11222         }
11223         cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
11224 #else
11225         if (!port) {
11226                 kfree(cfg);
11227                 return -EINVAL;
11228         }
11229         cfg->src_port = port;
11230 #endif
11231
11232         cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
11233         cfg->payload_len = data_size;
11234         cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
11235         memcpy((void *)cfg->payload,
11236                nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
11237                data_size);
11238         if (seq)
11239                 cfg->payload_seq = *seq;
11240         cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
11241         cfg->wake_len = wake_size;
11242         cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
11243         memcpy((void *)cfg->wake_data,
11244                nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
11245                wake_size);
11246         cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
11247                          data_size + wake_size;
11248         memcpy((void *)cfg->wake_mask,
11249                nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
11250                wake_mask_size);
11251         if (tok) {
11252                 cfg->tokens_size = tokens_size;
11253                 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
11254         }
11255
11256         trig->tcp = cfg;
11257
11258         return 0;
11259 }
11260
11261 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
11262                                    const struct wiphy_wowlan_support *wowlan,
11263                                    struct nlattr *attr,
11264                                    struct cfg80211_wowlan *trig)
11265 {
11266         struct nlattr **tb;
11267         int err;
11268
11269         tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
11270         if (!tb)
11271                 return -ENOMEM;
11272
11273         if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
11274                 err = -EOPNOTSUPP;
11275                 goto out;
11276         }
11277
11278         err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr,
11279                                           nl80211_policy, NULL);
11280         if (err)
11281                 goto out;
11282
11283         trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
11284                                                    wowlan->max_nd_match_sets);
11285         err = PTR_ERR_OR_ZERO(trig->nd_config);
11286         if (err)
11287                 trig->nd_config = NULL;
11288
11289 out:
11290         kfree(tb);
11291         return err;
11292 }
11293
11294 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
11295 {
11296         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11297         struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
11298         struct cfg80211_wowlan new_triggers = {};
11299         struct cfg80211_wowlan *ntrig;
11300         const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
11301         int err, i;
11302         bool prev_enabled = rdev->wiphy.wowlan_config;
11303         bool regular = false;
11304
11305         if (!wowlan)
11306                 return -EOPNOTSUPP;
11307
11308         if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
11309                 cfg80211_rdev_free_wowlan(rdev);
11310                 rdev->wiphy.wowlan_config = NULL;
11311                 goto set_wakeup;
11312         }
11313
11314         err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG,
11315                                           info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
11316                                           nl80211_wowlan_policy, info->extack);
11317         if (err)
11318                 return err;
11319
11320         if (tb[NL80211_WOWLAN_TRIG_ANY]) {
11321                 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
11322                         return -EINVAL;
11323                 new_triggers.any = true;
11324         }
11325
11326         if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
11327                 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
11328                         return -EINVAL;
11329                 new_triggers.disconnect = true;
11330                 regular = true;
11331         }
11332
11333         if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
11334                 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
11335                         return -EINVAL;
11336                 new_triggers.magic_pkt = true;
11337                 regular = true;
11338         }
11339
11340         if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
11341                 return -EINVAL;
11342
11343         if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
11344                 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
11345                         return -EINVAL;
11346                 new_triggers.gtk_rekey_failure = true;
11347                 regular = true;
11348         }
11349
11350         if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
11351                 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
11352                         return -EINVAL;
11353                 new_triggers.eap_identity_req = true;
11354                 regular = true;
11355         }
11356
11357         if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
11358                 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
11359                         return -EINVAL;
11360                 new_triggers.four_way_handshake = true;
11361                 regular = true;
11362         }
11363
11364         if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
11365                 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
11366                         return -EINVAL;
11367                 new_triggers.rfkill_release = true;
11368                 regular = true;
11369         }
11370
11371         if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
11372                 struct nlattr *pat;
11373                 int n_patterns = 0;
11374                 int rem, pat_len, mask_len, pkt_offset;
11375                 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
11376
11377                 regular = true;
11378
11379                 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
11380                                     rem)
11381                         n_patterns++;
11382                 if (n_patterns > wowlan->n_patterns)
11383                         return -EINVAL;
11384
11385                 new_triggers.patterns = kcalloc(n_patterns,
11386                                                 sizeof(new_triggers.patterns[0]),
11387                                                 GFP_KERNEL);
11388                 if (!new_triggers.patterns)
11389                         return -ENOMEM;
11390
11391                 new_triggers.n_patterns = n_patterns;
11392                 i = 0;
11393
11394                 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
11395                                     rem) {
11396                         u8 *mask_pat;
11397
11398                         err = nla_parse_nested_deprecated(pat_tb,
11399                                                           MAX_NL80211_PKTPAT,
11400                                                           pat,
11401                                                           nl80211_packet_pattern_policy,
11402                                                           info->extack);
11403                         if (err)
11404                                 goto error;
11405
11406                         err = -EINVAL;
11407                         if (!pat_tb[NL80211_PKTPAT_MASK] ||
11408                             !pat_tb[NL80211_PKTPAT_PATTERN])
11409                                 goto error;
11410                         pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
11411                         mask_len = DIV_ROUND_UP(pat_len, 8);
11412                         if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
11413                                 goto error;
11414                         if (pat_len > wowlan->pattern_max_len ||
11415                             pat_len < wowlan->pattern_min_len)
11416                                 goto error;
11417
11418                         if (!pat_tb[NL80211_PKTPAT_OFFSET])
11419                                 pkt_offset = 0;
11420                         else
11421                                 pkt_offset = nla_get_u32(
11422                                         pat_tb[NL80211_PKTPAT_OFFSET]);
11423                         if (pkt_offset > wowlan->max_pkt_offset)
11424                                 goto error;
11425                         new_triggers.patterns[i].pkt_offset = pkt_offset;
11426
11427                         mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
11428                         if (!mask_pat) {
11429                                 err = -ENOMEM;
11430                                 goto error;
11431                         }
11432                         new_triggers.patterns[i].mask = mask_pat;
11433                         memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
11434                                mask_len);
11435                         mask_pat += mask_len;
11436                         new_triggers.patterns[i].pattern = mask_pat;
11437                         new_triggers.patterns[i].pattern_len = pat_len;
11438                         memcpy(mask_pat,
11439                                nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
11440                                pat_len);
11441                         i++;
11442                 }
11443         }
11444
11445         if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
11446                 regular = true;
11447                 err = nl80211_parse_wowlan_tcp(
11448                         rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
11449                         &new_triggers);
11450                 if (err)
11451                         goto error;
11452         }
11453
11454         if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
11455                 regular = true;
11456                 err = nl80211_parse_wowlan_nd(
11457                         rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
11458                         &new_triggers);
11459                 if (err)
11460                         goto error;
11461         }
11462
11463         /* The 'any' trigger means the device continues operating more or less
11464          * as in its normal operation mode and wakes up the host on most of the
11465          * normal interrupts (like packet RX, ...)
11466          * It therefore makes little sense to combine with the more constrained
11467          * wakeup trigger modes.
11468          */
11469         if (new_triggers.any && regular) {
11470                 err = -EINVAL;
11471                 goto error;
11472         }
11473
11474         ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
11475         if (!ntrig) {
11476                 err = -ENOMEM;
11477                 goto error;
11478         }
11479         cfg80211_rdev_free_wowlan(rdev);
11480         rdev->wiphy.wowlan_config = ntrig;
11481
11482  set_wakeup:
11483         if (rdev->ops->set_wakeup &&
11484             prev_enabled != !!rdev->wiphy.wowlan_config)
11485                 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
11486
11487         return 0;
11488  error:
11489         for (i = 0; i < new_triggers.n_patterns; i++)
11490                 kfree(new_triggers.patterns[i].mask);
11491         kfree(new_triggers.patterns);
11492         if (new_triggers.tcp && new_triggers.tcp->sock)
11493                 sock_release(new_triggers.tcp->sock);
11494         kfree(new_triggers.tcp);
11495         kfree(new_triggers.nd_config);
11496         return err;
11497 }
11498 #endif
11499
11500 static int nl80211_send_coalesce_rules(struct sk_buff *msg,
11501                                        struct cfg80211_registered_device *rdev)
11502 {
11503         struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
11504         int i, j, pat_len;
11505         struct cfg80211_coalesce_rules *rule;
11506
11507         if (!rdev->coalesce->n_rules)
11508                 return 0;
11509
11510         nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE);
11511         if (!nl_rules)
11512                 return -ENOBUFS;
11513
11514         for (i = 0; i < rdev->coalesce->n_rules; i++) {
11515                 nl_rule = nla_nest_start_noflag(msg, i + 1);
11516                 if (!nl_rule)
11517                         return -ENOBUFS;
11518
11519                 rule = &rdev->coalesce->rules[i];
11520                 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
11521                                 rule->delay))
11522                         return -ENOBUFS;
11523
11524                 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
11525                                 rule->condition))
11526                         return -ENOBUFS;
11527
11528                 nl_pats = nla_nest_start_noflag(msg,
11529                                                 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
11530                 if (!nl_pats)
11531                         return -ENOBUFS;
11532
11533                 for (j = 0; j < rule->n_patterns; j++) {
11534                         nl_pat = nla_nest_start_noflag(msg, j + 1);
11535                         if (!nl_pat)
11536                                 return -ENOBUFS;
11537                         pat_len = rule->patterns[j].pattern_len;
11538                         if (nla_put(msg, NL80211_PKTPAT_MASK,
11539                                     DIV_ROUND_UP(pat_len, 8),
11540                                     rule->patterns[j].mask) ||
11541                             nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
11542                                     rule->patterns[j].pattern) ||
11543                             nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
11544                                         rule->patterns[j].pkt_offset))
11545                                 return -ENOBUFS;
11546                         nla_nest_end(msg, nl_pat);
11547                 }
11548                 nla_nest_end(msg, nl_pats);
11549                 nla_nest_end(msg, nl_rule);
11550         }
11551         nla_nest_end(msg, nl_rules);
11552
11553         return 0;
11554 }
11555
11556 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
11557 {
11558         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11559         struct sk_buff *msg;
11560         void *hdr;
11561
11562         if (!rdev->wiphy.coalesce)
11563                 return -EOPNOTSUPP;
11564
11565         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11566         if (!msg)
11567                 return -ENOMEM;
11568
11569         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11570                              NL80211_CMD_GET_COALESCE);
11571         if (!hdr)
11572                 goto nla_put_failure;
11573
11574         if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
11575                 goto nla_put_failure;
11576
11577         genlmsg_end(msg, hdr);
11578         return genlmsg_reply(msg, info);
11579
11580 nla_put_failure:
11581         nlmsg_free(msg);
11582         return -ENOBUFS;
11583 }
11584
11585 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
11586 {
11587         struct cfg80211_coalesce *coalesce = rdev->coalesce;
11588         int i, j;
11589         struct cfg80211_coalesce_rules *rule;
11590
11591         if (!coalesce)
11592                 return;
11593
11594         for (i = 0; i < coalesce->n_rules; i++) {
11595                 rule = &coalesce->rules[i];
11596                 for (j = 0; j < rule->n_patterns; j++)
11597                         kfree(rule->patterns[j].mask);
11598                 kfree(rule->patterns);
11599         }
11600         kfree(coalesce->rules);
11601         kfree(coalesce);
11602         rdev->coalesce = NULL;
11603 }
11604
11605 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
11606                                        struct nlattr *rule,
11607                                        struct cfg80211_coalesce_rules *new_rule)
11608 {
11609         int err, i;
11610         const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
11611         struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
11612         int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
11613         struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
11614
11615         err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX,
11616                                           rule, nl80211_coalesce_policy, NULL);
11617         if (err)
11618                 return err;
11619
11620         if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
11621                 new_rule->delay =
11622                         nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
11623         if (new_rule->delay > coalesce->max_delay)
11624                 return -EINVAL;
11625
11626         if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
11627                 new_rule->condition =
11628                         nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
11629
11630         if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
11631                 return -EINVAL;
11632
11633         nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
11634                             rem)
11635                 n_patterns++;
11636         if (n_patterns > coalesce->n_patterns)
11637                 return -EINVAL;
11638
11639         new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
11640                                      GFP_KERNEL);
11641         if (!new_rule->patterns)
11642                 return -ENOMEM;
11643
11644         new_rule->n_patterns = n_patterns;
11645         i = 0;
11646
11647         nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
11648                             rem) {
11649                 u8 *mask_pat;
11650
11651                 err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT,
11652                                                   pat,
11653                                                   nl80211_packet_pattern_policy,
11654                                                   NULL);
11655                 if (err)
11656                         return err;
11657
11658                 if (!pat_tb[NL80211_PKTPAT_MASK] ||
11659                     !pat_tb[NL80211_PKTPAT_PATTERN])
11660                         return -EINVAL;
11661                 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
11662                 mask_len = DIV_ROUND_UP(pat_len, 8);
11663                 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
11664                         return -EINVAL;
11665                 if (pat_len > coalesce->pattern_max_len ||
11666                     pat_len < coalesce->pattern_min_len)
11667                         return -EINVAL;
11668
11669                 if (!pat_tb[NL80211_PKTPAT_OFFSET])
11670                         pkt_offset = 0;
11671                 else
11672                         pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
11673                 if (pkt_offset > coalesce->max_pkt_offset)
11674                         return -EINVAL;
11675                 new_rule->patterns[i].pkt_offset = pkt_offset;
11676
11677                 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
11678                 if (!mask_pat)
11679                         return -ENOMEM;
11680
11681                 new_rule->patterns[i].mask = mask_pat;
11682                 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
11683                        mask_len);
11684
11685                 mask_pat += mask_len;
11686                 new_rule->patterns[i].pattern = mask_pat;
11687                 new_rule->patterns[i].pattern_len = pat_len;
11688                 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
11689                        pat_len);
11690                 i++;
11691         }
11692
11693         return 0;
11694 }
11695
11696 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
11697 {
11698         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11699         const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
11700         struct cfg80211_coalesce new_coalesce = {};
11701         struct cfg80211_coalesce *n_coalesce;
11702         int err, rem_rule, n_rules = 0, i, j;
11703         struct nlattr *rule;
11704         struct cfg80211_coalesce_rules *tmp_rule;
11705
11706         if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
11707                 return -EOPNOTSUPP;
11708
11709         if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
11710                 cfg80211_rdev_free_coalesce(rdev);
11711                 rdev_set_coalesce(rdev, NULL);
11712                 return 0;
11713         }
11714
11715         nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
11716                             rem_rule)
11717                 n_rules++;
11718         if (n_rules > coalesce->n_rules)
11719                 return -EINVAL;
11720
11721         new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
11722                                      GFP_KERNEL);
11723         if (!new_coalesce.rules)
11724                 return -ENOMEM;
11725
11726         new_coalesce.n_rules = n_rules;
11727         i = 0;
11728
11729         nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
11730                             rem_rule) {
11731                 err = nl80211_parse_coalesce_rule(rdev, rule,
11732                                                   &new_coalesce.rules[i]);
11733                 if (err)
11734                         goto error;
11735
11736                 i++;
11737         }
11738
11739         err = rdev_set_coalesce(rdev, &new_coalesce);
11740         if (err)
11741                 goto error;
11742
11743         n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
11744         if (!n_coalesce) {
11745                 err = -ENOMEM;
11746                 goto error;
11747         }
11748         cfg80211_rdev_free_coalesce(rdev);
11749         rdev->coalesce = n_coalesce;
11750
11751         return 0;
11752 error:
11753         for (i = 0; i < new_coalesce.n_rules; i++) {
11754                 tmp_rule = &new_coalesce.rules[i];
11755                 for (j = 0; j < tmp_rule->n_patterns; j++)
11756                         kfree(tmp_rule->patterns[j].mask);
11757                 kfree(tmp_rule->patterns);
11758         }
11759         kfree(new_coalesce.rules);
11760
11761         return err;
11762 }
11763
11764 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
11765 {
11766         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11767         struct net_device *dev = info->user_ptr[1];
11768         struct wireless_dev *wdev = dev->ieee80211_ptr;
11769         struct nlattr *tb[NUM_NL80211_REKEY_DATA];
11770         struct cfg80211_gtk_rekey_data rekey_data;
11771         int err;
11772
11773         if (!info->attrs[NL80211_ATTR_REKEY_DATA])
11774                 return -EINVAL;
11775
11776         err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA,
11777                                           info->attrs[NL80211_ATTR_REKEY_DATA],
11778                                           nl80211_rekey_policy, info->extack);
11779         if (err)
11780                 return err;
11781
11782         if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
11783             !tb[NL80211_REKEY_DATA_KCK])
11784                 return -EINVAL;
11785         if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
11786                 return -ERANGE;
11787         if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
11788                 return -ERANGE;
11789         if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
11790                 return -ERANGE;
11791
11792         rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
11793         rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
11794         rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
11795
11796         wdev_lock(wdev);
11797         if (!wdev->current_bss) {
11798                 err = -ENOTCONN;
11799                 goto out;
11800         }
11801
11802         if (!rdev->ops->set_rekey_data) {
11803                 err = -EOPNOTSUPP;
11804                 goto out;
11805         }
11806
11807         err = rdev_set_rekey_data(rdev, dev, &rekey_data);
11808  out:
11809         wdev_unlock(wdev);
11810         return err;
11811 }
11812
11813 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
11814                                              struct genl_info *info)
11815 {
11816         struct net_device *dev = info->user_ptr[1];
11817         struct wireless_dev *wdev = dev->ieee80211_ptr;
11818
11819         if (wdev->iftype != NL80211_IFTYPE_AP &&
11820             wdev->iftype != NL80211_IFTYPE_P2P_GO)
11821                 return -EINVAL;
11822
11823         if (wdev->ap_unexpected_nlportid)
11824                 return -EBUSY;
11825
11826         wdev->ap_unexpected_nlportid = info->snd_portid;
11827         return 0;
11828 }
11829
11830 static int nl80211_probe_client(struct sk_buff *skb,
11831                                 struct genl_info *info)
11832 {
11833         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11834         struct net_device *dev = info->user_ptr[1];
11835         struct wireless_dev *wdev = dev->ieee80211_ptr;
11836         struct sk_buff *msg;
11837         void *hdr;
11838         const u8 *addr;
11839         u64 cookie;
11840         int err;
11841
11842         if (wdev->iftype != NL80211_IFTYPE_AP &&
11843             wdev->iftype != NL80211_IFTYPE_P2P_GO)
11844                 return -EOPNOTSUPP;
11845
11846         if (!info->attrs[NL80211_ATTR_MAC])
11847                 return -EINVAL;
11848
11849         if (!rdev->ops->probe_client)
11850                 return -EOPNOTSUPP;
11851
11852         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11853         if (!msg)
11854                 return -ENOMEM;
11855
11856         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11857                              NL80211_CMD_PROBE_CLIENT);
11858         if (!hdr) {
11859                 err = -ENOBUFS;
11860                 goto free_msg;
11861         }
11862
11863         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
11864
11865         err = rdev_probe_client(rdev, dev, addr, &cookie);
11866         if (err)
11867                 goto free_msg;
11868
11869         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11870                               NL80211_ATTR_PAD))
11871                 goto nla_put_failure;
11872
11873         genlmsg_end(msg, hdr);
11874
11875         return genlmsg_reply(msg, info);
11876
11877  nla_put_failure:
11878         err = -ENOBUFS;
11879  free_msg:
11880         nlmsg_free(msg);
11881         return err;
11882 }
11883
11884 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
11885 {
11886         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11887         struct cfg80211_beacon_registration *reg, *nreg;
11888         int rv;
11889
11890         if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
11891                 return -EOPNOTSUPP;
11892
11893         nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
11894         if (!nreg)
11895                 return -ENOMEM;
11896
11897         /* First, check if already registered. */
11898         spin_lock_bh(&rdev->beacon_registrations_lock);
11899         list_for_each_entry(reg, &rdev->beacon_registrations, list) {
11900                 if (reg->nlportid == info->snd_portid) {
11901                         rv = -EALREADY;
11902                         goto out_err;
11903                 }
11904         }
11905         /* Add it to the list */
11906         nreg->nlportid = info->snd_portid;
11907         list_add(&nreg->list, &rdev->beacon_registrations);
11908
11909         spin_unlock_bh(&rdev->beacon_registrations_lock);
11910
11911         return 0;
11912 out_err:
11913         spin_unlock_bh(&rdev->beacon_registrations_lock);
11914         kfree(nreg);
11915         return rv;
11916 }
11917
11918 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
11919 {
11920         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11921         struct wireless_dev *wdev = info->user_ptr[1];
11922         int err;
11923
11924         if (!rdev->ops->start_p2p_device)
11925                 return -EOPNOTSUPP;
11926
11927         if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
11928                 return -EOPNOTSUPP;
11929
11930         if (wdev_running(wdev))
11931                 return 0;
11932
11933         if (rfkill_blocked(rdev->rfkill))
11934                 return -ERFKILL;
11935
11936         err = rdev_start_p2p_device(rdev, wdev);
11937         if (err)
11938                 return err;
11939
11940         wdev->is_running = true;
11941         rdev->opencount++;
11942
11943         return 0;
11944 }
11945
11946 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
11947 {
11948         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11949         struct wireless_dev *wdev = info->user_ptr[1];
11950
11951         if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
11952                 return -EOPNOTSUPP;
11953
11954         if (!rdev->ops->stop_p2p_device)
11955                 return -EOPNOTSUPP;
11956
11957         cfg80211_stop_p2p_device(rdev, wdev);
11958
11959         return 0;
11960 }
11961
11962 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
11963 {
11964         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11965         struct wireless_dev *wdev = info->user_ptr[1];
11966         struct cfg80211_nan_conf conf = {};
11967         int err;
11968
11969         if (wdev->iftype != NL80211_IFTYPE_NAN)
11970                 return -EOPNOTSUPP;
11971
11972         if (wdev_running(wdev))
11973                 return -EEXIST;
11974
11975         if (rfkill_blocked(rdev->rfkill))
11976                 return -ERFKILL;
11977
11978         if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
11979                 return -EINVAL;
11980
11981         conf.master_pref =
11982                 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
11983
11984         if (info->attrs[NL80211_ATTR_BANDS]) {
11985                 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
11986
11987                 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
11988                         return -EOPNOTSUPP;
11989
11990                 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
11991                         return -EINVAL;
11992
11993                 conf.bands = bands;
11994         }
11995
11996         err = rdev_start_nan(rdev, wdev, &conf);
11997         if (err)
11998                 return err;
11999
12000         wdev->is_running = true;
12001         rdev->opencount++;
12002
12003         return 0;
12004 }
12005
12006 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
12007 {
12008         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12009         struct wireless_dev *wdev = info->user_ptr[1];
12010
12011         if (wdev->iftype != NL80211_IFTYPE_NAN)
12012                 return -EOPNOTSUPP;
12013
12014         cfg80211_stop_nan(rdev, wdev);
12015
12016         return 0;
12017 }
12018
12019 static int validate_nan_filter(struct nlattr *filter_attr)
12020 {
12021         struct nlattr *attr;
12022         int len = 0, n_entries = 0, rem;
12023
12024         nla_for_each_nested(attr, filter_attr, rem) {
12025                 len += nla_len(attr);
12026                 n_entries++;
12027         }
12028
12029         if (len >= U8_MAX)
12030                 return -EINVAL;
12031
12032         return n_entries;
12033 }
12034
12035 static int handle_nan_filter(struct nlattr *attr_filter,
12036                              struct cfg80211_nan_func *func,
12037                              bool tx)
12038 {
12039         struct nlattr *attr;
12040         int n_entries, rem, i;
12041         struct cfg80211_nan_func_filter *filter;
12042
12043         n_entries = validate_nan_filter(attr_filter);
12044         if (n_entries < 0)
12045                 return n_entries;
12046
12047         BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
12048
12049         filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
12050         if (!filter)
12051                 return -ENOMEM;
12052
12053         i = 0;
12054         nla_for_each_nested(attr, attr_filter, rem) {
12055                 filter[i].filter = nla_memdup(attr, GFP_KERNEL);
12056                 filter[i].len = nla_len(attr);
12057                 i++;
12058         }
12059         if (tx) {
12060                 func->num_tx_filters = n_entries;
12061                 func->tx_filters = filter;
12062         } else {
12063                 func->num_rx_filters = n_entries;
12064                 func->rx_filters = filter;
12065         }
12066
12067         return 0;
12068 }
12069
12070 static int nl80211_nan_add_func(struct sk_buff *skb,
12071                                 struct genl_info *info)
12072 {
12073         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12074         struct wireless_dev *wdev = info->user_ptr[1];
12075         struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
12076         struct cfg80211_nan_func *func;
12077         struct sk_buff *msg = NULL;
12078         void *hdr = NULL;
12079         int err = 0;
12080
12081         if (wdev->iftype != NL80211_IFTYPE_NAN)
12082                 return -EOPNOTSUPP;
12083
12084         if (!wdev_running(wdev))
12085                 return -ENOTCONN;
12086
12087         if (!info->attrs[NL80211_ATTR_NAN_FUNC])
12088                 return -EINVAL;
12089
12090         err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX,
12091                                           info->attrs[NL80211_ATTR_NAN_FUNC],
12092                                           nl80211_nan_func_policy,
12093                                           info->extack);
12094         if (err)
12095                 return err;
12096
12097         func = kzalloc(sizeof(*func), GFP_KERNEL);
12098         if (!func)
12099                 return -ENOMEM;
12100
12101         func->cookie = cfg80211_assign_cookie(rdev);
12102
12103         if (!tb[NL80211_NAN_FUNC_TYPE] ||
12104             nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
12105                 err = -EINVAL;
12106                 goto out;
12107         }
12108
12109
12110         func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
12111
12112         if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
12113                 err = -EINVAL;
12114                 goto out;
12115         }
12116
12117         memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
12118                sizeof(func->service_id));
12119
12120         func->close_range =
12121                 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
12122
12123         if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
12124                 func->serv_spec_info_len =
12125                         nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
12126                 func->serv_spec_info =
12127                         kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
12128                                 func->serv_spec_info_len,
12129                                 GFP_KERNEL);
12130                 if (!func->serv_spec_info) {
12131                         err = -ENOMEM;
12132                         goto out;
12133                 }
12134         }
12135
12136         if (tb[NL80211_NAN_FUNC_TTL])
12137                 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
12138
12139         switch (func->type) {
12140         case NL80211_NAN_FUNC_PUBLISH:
12141                 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
12142                         err = -EINVAL;
12143                         goto out;
12144                 }
12145
12146                 func->publish_type =
12147                         nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
12148                 func->publish_bcast =
12149                         nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
12150
12151                 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
12152                         func->publish_bcast) {
12153                         err = -EINVAL;
12154                         goto out;
12155                 }
12156                 break;
12157         case NL80211_NAN_FUNC_SUBSCRIBE:
12158                 func->subscribe_active =
12159                         nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
12160                 break;
12161         case NL80211_NAN_FUNC_FOLLOW_UP:
12162                 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
12163                     !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
12164                     !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
12165                         err = -EINVAL;
12166                         goto out;
12167                 }
12168
12169                 func->followup_id =
12170                         nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
12171                 func->followup_reqid =
12172                         nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
12173                 memcpy(func->followup_dest.addr,
12174                        nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
12175                        sizeof(func->followup_dest.addr));
12176                 if (func->ttl) {
12177                         err = -EINVAL;
12178                         goto out;
12179                 }
12180                 break;
12181         default:
12182                 err = -EINVAL;
12183                 goto out;
12184         }
12185
12186         if (tb[NL80211_NAN_FUNC_SRF]) {
12187                 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
12188
12189                 err = nla_parse_nested_deprecated(srf_tb,
12190                                                   NL80211_NAN_SRF_ATTR_MAX,
12191                                                   tb[NL80211_NAN_FUNC_SRF],
12192                                                   nl80211_nan_srf_policy,
12193                                                   info->extack);
12194                 if (err)
12195                         goto out;
12196
12197                 func->srf_include =
12198                         nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
12199
12200                 if (srf_tb[NL80211_NAN_SRF_BF]) {
12201                         if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
12202                             !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
12203                                 err = -EINVAL;
12204                                 goto out;
12205                         }
12206
12207                         func->srf_bf_len =
12208                                 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
12209                         func->srf_bf =
12210                                 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
12211                                         func->srf_bf_len, GFP_KERNEL);
12212                         if (!func->srf_bf) {
12213                                 err = -ENOMEM;
12214                                 goto out;
12215                         }
12216
12217                         func->srf_bf_idx =
12218                                 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
12219                 } else {
12220                         struct nlattr *attr, *mac_attr =
12221                                 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
12222                         int n_entries, rem, i = 0;
12223
12224                         if (!mac_attr) {
12225                                 err = -EINVAL;
12226                                 goto out;
12227                         }
12228
12229                         n_entries = validate_acl_mac_addrs(mac_attr);
12230                         if (n_entries <= 0) {
12231                                 err = -EINVAL;
12232                                 goto out;
12233                         }
12234
12235                         func->srf_num_macs = n_entries;
12236                         func->srf_macs =
12237                                 kcalloc(n_entries, sizeof(*func->srf_macs),
12238                                         GFP_KERNEL);
12239                         if (!func->srf_macs) {
12240                                 err = -ENOMEM;
12241                                 goto out;
12242                         }
12243
12244                         nla_for_each_nested(attr, mac_attr, rem)
12245                                 memcpy(func->srf_macs[i++].addr, nla_data(attr),
12246                                        sizeof(*func->srf_macs));
12247                 }
12248         }
12249
12250         if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
12251                 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
12252                                         func, true);
12253                 if (err)
12254                         goto out;
12255         }
12256
12257         if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
12258                 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
12259                                         func, false);
12260                 if (err)
12261                         goto out;
12262         }
12263
12264         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12265         if (!msg) {
12266                 err = -ENOMEM;
12267                 goto out;
12268         }
12269
12270         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12271                              NL80211_CMD_ADD_NAN_FUNCTION);
12272         /* This can't really happen - we just allocated 4KB */
12273         if (WARN_ON(!hdr)) {
12274                 err = -ENOMEM;
12275                 goto out;
12276         }
12277
12278         err = rdev_add_nan_func(rdev, wdev, func);
12279 out:
12280         if (err < 0) {
12281                 cfg80211_free_nan_func(func);
12282                 nlmsg_free(msg);
12283                 return err;
12284         }
12285
12286         /* propagate the instance id and cookie to userspace  */
12287         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
12288                               NL80211_ATTR_PAD))
12289                 goto nla_put_failure;
12290
12291         func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
12292         if (!func_attr)
12293                 goto nla_put_failure;
12294
12295         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
12296                        func->instance_id))
12297                 goto nla_put_failure;
12298
12299         nla_nest_end(msg, func_attr);
12300
12301         genlmsg_end(msg, hdr);
12302         return genlmsg_reply(msg, info);
12303
12304 nla_put_failure:
12305         nlmsg_free(msg);
12306         return -ENOBUFS;
12307 }
12308
12309 static int nl80211_nan_del_func(struct sk_buff *skb,
12310                                struct genl_info *info)
12311 {
12312         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12313         struct wireless_dev *wdev = info->user_ptr[1];
12314         u64 cookie;
12315
12316         if (wdev->iftype != NL80211_IFTYPE_NAN)
12317                 return -EOPNOTSUPP;
12318
12319         if (!wdev_running(wdev))
12320                 return -ENOTCONN;
12321
12322         if (!info->attrs[NL80211_ATTR_COOKIE])
12323                 return -EINVAL;
12324
12325         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
12326
12327         rdev_del_nan_func(rdev, wdev, cookie);
12328
12329         return 0;
12330 }
12331
12332 static int nl80211_nan_change_config(struct sk_buff *skb,
12333                                      struct genl_info *info)
12334 {
12335         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12336         struct wireless_dev *wdev = info->user_ptr[1];
12337         struct cfg80211_nan_conf conf = {};
12338         u32 changed = 0;
12339
12340         if (wdev->iftype != NL80211_IFTYPE_NAN)
12341                 return -EOPNOTSUPP;
12342
12343         if (!wdev_running(wdev))
12344                 return -ENOTCONN;
12345
12346         if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
12347                 conf.master_pref =
12348                         nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
12349                 if (conf.master_pref <= 1 || conf.master_pref == 255)
12350                         return -EINVAL;
12351
12352                 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
12353         }
12354
12355         if (info->attrs[NL80211_ATTR_BANDS]) {
12356                 u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
12357
12358                 if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
12359                         return -EOPNOTSUPP;
12360
12361                 if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
12362                         return -EINVAL;
12363
12364                 conf.bands = bands;
12365                 changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
12366         }
12367
12368         if (!changed)
12369                 return -EINVAL;
12370
12371         return rdev_nan_change_conf(rdev, wdev, &conf, changed);
12372 }
12373
12374 void cfg80211_nan_match(struct wireless_dev *wdev,
12375                         struct cfg80211_nan_match_params *match, gfp_t gfp)
12376 {
12377         struct wiphy *wiphy = wdev->wiphy;
12378         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12379         struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
12380         struct sk_buff *msg;
12381         void *hdr;
12382
12383         if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
12384                 return;
12385
12386         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
12387         if (!msg)
12388                 return;
12389
12390         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
12391         if (!hdr) {
12392                 nlmsg_free(msg);
12393                 return;
12394         }
12395
12396         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12397             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12398                                          wdev->netdev->ifindex)) ||
12399             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12400                               NL80211_ATTR_PAD))
12401                 goto nla_put_failure;
12402
12403         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
12404                               NL80211_ATTR_PAD) ||
12405             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
12406                 goto nla_put_failure;
12407
12408         match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH);
12409         if (!match_attr)
12410                 goto nla_put_failure;
12411
12412         local_func_attr = nla_nest_start_noflag(msg,
12413                                                 NL80211_NAN_MATCH_FUNC_LOCAL);
12414         if (!local_func_attr)
12415                 goto nla_put_failure;
12416
12417         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
12418                 goto nla_put_failure;
12419
12420         nla_nest_end(msg, local_func_attr);
12421
12422         peer_func_attr = nla_nest_start_noflag(msg,
12423                                                NL80211_NAN_MATCH_FUNC_PEER);
12424         if (!peer_func_attr)
12425                 goto nla_put_failure;
12426
12427         if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
12428             nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
12429                 goto nla_put_failure;
12430
12431         if (match->info && match->info_len &&
12432             nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
12433                     match->info))
12434                 goto nla_put_failure;
12435
12436         nla_nest_end(msg, peer_func_attr);
12437         nla_nest_end(msg, match_attr);
12438         genlmsg_end(msg, hdr);
12439
12440         if (!wdev->owner_nlportid)
12441                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
12442                                         msg, 0, NL80211_MCGRP_NAN, gfp);
12443         else
12444                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
12445                                 wdev->owner_nlportid);
12446
12447         return;
12448
12449 nla_put_failure:
12450         nlmsg_free(msg);
12451 }
12452 EXPORT_SYMBOL(cfg80211_nan_match);
12453
12454 void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
12455                                   u8 inst_id,
12456                                   enum nl80211_nan_func_term_reason reason,
12457                                   u64 cookie, gfp_t gfp)
12458 {
12459         struct wiphy *wiphy = wdev->wiphy;
12460         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12461         struct sk_buff *msg;
12462         struct nlattr *func_attr;
12463         void *hdr;
12464
12465         if (WARN_ON(!inst_id))
12466                 return;
12467
12468         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
12469         if (!msg)
12470                 return;
12471
12472         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
12473         if (!hdr) {
12474                 nlmsg_free(msg);
12475                 return;
12476         }
12477
12478         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12479             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12480                                          wdev->netdev->ifindex)) ||
12481             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12482                               NL80211_ATTR_PAD))
12483                 goto nla_put_failure;
12484
12485         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
12486                               NL80211_ATTR_PAD))
12487                 goto nla_put_failure;
12488
12489         func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
12490         if (!func_attr)
12491                 goto nla_put_failure;
12492
12493         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
12494             nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
12495                 goto nla_put_failure;
12496
12497         nla_nest_end(msg, func_attr);
12498         genlmsg_end(msg, hdr);
12499
12500         if (!wdev->owner_nlportid)
12501                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
12502                                         msg, 0, NL80211_MCGRP_NAN, gfp);
12503         else
12504                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
12505                                 wdev->owner_nlportid);
12506
12507         return;
12508
12509 nla_put_failure:
12510         nlmsg_free(msg);
12511 }
12512 EXPORT_SYMBOL(cfg80211_nan_func_terminated);
12513
12514 static int nl80211_get_protocol_features(struct sk_buff *skb,
12515                                          struct genl_info *info)
12516 {
12517         void *hdr;
12518         struct sk_buff *msg;
12519
12520         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12521         if (!msg)
12522                 return -ENOMEM;
12523
12524         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
12525                              NL80211_CMD_GET_PROTOCOL_FEATURES);
12526         if (!hdr)
12527                 goto nla_put_failure;
12528
12529         if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
12530                         NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
12531                 goto nla_put_failure;
12532
12533         genlmsg_end(msg, hdr);
12534         return genlmsg_reply(msg, info);
12535
12536  nla_put_failure:
12537         kfree_skb(msg);
12538         return -ENOBUFS;
12539 }
12540
12541 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
12542 {
12543         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12544         struct cfg80211_update_ft_ies_params ft_params;
12545         struct net_device *dev = info->user_ptr[1];
12546
12547         if (!rdev->ops->update_ft_ies)
12548                 return -EOPNOTSUPP;
12549
12550         if (!info->attrs[NL80211_ATTR_MDID] ||
12551             !info->attrs[NL80211_ATTR_IE])
12552                 return -EINVAL;
12553
12554         memset(&ft_params, 0, sizeof(ft_params));
12555         ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
12556         ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
12557         ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
12558
12559         return rdev_update_ft_ies(rdev, dev, &ft_params);
12560 }
12561
12562 static int nl80211_crit_protocol_start(struct sk_buff *skb,
12563                                        struct genl_info *info)
12564 {
12565         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12566         struct wireless_dev *wdev = info->user_ptr[1];
12567         enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
12568         u16 duration;
12569         int ret;
12570
12571         if (!rdev->ops->crit_proto_start)
12572                 return -EOPNOTSUPP;
12573
12574         if (WARN_ON(!rdev->ops->crit_proto_stop))
12575                 return -EINVAL;
12576
12577         if (rdev->crit_proto_nlportid)
12578                 return -EBUSY;
12579
12580         /* determine protocol if provided */
12581         if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
12582                 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
12583
12584         if (proto >= NUM_NL80211_CRIT_PROTO)
12585                 return -EINVAL;
12586
12587         /* timeout must be provided */
12588         if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
12589                 return -EINVAL;
12590
12591         duration =
12592                 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
12593
12594         if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
12595                 return -ERANGE;
12596
12597         ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
12598         if (!ret)
12599                 rdev->crit_proto_nlportid = info->snd_portid;
12600
12601         return ret;
12602 }
12603
12604 static int nl80211_crit_protocol_stop(struct sk_buff *skb,
12605                                       struct genl_info *info)
12606 {
12607         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12608         struct wireless_dev *wdev = info->user_ptr[1];
12609
12610         if (!rdev->ops->crit_proto_stop)
12611                 return -EOPNOTSUPP;
12612
12613         if (rdev->crit_proto_nlportid) {
12614                 rdev->crit_proto_nlportid = 0;
12615                 rdev_crit_proto_stop(rdev, wdev);
12616         }
12617         return 0;
12618 }
12619
12620 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
12621 {
12622         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12623         struct wireless_dev *wdev =
12624                 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
12625         int i, err;
12626         u32 vid, subcmd;
12627
12628         if (!rdev->wiphy.vendor_commands)
12629                 return -EOPNOTSUPP;
12630
12631         if (IS_ERR(wdev)) {
12632                 err = PTR_ERR(wdev);
12633                 if (err != -EINVAL)
12634                         return err;
12635                 wdev = NULL;
12636         } else if (wdev->wiphy != &rdev->wiphy) {
12637                 return -EINVAL;
12638         }
12639
12640         if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
12641             !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
12642                 return -EINVAL;
12643
12644         vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
12645         subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
12646         for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
12647                 const struct wiphy_vendor_command *vcmd;
12648                 void *data = NULL;
12649                 int len = 0;
12650
12651                 vcmd = &rdev->wiphy.vendor_commands[i];
12652
12653                 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
12654                         continue;
12655
12656                 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
12657                                    WIPHY_VENDOR_CMD_NEED_NETDEV)) {
12658                         if (!wdev)
12659                                 return -EINVAL;
12660                         if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
12661                             !wdev->netdev)
12662                                 return -EINVAL;
12663
12664                         if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
12665                                 if (!wdev_running(wdev))
12666                                         return -ENETDOWN;
12667                         }
12668
12669                         if (!vcmd->doit)
12670                                 return -EOPNOTSUPP;
12671                 } else {
12672                         wdev = NULL;
12673                 }
12674
12675                 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
12676                         data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
12677                         len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
12678                 }
12679
12680                 rdev->cur_cmd_info = info;
12681                 err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
12682                                                           data, len);
12683                 rdev->cur_cmd_info = NULL;
12684                 return err;
12685         }
12686
12687         return -EOPNOTSUPP;
12688 }
12689
12690 static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
12691                                        struct netlink_callback *cb,
12692                                        struct cfg80211_registered_device **rdev,
12693                                        struct wireless_dev **wdev)
12694 {
12695         struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
12696         u32 vid, subcmd;
12697         unsigned int i;
12698         int vcmd_idx = -1;
12699         int err;
12700         void *data = NULL;
12701         unsigned int data_len = 0;
12702
12703         if (cb->args[0]) {
12704                 /* subtract the 1 again here */
12705                 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
12706                 struct wireless_dev *tmp;
12707
12708                 if (!wiphy)
12709                         return -ENODEV;
12710                 *rdev = wiphy_to_rdev(wiphy);
12711                 *wdev = NULL;
12712
12713                 if (cb->args[1]) {
12714                         list_for_each_entry(tmp, &wiphy->wdev_list, list) {
12715                                 if (tmp->identifier == cb->args[1] - 1) {
12716                                         *wdev = tmp;
12717                                         break;
12718                                 }
12719                         }
12720                 }
12721
12722                 /* keep rtnl locked in successful case */
12723                 return 0;
12724         }
12725
12726         err = nlmsg_parse_deprecated(cb->nlh,
12727                                      GENL_HDRLEN + nl80211_fam.hdrsize,
12728                                      attrbuf, nl80211_fam.maxattr,
12729                                      nl80211_policy, NULL);
12730         if (err)
12731                 return err;
12732
12733         if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
12734             !attrbuf[NL80211_ATTR_VENDOR_SUBCMD])
12735                 return -EINVAL;
12736
12737         *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
12738         if (IS_ERR(*wdev))
12739                 *wdev = NULL;
12740
12741         *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
12742         if (IS_ERR(*rdev))
12743                 return PTR_ERR(*rdev);
12744
12745         vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
12746         subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
12747
12748         for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
12749                 const struct wiphy_vendor_command *vcmd;
12750
12751                 vcmd = &(*rdev)->wiphy.vendor_commands[i];
12752
12753                 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
12754                         continue;
12755
12756                 if (!vcmd->dumpit)
12757                         return -EOPNOTSUPP;
12758
12759                 vcmd_idx = i;
12760                 break;
12761         }
12762
12763         if (vcmd_idx < 0)
12764                 return -EOPNOTSUPP;
12765
12766         if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
12767                 data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
12768                 data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
12769         }
12770
12771         /* 0 is the first index - add 1 to parse only once */
12772         cb->args[0] = (*rdev)->wiphy_idx + 1;
12773         /* add 1 to know if it was NULL */
12774         cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
12775         cb->args[2] = vcmd_idx;
12776         cb->args[3] = (unsigned long)data;
12777         cb->args[4] = data_len;
12778
12779         /* keep rtnl locked in successful case */
12780         return 0;
12781 }
12782
12783 static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
12784                                    struct netlink_callback *cb)
12785 {
12786         struct cfg80211_registered_device *rdev;
12787         struct wireless_dev *wdev;
12788         unsigned int vcmd_idx;
12789         const struct wiphy_vendor_command *vcmd;
12790         void *data;
12791         int data_len;
12792         int err;
12793         struct nlattr *vendor_data;
12794
12795         rtnl_lock();
12796         err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
12797         if (err)
12798                 goto out;
12799
12800         vcmd_idx = cb->args[2];
12801         data = (void *)cb->args[3];
12802         data_len = cb->args[4];
12803         vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
12804
12805         if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
12806                            WIPHY_VENDOR_CMD_NEED_NETDEV)) {
12807                 if (!wdev) {
12808                         err = -EINVAL;
12809                         goto out;
12810                 }
12811                 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
12812                     !wdev->netdev) {
12813                         err = -EINVAL;
12814                         goto out;
12815                 }
12816
12817                 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
12818                         if (!wdev_running(wdev)) {
12819                                 err = -ENETDOWN;
12820                                 goto out;
12821                         }
12822                 }
12823         }
12824
12825         while (1) {
12826                 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
12827                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
12828                                            NL80211_CMD_VENDOR);
12829                 if (!hdr)
12830                         break;
12831
12832                 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12833                     (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
12834                                                wdev_id(wdev),
12835                                                NL80211_ATTR_PAD))) {
12836                         genlmsg_cancel(skb, hdr);
12837                         break;
12838                 }
12839
12840                 vendor_data = nla_nest_start_noflag(skb,
12841                                                     NL80211_ATTR_VENDOR_DATA);
12842                 if (!vendor_data) {
12843                         genlmsg_cancel(skb, hdr);
12844                         break;
12845                 }
12846
12847                 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
12848                                    (unsigned long *)&cb->args[5]);
12849                 nla_nest_end(skb, vendor_data);
12850
12851                 if (err == -ENOBUFS || err == -ENOENT) {
12852                         genlmsg_cancel(skb, hdr);
12853                         break;
12854                 } else if (err) {
12855                         genlmsg_cancel(skb, hdr);
12856                         goto out;
12857                 }
12858
12859                 genlmsg_end(skb, hdr);
12860         }
12861
12862         err = skb->len;
12863  out:
12864         rtnl_unlock();
12865         return err;
12866 }
12867
12868 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
12869                                            enum nl80211_commands cmd,
12870                                            enum nl80211_attrs attr,
12871                                            int approxlen)
12872 {
12873         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12874
12875         if (WARN_ON(!rdev->cur_cmd_info))
12876                 return NULL;
12877
12878         return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
12879                                            rdev->cur_cmd_info->snd_portid,
12880                                            rdev->cur_cmd_info->snd_seq,
12881                                            cmd, attr, NULL, GFP_KERNEL);
12882 }
12883 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
12884
12885 int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
12886 {
12887         struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
12888         void *hdr = ((void **)skb->cb)[1];
12889         struct nlattr *data = ((void **)skb->cb)[2];
12890
12891         /* clear CB data for netlink core to own from now on */
12892         memset(skb->cb, 0, sizeof(skb->cb));
12893
12894         if (WARN_ON(!rdev->cur_cmd_info)) {
12895                 kfree_skb(skb);
12896                 return -EINVAL;
12897         }
12898
12899         nla_nest_end(skb, data);
12900         genlmsg_end(skb, hdr);
12901         return genlmsg_reply(skb, rdev->cur_cmd_info);
12902 }
12903 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
12904
12905 unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy)
12906 {
12907         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
12908
12909         if (WARN_ON(!rdev->cur_cmd_info))
12910                 return 0;
12911
12912         return rdev->cur_cmd_info->snd_portid;
12913 }
12914 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender);
12915
12916 static int nl80211_set_qos_map(struct sk_buff *skb,
12917                                struct genl_info *info)
12918 {
12919         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12920         struct cfg80211_qos_map *qos_map = NULL;
12921         struct net_device *dev = info->user_ptr[1];
12922         u8 *pos, len, num_des, des_len, des;
12923         int ret;
12924
12925         if (!rdev->ops->set_qos_map)
12926                 return -EOPNOTSUPP;
12927
12928         if (info->attrs[NL80211_ATTR_QOS_MAP]) {
12929                 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
12930                 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
12931
12932                 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
12933                     len > IEEE80211_QOS_MAP_LEN_MAX)
12934                         return -EINVAL;
12935
12936                 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
12937                 if (!qos_map)
12938                         return -ENOMEM;
12939
12940                 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
12941                 if (num_des) {
12942                         des_len = num_des *
12943                                 sizeof(struct cfg80211_dscp_exception);
12944                         memcpy(qos_map->dscp_exception, pos, des_len);
12945                         qos_map->num_des = num_des;
12946                         for (des = 0; des < num_des; des++) {
12947                                 if (qos_map->dscp_exception[des].up > 7) {
12948                                         kfree(qos_map);
12949                                         return -EINVAL;
12950                                 }
12951                         }
12952                         pos += des_len;
12953                 }
12954                 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
12955         }
12956
12957         wdev_lock(dev->ieee80211_ptr);
12958         ret = nl80211_key_allowed(dev->ieee80211_ptr);
12959         if (!ret)
12960                 ret = rdev_set_qos_map(rdev, dev, qos_map);
12961         wdev_unlock(dev->ieee80211_ptr);
12962
12963         kfree(qos_map);
12964         return ret;
12965 }
12966
12967 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
12968 {
12969         struct cfg80211_registered_device *rdev = info->user_ptr[0];
12970         struct net_device *dev = info->user_ptr[1];
12971         struct wireless_dev *wdev = dev->ieee80211_ptr;
12972         const u8 *peer;
12973         u8 tsid, up;
12974         u16 admitted_time = 0;
12975         int err;
12976
12977         if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
12978                 return -EOPNOTSUPP;
12979
12980         if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
12981             !info->attrs[NL80211_ATTR_USER_PRIO])
12982                 return -EINVAL;
12983
12984         tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
12985         up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
12986
12987         /* WMM uses TIDs 0-7 even for TSPEC */
12988         if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
12989                 /* TODO: handle 802.11 TSPEC/admission control
12990                  * need more attributes for that (e.g. BA session requirement);
12991                  * change the WMM adminssion test above to allow both then
12992                  */
12993                 return -EINVAL;
12994         }
12995
12996         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
12997
12998         if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
12999                 admitted_time =
13000                         nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
13001                 if (!admitted_time)
13002                         return -EINVAL;
13003         }
13004
13005         wdev_lock(wdev);
13006         switch (wdev->iftype) {
13007         case NL80211_IFTYPE_STATION:
13008         case NL80211_IFTYPE_P2P_CLIENT:
13009                 if (wdev->current_bss)
13010                         break;
13011                 err = -ENOTCONN;
13012                 goto out;
13013         default:
13014                 err = -EOPNOTSUPP;
13015                 goto out;
13016         }
13017
13018         err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
13019
13020  out:
13021         wdev_unlock(wdev);
13022         return err;
13023 }
13024
13025 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
13026 {
13027         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13028         struct net_device *dev = info->user_ptr[1];
13029         struct wireless_dev *wdev = dev->ieee80211_ptr;
13030         const u8 *peer;
13031         u8 tsid;
13032         int err;
13033
13034         if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
13035                 return -EINVAL;
13036
13037         tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
13038         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
13039
13040         wdev_lock(wdev);
13041         err = rdev_del_tx_ts(rdev, dev, tsid, peer);
13042         wdev_unlock(wdev);
13043
13044         return err;
13045 }
13046
13047 static int nl80211_tdls_channel_switch(struct sk_buff *skb,
13048                                        struct genl_info *info)
13049 {
13050         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13051         struct net_device *dev = info->user_ptr[1];
13052         struct wireless_dev *wdev = dev->ieee80211_ptr;
13053         struct cfg80211_chan_def chandef = {};
13054         const u8 *addr;
13055         u8 oper_class;
13056         int err;
13057
13058         if (!rdev->ops->tdls_channel_switch ||
13059             !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
13060                 return -EOPNOTSUPP;
13061
13062         switch (dev->ieee80211_ptr->iftype) {
13063         case NL80211_IFTYPE_STATION:
13064         case NL80211_IFTYPE_P2P_CLIENT:
13065                 break;
13066         default:
13067                 return -EOPNOTSUPP;
13068         }
13069
13070         if (!info->attrs[NL80211_ATTR_MAC] ||
13071             !info->attrs[NL80211_ATTR_OPER_CLASS])
13072                 return -EINVAL;
13073
13074         err = nl80211_parse_chandef(rdev, info, &chandef);
13075         if (err)
13076                 return err;
13077
13078         /*
13079          * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
13080          * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
13081          * specification is not defined for them.
13082          */
13083         if (chandef.chan->band == NL80211_BAND_2GHZ &&
13084             chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
13085             chandef.width != NL80211_CHAN_WIDTH_20)
13086                 return -EINVAL;
13087
13088         /* we will be active on the TDLS link */
13089         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
13090                                            wdev->iftype))
13091                 return -EINVAL;
13092
13093         /* don't allow switching to DFS channels */
13094         if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
13095                 return -EINVAL;
13096
13097         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
13098         oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
13099
13100         wdev_lock(wdev);
13101         err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
13102         wdev_unlock(wdev);
13103
13104         return err;
13105 }
13106
13107 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
13108                                               struct genl_info *info)
13109 {
13110         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13111         struct net_device *dev = info->user_ptr[1];
13112         struct wireless_dev *wdev = dev->ieee80211_ptr;
13113         const u8 *addr;
13114
13115         if (!rdev->ops->tdls_channel_switch ||
13116             !rdev->ops->tdls_cancel_channel_switch ||
13117             !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
13118                 return -EOPNOTSUPP;
13119
13120         switch (dev->ieee80211_ptr->iftype) {
13121         case NL80211_IFTYPE_STATION:
13122         case NL80211_IFTYPE_P2P_CLIENT:
13123                 break;
13124         default:
13125                 return -EOPNOTSUPP;
13126         }
13127
13128         if (!info->attrs[NL80211_ATTR_MAC])
13129                 return -EINVAL;
13130
13131         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
13132
13133         wdev_lock(wdev);
13134         rdev_tdls_cancel_channel_switch(rdev, dev, addr);
13135         wdev_unlock(wdev);
13136
13137         return 0;
13138 }
13139
13140 static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
13141                                             struct genl_info *info)
13142 {
13143         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13144         struct net_device *dev = info->user_ptr[1];
13145         struct wireless_dev *wdev = dev->ieee80211_ptr;
13146         const struct nlattr *nla;
13147         bool enabled;
13148
13149         if (!rdev->ops->set_multicast_to_unicast)
13150                 return -EOPNOTSUPP;
13151
13152         if (wdev->iftype != NL80211_IFTYPE_AP &&
13153             wdev->iftype != NL80211_IFTYPE_P2P_GO)
13154                 return -EOPNOTSUPP;
13155
13156         nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
13157         enabled = nla_get_flag(nla);
13158
13159         return rdev_set_multicast_to_unicast(rdev, dev, enabled);
13160 }
13161
13162 static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
13163 {
13164         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13165         struct net_device *dev = info->user_ptr[1];
13166         struct wireless_dev *wdev = dev->ieee80211_ptr;
13167         struct cfg80211_pmk_conf pmk_conf = {};
13168         int ret;
13169
13170         if (wdev->iftype != NL80211_IFTYPE_STATION &&
13171             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
13172                 return -EOPNOTSUPP;
13173
13174         if (!wiphy_ext_feature_isset(&rdev->wiphy,
13175                                      NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
13176                 return -EOPNOTSUPP;
13177
13178         if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
13179                 return -EINVAL;
13180
13181         wdev_lock(wdev);
13182         if (!wdev->current_bss) {
13183                 ret = -ENOTCONN;
13184                 goto out;
13185         }
13186
13187         pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
13188         if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) {
13189                 ret = -EINVAL;
13190                 goto out;
13191         }
13192
13193         pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
13194         pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
13195         if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
13196             pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
13197                 ret = -EINVAL;
13198                 goto out;
13199         }
13200
13201         if (info->attrs[NL80211_ATTR_PMKR0_NAME]) {
13202                 int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]);
13203
13204                 if (r0_name_len != WLAN_PMK_NAME_LEN) {
13205                         ret = -EINVAL;
13206                         goto out;
13207                 }
13208
13209                 pmk_conf.pmk_r0_name =
13210                         nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
13211         }
13212
13213         ret = rdev_set_pmk(rdev, dev, &pmk_conf);
13214 out:
13215         wdev_unlock(wdev);
13216         return ret;
13217 }
13218
13219 static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
13220 {
13221         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13222         struct net_device *dev = info->user_ptr[1];
13223         struct wireless_dev *wdev = dev->ieee80211_ptr;
13224         const u8 *aa;
13225         int ret;
13226
13227         if (wdev->iftype != NL80211_IFTYPE_STATION &&
13228             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
13229                 return -EOPNOTSUPP;
13230
13231         if (!wiphy_ext_feature_isset(&rdev->wiphy,
13232                                      NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
13233                 return -EOPNOTSUPP;
13234
13235         if (!info->attrs[NL80211_ATTR_MAC])
13236                 return -EINVAL;
13237
13238         wdev_lock(wdev);
13239         aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
13240         ret = rdev_del_pmk(rdev, dev, aa);
13241         wdev_unlock(wdev);
13242
13243         return ret;
13244 }
13245
13246 static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
13247 {
13248         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13249         struct net_device *dev = info->user_ptr[1];
13250         struct cfg80211_external_auth_params params;
13251
13252         if (!rdev->ops->external_auth)
13253                 return -EOPNOTSUPP;
13254
13255         if (!info->attrs[NL80211_ATTR_SSID] &&
13256             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
13257             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
13258                 return -EINVAL;
13259
13260         if (!info->attrs[NL80211_ATTR_BSSID])
13261                 return -EINVAL;
13262
13263         if (!info->attrs[NL80211_ATTR_STATUS_CODE])
13264                 return -EINVAL;
13265
13266         memset(&params, 0, sizeof(params));
13267
13268         if (info->attrs[NL80211_ATTR_SSID]) {
13269                 params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
13270                 if (params.ssid.ssid_len == 0 ||
13271                     params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN)
13272                         return -EINVAL;
13273                 memcpy(params.ssid.ssid,
13274                        nla_data(info->attrs[NL80211_ATTR_SSID]),
13275                        params.ssid.ssid_len);
13276         }
13277
13278         memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
13279                ETH_ALEN);
13280
13281         params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
13282
13283         if (info->attrs[NL80211_ATTR_PMKID])
13284                 params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
13285
13286         return rdev_external_auth(rdev, dev, &params);
13287 }
13288
13289 static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
13290 {
13291         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13292         struct net_device *dev = info->user_ptr[1];
13293         struct wireless_dev *wdev = dev->ieee80211_ptr;
13294         const u8 *buf;
13295         size_t len;
13296         u8 *dest;
13297         u16 proto;
13298         bool noencrypt;
13299         int err;
13300
13301         if (!wiphy_ext_feature_isset(&rdev->wiphy,
13302                                      NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
13303                 return -EOPNOTSUPP;
13304
13305         if (!rdev->ops->tx_control_port)
13306                 return -EOPNOTSUPP;
13307
13308         if (!info->attrs[NL80211_ATTR_FRAME] ||
13309             !info->attrs[NL80211_ATTR_MAC] ||
13310             !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
13311                 GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
13312                 return -EINVAL;
13313         }
13314
13315         wdev_lock(wdev);
13316
13317         switch (wdev->iftype) {
13318         case NL80211_IFTYPE_AP:
13319         case NL80211_IFTYPE_P2P_GO:
13320         case NL80211_IFTYPE_MESH_POINT:
13321                 break;
13322         case NL80211_IFTYPE_ADHOC:
13323         case NL80211_IFTYPE_STATION:
13324         case NL80211_IFTYPE_P2P_CLIENT:
13325                 if (wdev->current_bss)
13326                         break;
13327                 err = -ENOTCONN;
13328                 goto out;
13329         default:
13330                 err = -EOPNOTSUPP;
13331                 goto out;
13332         }
13333
13334         wdev_unlock(wdev);
13335
13336         buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
13337         len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
13338         dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
13339         proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
13340         noencrypt =
13341                 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);
13342
13343         return rdev_tx_control_port(rdev, dev, buf, len,
13344                                     dest, cpu_to_be16(proto), noencrypt);
13345
13346  out:
13347         wdev_unlock(wdev);
13348         return err;
13349 }
13350
13351 static int nl80211_get_ftm_responder_stats(struct sk_buff *skb,
13352                                            struct genl_info *info)
13353 {
13354         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13355         struct net_device *dev = info->user_ptr[1];
13356         struct wireless_dev *wdev = dev->ieee80211_ptr;
13357         struct cfg80211_ftm_responder_stats ftm_stats = {};
13358         struct sk_buff *msg;
13359         void *hdr;
13360         struct nlattr *ftm_stats_attr;
13361         int err;
13362
13363         if (wdev->iftype != NL80211_IFTYPE_AP || !wdev->beacon_interval)
13364                 return -EOPNOTSUPP;
13365
13366         err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats);
13367         if (err)
13368                 return err;
13369
13370         if (!ftm_stats.filled)
13371                 return -ENODATA;
13372
13373         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13374         if (!msg)
13375                 return -ENOMEM;
13376
13377         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
13378                              NL80211_CMD_GET_FTM_RESPONDER_STATS);
13379         if (!hdr)
13380                 return -ENOBUFS;
13381
13382         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
13383                 goto nla_put_failure;
13384
13385         ftm_stats_attr = nla_nest_start_noflag(msg,
13386                                                NL80211_ATTR_FTM_RESPONDER_STATS);
13387         if (!ftm_stats_attr)
13388                 goto nla_put_failure;
13389
13390 #define SET_FTM(field, name, type)                                       \
13391         do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
13392             nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name,            \
13393                              ftm_stats.field))                           \
13394                 goto nla_put_failure; } while (0)
13395 #define SET_FTM_U64(field, name)                                         \
13396         do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
13397             nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name,           \
13398                               ftm_stats.field, NL80211_FTM_STATS_PAD))   \
13399                 goto nla_put_failure; } while (0)
13400
13401         SET_FTM(success_num, SUCCESS_NUM, u32);
13402         SET_FTM(partial_num, PARTIAL_NUM, u32);
13403         SET_FTM(failed_num, FAILED_NUM, u32);
13404         SET_FTM(asap_num, ASAP_NUM, u32);
13405         SET_FTM(non_asap_num, NON_ASAP_NUM, u32);
13406         SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC);
13407         SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32);
13408         SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32);
13409         SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32);
13410 #undef SET_FTM
13411
13412         nla_nest_end(msg, ftm_stats_attr);
13413
13414         genlmsg_end(msg, hdr);
13415         return genlmsg_reply(msg, info);
13416
13417 nla_put_failure:
13418         nlmsg_free(msg);
13419         return -ENOBUFS;
13420 }
13421
13422 static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info)
13423 {
13424         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13425         struct cfg80211_update_owe_info owe_info;
13426         struct net_device *dev = info->user_ptr[1];
13427
13428         if (!rdev->ops->update_owe_info)
13429                 return -EOPNOTSUPP;
13430
13431         if (!info->attrs[NL80211_ATTR_STATUS_CODE] ||
13432             !info->attrs[NL80211_ATTR_MAC])
13433                 return -EINVAL;
13434
13435         memset(&owe_info, 0, sizeof(owe_info));
13436         owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
13437         nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN);
13438
13439         if (info->attrs[NL80211_ATTR_IE]) {
13440                 owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
13441                 owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
13442         }
13443
13444         return rdev_update_owe_info(rdev, dev, &owe_info);
13445 }
13446
13447 static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info)
13448 {
13449         struct cfg80211_registered_device *rdev = info->user_ptr[0];
13450         struct net_device *dev = info->user_ptr[1];
13451         struct wireless_dev *wdev = dev->ieee80211_ptr;
13452         struct station_info sinfo = {};
13453         const u8 *buf;
13454         size_t len;
13455         u8 *dest;
13456         int err;
13457
13458         if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station)
13459                 return -EOPNOTSUPP;
13460
13461         if (!info->attrs[NL80211_ATTR_MAC] ||
13462             !info->attrs[NL80211_ATTR_FRAME]) {
13463                 GENL_SET_ERR_MSG(info, "Frame or MAC missing");
13464                 return -EINVAL;
13465         }
13466
13467         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
13468                 return -EOPNOTSUPP;
13469
13470         dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
13471         buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
13472         len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
13473
13474         if (len < sizeof(struct ethhdr))
13475                 return -EINVAL;
13476
13477         if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) ||
13478             !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr))
13479                 return -EINVAL;
13480
13481         err = rdev_get_station(rdev, dev, dest, &sinfo);
13482         if (err)
13483                 return err;
13484
13485         return rdev_probe_mesh_link(rdev, dev, dest, buf, len);
13486 }
13487
13488 #define NL80211_FLAG_NEED_WIPHY         0x01
13489 #define NL80211_FLAG_NEED_NETDEV        0x02
13490 #define NL80211_FLAG_NEED_RTNL          0x04
13491 #define NL80211_FLAG_CHECK_NETDEV_UP    0x08
13492 #define NL80211_FLAG_NEED_NETDEV_UP     (NL80211_FLAG_NEED_NETDEV |\
13493                                          NL80211_FLAG_CHECK_NETDEV_UP)
13494 #define NL80211_FLAG_NEED_WDEV          0x10
13495 /* If a netdev is associated, it must be UP, P2P must be started */
13496 #define NL80211_FLAG_NEED_WDEV_UP       (NL80211_FLAG_NEED_WDEV |\
13497                                          NL80211_FLAG_CHECK_NETDEV_UP)
13498 #define NL80211_FLAG_CLEAR_SKB          0x20
13499
13500 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
13501                             struct genl_info *info)
13502 {
13503         struct cfg80211_registered_device *rdev;
13504         struct wireless_dev *wdev;
13505         struct net_device *dev;
13506         bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
13507
13508         if (rtnl)
13509                 rtnl_lock();
13510
13511         if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
13512                 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
13513                 if (IS_ERR(rdev)) {
13514                         if (rtnl)
13515                                 rtnl_unlock();
13516                         return PTR_ERR(rdev);
13517                 }
13518                 info->user_ptr[0] = rdev;
13519         } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
13520                    ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
13521                 ASSERT_RTNL();
13522
13523                 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
13524                                                   info->attrs);
13525                 if (IS_ERR(wdev)) {
13526                         if (rtnl)
13527                                 rtnl_unlock();
13528                         return PTR_ERR(wdev);
13529                 }
13530
13531                 dev = wdev->netdev;
13532                 rdev = wiphy_to_rdev(wdev->wiphy);
13533
13534                 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
13535                         if (!dev) {
13536                                 if (rtnl)
13537                                         rtnl_unlock();
13538                                 return -EINVAL;
13539                         }
13540
13541                         info->user_ptr[1] = dev;
13542                 } else {
13543                         info->user_ptr[1] = wdev;
13544                 }
13545
13546                 if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
13547                     !wdev_running(wdev)) {
13548                         if (rtnl)
13549                                 rtnl_unlock();
13550                         return -ENETDOWN;
13551                 }
13552
13553                 if (dev)
13554                         dev_hold(dev);
13555
13556                 info->user_ptr[0] = rdev;
13557         }
13558
13559         return 0;
13560 }
13561
13562 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
13563                               struct genl_info *info)
13564 {
13565         if (info->user_ptr[1]) {
13566                 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
13567                         struct wireless_dev *wdev = info->user_ptr[1];
13568
13569                         if (wdev->netdev)
13570                                 dev_put(wdev->netdev);
13571                 } else {
13572                         dev_put(info->user_ptr[1]);
13573                 }
13574         }
13575
13576         if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
13577                 rtnl_unlock();
13578
13579         /* If needed, clear the netlink message payload from the SKB
13580          * as it might contain key data that shouldn't stick around on
13581          * the heap after the SKB is freed. The netlink message header
13582          * is still needed for further processing, so leave it intact.
13583          */
13584         if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
13585                 struct nlmsghdr *nlh = nlmsg_hdr(skb);
13586
13587                 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
13588         }
13589 }
13590
13591 static const struct genl_ops nl80211_ops[] = {
13592         {
13593                 .cmd = NL80211_CMD_GET_WIPHY,
13594                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13595                 .doit = nl80211_get_wiphy,
13596                 .dumpit = nl80211_dump_wiphy,
13597                 .done = nl80211_dump_wiphy_done,
13598                 /* can be retrieved by unprivileged users */
13599                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13600                                   NL80211_FLAG_NEED_RTNL,
13601         },
13602         {
13603                 .cmd = NL80211_CMD_SET_WIPHY,
13604                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13605                 .doit = nl80211_set_wiphy,
13606                 .flags = GENL_UNS_ADMIN_PERM,
13607                 .internal_flags = NL80211_FLAG_NEED_RTNL,
13608         },
13609         {
13610                 .cmd = NL80211_CMD_GET_INTERFACE,
13611                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13612                 .doit = nl80211_get_interface,
13613                 .dumpit = nl80211_dump_interface,
13614                 /* can be retrieved by unprivileged users */
13615                 .internal_flags = NL80211_FLAG_NEED_WDEV |
13616                                   NL80211_FLAG_NEED_RTNL,
13617         },
13618         {
13619                 .cmd = NL80211_CMD_SET_INTERFACE,
13620                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13621                 .doit = nl80211_set_interface,
13622                 .flags = GENL_UNS_ADMIN_PERM,
13623                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13624                                   NL80211_FLAG_NEED_RTNL,
13625         },
13626         {
13627                 .cmd = NL80211_CMD_NEW_INTERFACE,
13628                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13629                 .doit = nl80211_new_interface,
13630                 .flags = GENL_UNS_ADMIN_PERM,
13631                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13632                                   NL80211_FLAG_NEED_RTNL,
13633         },
13634         {
13635                 .cmd = NL80211_CMD_DEL_INTERFACE,
13636                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13637                 .doit = nl80211_del_interface,
13638                 .flags = GENL_UNS_ADMIN_PERM,
13639                 .internal_flags = NL80211_FLAG_NEED_WDEV |
13640                                   NL80211_FLAG_NEED_RTNL,
13641         },
13642         {
13643                 .cmd = NL80211_CMD_GET_KEY,
13644                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13645                 .doit = nl80211_get_key,
13646                 .flags = GENL_UNS_ADMIN_PERM,
13647                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13648                                   NL80211_FLAG_NEED_RTNL,
13649         },
13650         {
13651                 .cmd = NL80211_CMD_SET_KEY,
13652                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13653                 .doit = nl80211_set_key,
13654                 .flags = GENL_UNS_ADMIN_PERM,
13655                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13656                                   NL80211_FLAG_NEED_RTNL |
13657                                   NL80211_FLAG_CLEAR_SKB,
13658         },
13659         {
13660                 .cmd = NL80211_CMD_NEW_KEY,
13661                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13662                 .doit = nl80211_new_key,
13663                 .flags = GENL_UNS_ADMIN_PERM,
13664                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13665                                   NL80211_FLAG_NEED_RTNL |
13666                                   NL80211_FLAG_CLEAR_SKB,
13667         },
13668         {
13669                 .cmd = NL80211_CMD_DEL_KEY,
13670                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13671                 .doit = nl80211_del_key,
13672                 .flags = GENL_UNS_ADMIN_PERM,
13673                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13674                                   NL80211_FLAG_NEED_RTNL,
13675         },
13676         {
13677                 .cmd = NL80211_CMD_SET_BEACON,
13678                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13679                 .flags = GENL_UNS_ADMIN_PERM,
13680                 .doit = nl80211_set_beacon,
13681                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13682                                   NL80211_FLAG_NEED_RTNL,
13683         },
13684         {
13685                 .cmd = NL80211_CMD_START_AP,
13686                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13687                 .flags = GENL_UNS_ADMIN_PERM,
13688                 .doit = nl80211_start_ap,
13689                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13690                                   NL80211_FLAG_NEED_RTNL,
13691         },
13692         {
13693                 .cmd = NL80211_CMD_STOP_AP,
13694                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13695                 .flags = GENL_UNS_ADMIN_PERM,
13696                 .doit = nl80211_stop_ap,
13697                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13698                                   NL80211_FLAG_NEED_RTNL,
13699         },
13700         {
13701                 .cmd = NL80211_CMD_GET_STATION,
13702                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13703                 .doit = nl80211_get_station,
13704                 .dumpit = nl80211_dump_station,
13705                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
13706                                   NL80211_FLAG_NEED_RTNL,
13707         },
13708         {
13709                 .cmd = NL80211_CMD_SET_STATION,
13710                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13711                 .doit = nl80211_set_station,
13712                 .flags = GENL_UNS_ADMIN_PERM,
13713                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13714                                   NL80211_FLAG_NEED_RTNL,
13715         },
13716         {
13717                 .cmd = NL80211_CMD_NEW_STATION,
13718                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13719                 .doit = nl80211_new_station,
13720                 .flags = GENL_UNS_ADMIN_PERM,
13721                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13722                                   NL80211_FLAG_NEED_RTNL,
13723         },
13724         {
13725                 .cmd = NL80211_CMD_DEL_STATION,
13726                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13727                 .doit = nl80211_del_station,
13728                 .flags = GENL_UNS_ADMIN_PERM,
13729                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13730                                   NL80211_FLAG_NEED_RTNL,
13731         },
13732         {
13733                 .cmd = NL80211_CMD_GET_MPATH,
13734                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13735                 .doit = nl80211_get_mpath,
13736                 .dumpit = nl80211_dump_mpath,
13737                 .flags = GENL_UNS_ADMIN_PERM,
13738                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13739                                   NL80211_FLAG_NEED_RTNL,
13740         },
13741         {
13742                 .cmd = NL80211_CMD_GET_MPP,
13743                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13744                 .doit = nl80211_get_mpp,
13745                 .dumpit = nl80211_dump_mpp,
13746                 .flags = GENL_UNS_ADMIN_PERM,
13747                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13748                                   NL80211_FLAG_NEED_RTNL,
13749         },
13750         {
13751                 .cmd = NL80211_CMD_SET_MPATH,
13752                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13753                 .doit = nl80211_set_mpath,
13754                 .flags = GENL_UNS_ADMIN_PERM,
13755                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13756                                   NL80211_FLAG_NEED_RTNL,
13757         },
13758         {
13759                 .cmd = NL80211_CMD_NEW_MPATH,
13760                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13761                 .doit = nl80211_new_mpath,
13762                 .flags = GENL_UNS_ADMIN_PERM,
13763                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13764                                   NL80211_FLAG_NEED_RTNL,
13765         },
13766         {
13767                 .cmd = NL80211_CMD_DEL_MPATH,
13768                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13769                 .doit = nl80211_del_mpath,
13770                 .flags = GENL_UNS_ADMIN_PERM,
13771                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13772                                   NL80211_FLAG_NEED_RTNL,
13773         },
13774         {
13775                 .cmd = NL80211_CMD_SET_BSS,
13776                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13777                 .doit = nl80211_set_bss,
13778                 .flags = GENL_UNS_ADMIN_PERM,
13779                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13780                                   NL80211_FLAG_NEED_RTNL,
13781         },
13782         {
13783                 .cmd = NL80211_CMD_GET_REG,
13784                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13785                 .doit = nl80211_get_reg_do,
13786                 .dumpit = nl80211_get_reg_dump,
13787                 .internal_flags = NL80211_FLAG_NEED_RTNL,
13788                 /* can be retrieved by unprivileged users */
13789         },
13790 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
13791         {
13792                 .cmd = NL80211_CMD_SET_REG,
13793                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13794                 .doit = nl80211_set_reg,
13795                 .flags = GENL_ADMIN_PERM,
13796                 .internal_flags = NL80211_FLAG_NEED_RTNL,
13797         },
13798 #endif
13799         {
13800                 .cmd = NL80211_CMD_REQ_SET_REG,
13801                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13802                 .doit = nl80211_req_set_reg,
13803                 .flags = GENL_ADMIN_PERM,
13804         },
13805         {
13806                 .cmd = NL80211_CMD_RELOAD_REGDB,
13807                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13808                 .doit = nl80211_reload_regdb,
13809                 .flags = GENL_ADMIN_PERM,
13810         },
13811         {
13812                 .cmd = NL80211_CMD_GET_MESH_CONFIG,
13813                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13814                 .doit = nl80211_get_mesh_config,
13815                 /* can be retrieved by unprivileged users */
13816                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13817                                   NL80211_FLAG_NEED_RTNL,
13818         },
13819         {
13820                 .cmd = NL80211_CMD_SET_MESH_CONFIG,
13821                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13822                 .doit = nl80211_update_mesh_config,
13823                 .flags = GENL_UNS_ADMIN_PERM,
13824                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13825                                   NL80211_FLAG_NEED_RTNL,
13826         },
13827         {
13828                 .cmd = NL80211_CMD_TRIGGER_SCAN,
13829                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13830                 .doit = nl80211_trigger_scan,
13831                 .flags = GENL_UNS_ADMIN_PERM,
13832                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13833                                   NL80211_FLAG_NEED_RTNL,
13834         },
13835         {
13836                 .cmd = NL80211_CMD_ABORT_SCAN,
13837                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13838                 .doit = nl80211_abort_scan,
13839                 .flags = GENL_UNS_ADMIN_PERM,
13840                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13841                                   NL80211_FLAG_NEED_RTNL,
13842         },
13843         {
13844                 .cmd = NL80211_CMD_GET_SCAN,
13845                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13846                 .dumpit = nl80211_dump_scan,
13847         },
13848         {
13849                 .cmd = NL80211_CMD_START_SCHED_SCAN,
13850                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13851                 .doit = nl80211_start_sched_scan,
13852                 .flags = GENL_UNS_ADMIN_PERM,
13853                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13854                                   NL80211_FLAG_NEED_RTNL,
13855         },
13856         {
13857                 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
13858                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13859                 .doit = nl80211_stop_sched_scan,
13860                 .flags = GENL_UNS_ADMIN_PERM,
13861                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13862                                   NL80211_FLAG_NEED_RTNL,
13863         },
13864         {
13865                 .cmd = NL80211_CMD_AUTHENTICATE,
13866                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13867                 .doit = nl80211_authenticate,
13868                 .flags = GENL_UNS_ADMIN_PERM,
13869                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13870                                   NL80211_FLAG_NEED_RTNL |
13871                                   NL80211_FLAG_CLEAR_SKB,
13872         },
13873         {
13874                 .cmd = NL80211_CMD_ASSOCIATE,
13875                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13876                 .doit = nl80211_associate,
13877                 .flags = GENL_UNS_ADMIN_PERM,
13878                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13879                                   NL80211_FLAG_NEED_RTNL |
13880                                   NL80211_FLAG_CLEAR_SKB,
13881         },
13882         {
13883                 .cmd = NL80211_CMD_DEAUTHENTICATE,
13884                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13885                 .doit = nl80211_deauthenticate,
13886                 .flags = GENL_UNS_ADMIN_PERM,
13887                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13888                                   NL80211_FLAG_NEED_RTNL,
13889         },
13890         {
13891                 .cmd = NL80211_CMD_DISASSOCIATE,
13892                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13893                 .doit = nl80211_disassociate,
13894                 .flags = GENL_UNS_ADMIN_PERM,
13895                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13896                                   NL80211_FLAG_NEED_RTNL,
13897         },
13898         {
13899                 .cmd = NL80211_CMD_JOIN_IBSS,
13900                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13901                 .doit = nl80211_join_ibss,
13902                 .flags = GENL_UNS_ADMIN_PERM,
13903                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13904                                   NL80211_FLAG_NEED_RTNL,
13905         },
13906         {
13907                 .cmd = NL80211_CMD_LEAVE_IBSS,
13908                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13909                 .doit = nl80211_leave_ibss,
13910                 .flags = GENL_UNS_ADMIN_PERM,
13911                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13912                                   NL80211_FLAG_NEED_RTNL,
13913         },
13914 #ifdef CONFIG_NL80211_TESTMODE
13915         {
13916                 .cmd = NL80211_CMD_TESTMODE,
13917                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13918                 .doit = nl80211_testmode_do,
13919                 .dumpit = nl80211_testmode_dump,
13920                 .flags = GENL_UNS_ADMIN_PERM,
13921                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13922                                   NL80211_FLAG_NEED_RTNL,
13923         },
13924 #endif
13925         {
13926                 .cmd = NL80211_CMD_CONNECT,
13927                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13928                 .doit = nl80211_connect,
13929                 .flags = GENL_UNS_ADMIN_PERM,
13930                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13931                                   NL80211_FLAG_NEED_RTNL |
13932                                   NL80211_FLAG_CLEAR_SKB,
13933         },
13934         {
13935                 .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
13936                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13937                 .doit = nl80211_update_connect_params,
13938                 .flags = GENL_ADMIN_PERM,
13939                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13940                                   NL80211_FLAG_NEED_RTNL |
13941                                   NL80211_FLAG_CLEAR_SKB,
13942         },
13943         {
13944                 .cmd = NL80211_CMD_DISCONNECT,
13945                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13946                 .doit = nl80211_disconnect,
13947                 .flags = GENL_UNS_ADMIN_PERM,
13948                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13949                                   NL80211_FLAG_NEED_RTNL,
13950         },
13951         {
13952                 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
13953                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13954                 .doit = nl80211_wiphy_netns,
13955                 .flags = GENL_UNS_ADMIN_PERM,
13956                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
13957                                   NL80211_FLAG_NEED_RTNL,
13958         },
13959         {
13960                 .cmd = NL80211_CMD_GET_SURVEY,
13961                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13962                 .dumpit = nl80211_dump_survey,
13963         },
13964         {
13965                 .cmd = NL80211_CMD_SET_PMKSA,
13966                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13967                 .doit = nl80211_setdel_pmksa,
13968                 .flags = GENL_UNS_ADMIN_PERM,
13969                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13970                                   NL80211_FLAG_NEED_RTNL |
13971                                   NL80211_FLAG_CLEAR_SKB,
13972         },
13973         {
13974                 .cmd = NL80211_CMD_DEL_PMKSA,
13975                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13976                 .doit = nl80211_setdel_pmksa,
13977                 .flags = GENL_UNS_ADMIN_PERM,
13978                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13979                                   NL80211_FLAG_NEED_RTNL,
13980         },
13981         {
13982                 .cmd = NL80211_CMD_FLUSH_PMKSA,
13983                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13984                 .doit = nl80211_flush_pmksa,
13985                 .flags = GENL_UNS_ADMIN_PERM,
13986                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
13987                                   NL80211_FLAG_NEED_RTNL,
13988         },
13989         {
13990                 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
13991                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
13992                 .doit = nl80211_remain_on_channel,
13993                 .flags = GENL_UNS_ADMIN_PERM,
13994                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
13995                                   NL80211_FLAG_NEED_RTNL,
13996         },
13997         {
13998                 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
13999                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14000                 .doit = nl80211_cancel_remain_on_channel,
14001                 .flags = GENL_UNS_ADMIN_PERM,
14002                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14003                                   NL80211_FLAG_NEED_RTNL,
14004         },
14005         {
14006                 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
14007                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14008                 .doit = nl80211_set_tx_bitrate_mask,
14009                 .flags = GENL_UNS_ADMIN_PERM,
14010                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14011                                   NL80211_FLAG_NEED_RTNL,
14012         },
14013         {
14014                 .cmd = NL80211_CMD_REGISTER_FRAME,
14015                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14016                 .doit = nl80211_register_mgmt,
14017                 .flags = GENL_UNS_ADMIN_PERM,
14018                 .internal_flags = NL80211_FLAG_NEED_WDEV |
14019                                   NL80211_FLAG_NEED_RTNL,
14020         },
14021         {
14022                 .cmd = NL80211_CMD_FRAME,
14023                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14024                 .doit = nl80211_tx_mgmt,
14025                 .flags = GENL_UNS_ADMIN_PERM,
14026                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14027                                   NL80211_FLAG_NEED_RTNL,
14028         },
14029         {
14030                 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
14031                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14032                 .doit = nl80211_tx_mgmt_cancel_wait,
14033                 .flags = GENL_UNS_ADMIN_PERM,
14034                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14035                                   NL80211_FLAG_NEED_RTNL,
14036         },
14037         {
14038                 .cmd = NL80211_CMD_SET_POWER_SAVE,
14039                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14040                 .doit = nl80211_set_power_save,
14041                 .flags = GENL_UNS_ADMIN_PERM,
14042                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14043                                   NL80211_FLAG_NEED_RTNL,
14044         },
14045         {
14046                 .cmd = NL80211_CMD_GET_POWER_SAVE,
14047                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14048                 .doit = nl80211_get_power_save,
14049                 /* can be retrieved by unprivileged users */
14050                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14051                                   NL80211_FLAG_NEED_RTNL,
14052         },
14053         {
14054                 .cmd = NL80211_CMD_SET_CQM,
14055                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14056                 .doit = nl80211_set_cqm,
14057                 .flags = GENL_UNS_ADMIN_PERM,
14058                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14059                                   NL80211_FLAG_NEED_RTNL,
14060         },
14061         {
14062                 .cmd = NL80211_CMD_SET_CHANNEL,
14063                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14064                 .doit = nl80211_set_channel,
14065                 .flags = GENL_UNS_ADMIN_PERM,
14066                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14067                                   NL80211_FLAG_NEED_RTNL,
14068         },
14069         {
14070                 .cmd = NL80211_CMD_SET_WDS_PEER,
14071                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14072                 .doit = nl80211_set_wds_peer,
14073                 .flags = GENL_UNS_ADMIN_PERM,
14074                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14075                                   NL80211_FLAG_NEED_RTNL,
14076         },
14077         {
14078                 .cmd = NL80211_CMD_JOIN_MESH,
14079                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14080                 .doit = nl80211_join_mesh,
14081                 .flags = GENL_UNS_ADMIN_PERM,
14082                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14083                                   NL80211_FLAG_NEED_RTNL,
14084         },
14085         {
14086                 .cmd = NL80211_CMD_LEAVE_MESH,
14087                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14088                 .doit = nl80211_leave_mesh,
14089                 .flags = GENL_UNS_ADMIN_PERM,
14090                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14091                                   NL80211_FLAG_NEED_RTNL,
14092         },
14093         {
14094                 .cmd = NL80211_CMD_JOIN_OCB,
14095                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14096                 .doit = nl80211_join_ocb,
14097                 .flags = GENL_UNS_ADMIN_PERM,
14098                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14099                                   NL80211_FLAG_NEED_RTNL,
14100         },
14101         {
14102                 .cmd = NL80211_CMD_LEAVE_OCB,
14103                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14104                 .doit = nl80211_leave_ocb,
14105                 .flags = GENL_UNS_ADMIN_PERM,
14106                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14107                                   NL80211_FLAG_NEED_RTNL,
14108         },
14109 #ifdef CONFIG_PM
14110         {
14111                 .cmd = NL80211_CMD_GET_WOWLAN,
14112                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14113                 .doit = nl80211_get_wowlan,
14114                 /* can be retrieved by unprivileged users */
14115                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14116                                   NL80211_FLAG_NEED_RTNL,
14117         },
14118         {
14119                 .cmd = NL80211_CMD_SET_WOWLAN,
14120                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14121                 .doit = nl80211_set_wowlan,
14122                 .flags = GENL_UNS_ADMIN_PERM,
14123                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14124                                   NL80211_FLAG_NEED_RTNL,
14125         },
14126 #endif
14127         {
14128                 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
14129                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14130                 .doit = nl80211_set_rekey_data,
14131                 .flags = GENL_UNS_ADMIN_PERM,
14132                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14133                                   NL80211_FLAG_NEED_RTNL |
14134                                   NL80211_FLAG_CLEAR_SKB,
14135         },
14136         {
14137                 .cmd = NL80211_CMD_TDLS_MGMT,
14138                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14139                 .doit = nl80211_tdls_mgmt,
14140                 .flags = GENL_UNS_ADMIN_PERM,
14141                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14142                                   NL80211_FLAG_NEED_RTNL,
14143         },
14144         {
14145                 .cmd = NL80211_CMD_TDLS_OPER,
14146                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14147                 .doit = nl80211_tdls_oper,
14148                 .flags = GENL_UNS_ADMIN_PERM,
14149                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14150                                   NL80211_FLAG_NEED_RTNL,
14151         },
14152         {
14153                 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
14154                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14155                 .doit = nl80211_register_unexpected_frame,
14156                 .flags = GENL_UNS_ADMIN_PERM,
14157                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14158                                   NL80211_FLAG_NEED_RTNL,
14159         },
14160         {
14161                 .cmd = NL80211_CMD_PROBE_CLIENT,
14162                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14163                 .doit = nl80211_probe_client,
14164                 .flags = GENL_UNS_ADMIN_PERM,
14165                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14166                                   NL80211_FLAG_NEED_RTNL,
14167         },
14168         {
14169                 .cmd = NL80211_CMD_REGISTER_BEACONS,
14170                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14171                 .doit = nl80211_register_beacons,
14172                 .flags = GENL_UNS_ADMIN_PERM,
14173                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14174                                   NL80211_FLAG_NEED_RTNL,
14175         },
14176         {
14177                 .cmd = NL80211_CMD_SET_NOACK_MAP,
14178                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14179                 .doit = nl80211_set_noack_map,
14180                 .flags = GENL_UNS_ADMIN_PERM,
14181                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14182                                   NL80211_FLAG_NEED_RTNL,
14183         },
14184         {
14185                 .cmd = NL80211_CMD_START_P2P_DEVICE,
14186                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14187                 .doit = nl80211_start_p2p_device,
14188                 .flags = GENL_UNS_ADMIN_PERM,
14189                 .internal_flags = NL80211_FLAG_NEED_WDEV |
14190                                   NL80211_FLAG_NEED_RTNL,
14191         },
14192         {
14193                 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
14194                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14195                 .doit = nl80211_stop_p2p_device,
14196                 .flags = GENL_UNS_ADMIN_PERM,
14197                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14198                                   NL80211_FLAG_NEED_RTNL,
14199         },
14200         {
14201                 .cmd = NL80211_CMD_START_NAN,
14202                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14203                 .doit = nl80211_start_nan,
14204                 .flags = GENL_ADMIN_PERM,
14205                 .internal_flags = NL80211_FLAG_NEED_WDEV |
14206                                   NL80211_FLAG_NEED_RTNL,
14207         },
14208         {
14209                 .cmd = NL80211_CMD_STOP_NAN,
14210                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14211                 .doit = nl80211_stop_nan,
14212                 .flags = GENL_ADMIN_PERM,
14213                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14214                                   NL80211_FLAG_NEED_RTNL,
14215         },
14216         {
14217                 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
14218                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14219                 .doit = nl80211_nan_add_func,
14220                 .flags = GENL_ADMIN_PERM,
14221                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14222                                   NL80211_FLAG_NEED_RTNL,
14223         },
14224         {
14225                 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
14226                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14227                 .doit = nl80211_nan_del_func,
14228                 .flags = GENL_ADMIN_PERM,
14229                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14230                                   NL80211_FLAG_NEED_RTNL,
14231         },
14232         {
14233                 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
14234                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14235                 .doit = nl80211_nan_change_config,
14236                 .flags = GENL_ADMIN_PERM,
14237                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14238                                   NL80211_FLAG_NEED_RTNL,
14239         },
14240         {
14241                 .cmd = NL80211_CMD_SET_MCAST_RATE,
14242                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14243                 .doit = nl80211_set_mcast_rate,
14244                 .flags = GENL_UNS_ADMIN_PERM,
14245                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14246                                   NL80211_FLAG_NEED_RTNL,
14247         },
14248         {
14249                 .cmd = NL80211_CMD_SET_MAC_ACL,
14250                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14251                 .doit = nl80211_set_mac_acl,
14252                 .flags = GENL_UNS_ADMIN_PERM,
14253                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14254                                   NL80211_FLAG_NEED_RTNL,
14255         },
14256         {
14257                 .cmd = NL80211_CMD_RADAR_DETECT,
14258                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14259                 .doit = nl80211_start_radar_detection,
14260                 .flags = GENL_UNS_ADMIN_PERM,
14261                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14262                                   NL80211_FLAG_NEED_RTNL,
14263         },
14264         {
14265                 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
14266                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14267                 .doit = nl80211_get_protocol_features,
14268         },
14269         {
14270                 .cmd = NL80211_CMD_UPDATE_FT_IES,
14271                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14272                 .doit = nl80211_update_ft_ies,
14273                 .flags = GENL_UNS_ADMIN_PERM,
14274                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14275                                   NL80211_FLAG_NEED_RTNL,
14276         },
14277         {
14278                 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
14279                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14280                 .doit = nl80211_crit_protocol_start,
14281                 .flags = GENL_UNS_ADMIN_PERM,
14282                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14283                                   NL80211_FLAG_NEED_RTNL,
14284         },
14285         {
14286                 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
14287                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14288                 .doit = nl80211_crit_protocol_stop,
14289                 .flags = GENL_UNS_ADMIN_PERM,
14290                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14291                                   NL80211_FLAG_NEED_RTNL,
14292         },
14293         {
14294                 .cmd = NL80211_CMD_GET_COALESCE,
14295                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14296                 .doit = nl80211_get_coalesce,
14297                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14298                                   NL80211_FLAG_NEED_RTNL,
14299         },
14300         {
14301                 .cmd = NL80211_CMD_SET_COALESCE,
14302                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14303                 .doit = nl80211_set_coalesce,
14304                 .flags = GENL_UNS_ADMIN_PERM,
14305                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14306                                   NL80211_FLAG_NEED_RTNL,
14307         },
14308         {
14309                 .cmd = NL80211_CMD_CHANNEL_SWITCH,
14310                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14311                 .doit = nl80211_channel_switch,
14312                 .flags = GENL_UNS_ADMIN_PERM,
14313                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14314                                   NL80211_FLAG_NEED_RTNL,
14315         },
14316         {
14317                 .cmd = NL80211_CMD_VENDOR,
14318                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14319                 .doit = nl80211_vendor_cmd,
14320                 .dumpit = nl80211_vendor_cmd_dump,
14321                 .flags = GENL_UNS_ADMIN_PERM,
14322                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
14323                                   NL80211_FLAG_NEED_RTNL |
14324                                   NL80211_FLAG_CLEAR_SKB,
14325         },
14326         {
14327                 .cmd = NL80211_CMD_SET_QOS_MAP,
14328                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14329                 .doit = nl80211_set_qos_map,
14330                 .flags = GENL_UNS_ADMIN_PERM,
14331                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14332                                   NL80211_FLAG_NEED_RTNL,
14333         },
14334         {
14335                 .cmd = NL80211_CMD_ADD_TX_TS,
14336                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14337                 .doit = nl80211_add_tx_ts,
14338                 .flags = GENL_UNS_ADMIN_PERM,
14339                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14340                                   NL80211_FLAG_NEED_RTNL,
14341         },
14342         {
14343                 .cmd = NL80211_CMD_DEL_TX_TS,
14344                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14345                 .doit = nl80211_del_tx_ts,
14346                 .flags = GENL_UNS_ADMIN_PERM,
14347                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14348                                   NL80211_FLAG_NEED_RTNL,
14349         },
14350         {
14351                 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
14352                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14353                 .doit = nl80211_tdls_channel_switch,
14354                 .flags = GENL_UNS_ADMIN_PERM,
14355                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14356                                   NL80211_FLAG_NEED_RTNL,
14357         },
14358         {
14359                 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
14360                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14361                 .doit = nl80211_tdls_cancel_channel_switch,
14362                 .flags = GENL_UNS_ADMIN_PERM,
14363                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14364                                   NL80211_FLAG_NEED_RTNL,
14365         },
14366         {
14367                 .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
14368                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14369                 .doit = nl80211_set_multicast_to_unicast,
14370                 .flags = GENL_UNS_ADMIN_PERM,
14371                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14372                                   NL80211_FLAG_NEED_RTNL,
14373         },
14374         {
14375                 .cmd = NL80211_CMD_SET_PMK,
14376                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14377                 .doit = nl80211_set_pmk,
14378                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14379                                   NL80211_FLAG_NEED_RTNL |
14380                                   NL80211_FLAG_CLEAR_SKB,
14381         },
14382         {
14383                 .cmd = NL80211_CMD_DEL_PMK,
14384                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14385                 .doit = nl80211_del_pmk,
14386                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14387                                   NL80211_FLAG_NEED_RTNL,
14388         },
14389         {
14390                 .cmd = NL80211_CMD_EXTERNAL_AUTH,
14391                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14392                 .doit = nl80211_external_auth,
14393                 .flags = GENL_ADMIN_PERM,
14394                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14395                                   NL80211_FLAG_NEED_RTNL,
14396         },
14397         {
14398                 .cmd = NL80211_CMD_CONTROL_PORT_FRAME,
14399                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14400                 .doit = nl80211_tx_control_port,
14401                 .flags = GENL_UNS_ADMIN_PERM,
14402                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14403                                   NL80211_FLAG_NEED_RTNL,
14404         },
14405         {
14406                 .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS,
14407                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14408                 .doit = nl80211_get_ftm_responder_stats,
14409                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
14410                                   NL80211_FLAG_NEED_RTNL,
14411         },
14412         {
14413                 .cmd = NL80211_CMD_PEER_MEASUREMENT_START,
14414                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14415                 .doit = nl80211_pmsr_start,
14416                 .flags = GENL_UNS_ADMIN_PERM,
14417                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
14418                                   NL80211_FLAG_NEED_RTNL,
14419         },
14420         {
14421                 .cmd = NL80211_CMD_NOTIFY_RADAR,
14422                 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
14423                 .doit = nl80211_notify_radar_detection,
14424                 .flags = GENL_UNS_ADMIN_PERM,
14425                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14426                                   NL80211_FLAG_NEED_RTNL,
14427         },
14428         {
14429                 .cmd = NL80211_CMD_UPDATE_OWE_INFO,
14430                 .doit = nl80211_update_owe_info,
14431                 .flags = GENL_ADMIN_PERM,
14432                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14433                                   NL80211_FLAG_NEED_RTNL,
14434         },
14435         {
14436                 .cmd = NL80211_CMD_PROBE_MESH_LINK,
14437                 .doit = nl80211_probe_mesh_link,
14438                 .flags = GENL_UNS_ADMIN_PERM,
14439                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
14440                                   NL80211_FLAG_NEED_RTNL,
14441         },
14442 };
14443
14444 static struct genl_family nl80211_fam __ro_after_init = {
14445         .name = NL80211_GENL_NAME,      /* have users key off the name instead */
14446         .hdrsize = 0,                   /* no private header */
14447         .version = 1,                   /* no particular meaning now */
14448         .maxattr = NL80211_ATTR_MAX,
14449         .policy = nl80211_policy,
14450         .netnsok = true,
14451         .pre_doit = nl80211_pre_doit,
14452         .post_doit = nl80211_post_doit,
14453         .module = THIS_MODULE,
14454         .ops = nl80211_ops,
14455         .n_ops = ARRAY_SIZE(nl80211_ops),
14456         .mcgrps = nl80211_mcgrps,
14457         .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
14458 };
14459
14460 /* notification functions */
14461
14462 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
14463                           enum nl80211_commands cmd)
14464 {
14465         struct sk_buff *msg;
14466         struct nl80211_dump_wiphy_state state = {};
14467
14468         WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
14469                 cmd != NL80211_CMD_DEL_WIPHY);
14470
14471         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14472         if (!msg)
14473                 return;
14474
14475         if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
14476                 nlmsg_free(msg);
14477                 return;
14478         }
14479
14480         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14481                                 NL80211_MCGRP_CONFIG, GFP_KERNEL);
14482 }
14483
14484 void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
14485                                 struct wireless_dev *wdev,
14486                                 enum nl80211_commands cmd)
14487 {
14488         struct sk_buff *msg;
14489
14490         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14491         if (!msg)
14492                 return;
14493
14494         if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) {
14495                 nlmsg_free(msg);
14496                 return;
14497         }
14498
14499         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14500                                 NL80211_MCGRP_CONFIG, GFP_KERNEL);
14501 }
14502
14503 static int nl80211_add_scan_req(struct sk_buff *msg,
14504                                 struct cfg80211_registered_device *rdev)
14505 {
14506         struct cfg80211_scan_request *req = rdev->scan_req;
14507         struct nlattr *nest;
14508         int i;
14509
14510         if (WARN_ON(!req))
14511                 return 0;
14512
14513         nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS);
14514         if (!nest)
14515                 goto nla_put_failure;
14516         for (i = 0; i < req->n_ssids; i++) {
14517                 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
14518                         goto nla_put_failure;
14519         }
14520         nla_nest_end(msg, nest);
14521
14522         nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
14523         if (!nest)
14524                 goto nla_put_failure;
14525         for (i = 0; i < req->n_channels; i++) {
14526                 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
14527                         goto nla_put_failure;
14528         }
14529         nla_nest_end(msg, nest);
14530
14531         if (req->ie &&
14532             nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
14533                 goto nla_put_failure;
14534
14535         if (req->flags &&
14536             nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
14537                 goto nla_put_failure;
14538
14539         if (req->info.scan_start_tsf &&
14540             (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
14541                                req->info.scan_start_tsf, NL80211_BSS_PAD) ||
14542              nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
14543                      req->info.tsf_bssid)))
14544                 goto nla_put_failure;
14545
14546         return 0;
14547  nla_put_failure:
14548         return -ENOBUFS;
14549 }
14550
14551 static int nl80211_prep_scan_msg(struct sk_buff *msg,
14552                                  struct cfg80211_registered_device *rdev,
14553                                  struct wireless_dev *wdev,
14554                                  u32 portid, u32 seq, int flags,
14555                                  u32 cmd)
14556 {
14557         void *hdr;
14558
14559         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
14560         if (!hdr)
14561                 return -1;
14562
14563         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14564             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14565                                          wdev->netdev->ifindex)) ||
14566             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14567                               NL80211_ATTR_PAD))
14568                 goto nla_put_failure;
14569
14570         /* ignore errors and send incomplete event anyway */
14571         nl80211_add_scan_req(msg, rdev);
14572
14573         genlmsg_end(msg, hdr);
14574         return 0;
14575
14576  nla_put_failure:
14577         genlmsg_cancel(msg, hdr);
14578         return -EMSGSIZE;
14579 }
14580
14581 static int
14582 nl80211_prep_sched_scan_msg(struct sk_buff *msg,
14583                             struct cfg80211_sched_scan_request *req, u32 cmd)
14584 {
14585         void *hdr;
14586
14587         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14588         if (!hdr)
14589                 return -1;
14590
14591         if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
14592                         wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
14593             nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
14594             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
14595                               NL80211_ATTR_PAD))
14596                 goto nla_put_failure;
14597
14598         genlmsg_end(msg, hdr);
14599         return 0;
14600
14601  nla_put_failure:
14602         genlmsg_cancel(msg, hdr);
14603         return -EMSGSIZE;
14604 }
14605
14606 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
14607                              struct wireless_dev *wdev)
14608 {
14609         struct sk_buff *msg;
14610
14611         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14612         if (!msg)
14613                 return;
14614
14615         if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
14616                                   NL80211_CMD_TRIGGER_SCAN) < 0) {
14617                 nlmsg_free(msg);
14618                 return;
14619         }
14620
14621         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14622                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
14623 }
14624
14625 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
14626                                        struct wireless_dev *wdev, bool aborted)
14627 {
14628         struct sk_buff *msg;
14629
14630         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14631         if (!msg)
14632                 return NULL;
14633
14634         if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
14635                                   aborted ? NL80211_CMD_SCAN_ABORTED :
14636                                             NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
14637                 nlmsg_free(msg);
14638                 return NULL;
14639         }
14640
14641         return msg;
14642 }
14643
14644 /* send message created by nl80211_build_scan_msg() */
14645 void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
14646                            struct sk_buff *msg)
14647 {
14648         if (!msg)
14649                 return;
14650
14651         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14652                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
14653 }
14654
14655 void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
14656 {
14657         struct sk_buff *msg;
14658
14659         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14660         if (!msg)
14661                 return;
14662
14663         if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
14664                 nlmsg_free(msg);
14665                 return;
14666         }
14667
14668         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
14669                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
14670 }
14671
14672 static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
14673                                           struct regulatory_request *request)
14674 {
14675         /* Userspace can always count this one always being set */
14676         if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
14677                 goto nla_put_failure;
14678
14679         if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
14680                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
14681                                NL80211_REGDOM_TYPE_WORLD))
14682                         goto nla_put_failure;
14683         } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
14684                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
14685                                NL80211_REGDOM_TYPE_CUSTOM_WORLD))
14686                         goto nla_put_failure;
14687         } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
14688                    request->intersect) {
14689                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
14690                                NL80211_REGDOM_TYPE_INTERSECTION))
14691                         goto nla_put_failure;
14692         } else {
14693                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
14694                                NL80211_REGDOM_TYPE_COUNTRY) ||
14695                     nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
14696                                    request->alpha2))
14697                         goto nla_put_failure;
14698         }
14699
14700         if (request->wiphy_idx != WIPHY_IDX_INVALID) {
14701                 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
14702
14703                 if (wiphy &&
14704                     nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
14705                         goto nla_put_failure;
14706
14707                 if (wiphy &&
14708                     wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
14709                     nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
14710                         goto nla_put_failure;
14711         }
14712
14713         return true;
14714
14715 nla_put_failure:
14716         return false;
14717 }
14718
14719 /*
14720  * This can happen on global regulatory changes or device specific settings
14721  * based on custom regulatory domains.
14722  */
14723 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
14724                                      struct regulatory_request *request)
14725 {
14726         struct sk_buff *msg;
14727         void *hdr;
14728
14729         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14730         if (!msg)
14731                 return;
14732
14733         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
14734         if (!hdr) {
14735                 nlmsg_free(msg);
14736                 return;
14737         }
14738
14739         if (nl80211_reg_change_event_fill(msg, request) == false)
14740                 goto nla_put_failure;
14741
14742         genlmsg_end(msg, hdr);
14743
14744         rcu_read_lock();
14745         genlmsg_multicast_allns(&nl80211_fam, msg, 0,
14746                                 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
14747         rcu_read_unlock();
14748
14749         return;
14750
14751 nla_put_failure:
14752         nlmsg_free(msg);
14753 }
14754
14755 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
14756                                     struct net_device *netdev,
14757                                     const u8 *buf, size_t len,
14758                                     enum nl80211_commands cmd, gfp_t gfp,
14759                                     int uapsd_queues, const u8 *req_ies,
14760                                     size_t req_ies_len)
14761 {
14762         struct sk_buff *msg;
14763         void *hdr;
14764
14765         msg = nlmsg_new(100 + len + req_ies_len, gfp);
14766         if (!msg)
14767                 return;
14768
14769         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14770         if (!hdr) {
14771                 nlmsg_free(msg);
14772                 return;
14773         }
14774
14775         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14776             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14777             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
14778             (req_ies &&
14779              nla_put(msg, NL80211_ATTR_REQ_IE, req_ies_len, req_ies)))
14780                 goto nla_put_failure;
14781
14782         if (uapsd_queues >= 0) {
14783                 struct nlattr *nla_wmm =
14784                         nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME);
14785                 if (!nla_wmm)
14786                         goto nla_put_failure;
14787
14788                 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
14789                                uapsd_queues))
14790                         goto nla_put_failure;
14791
14792                 nla_nest_end(msg, nla_wmm);
14793         }
14794
14795         genlmsg_end(msg, hdr);
14796
14797         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14798                                 NL80211_MCGRP_MLME, gfp);
14799         return;
14800
14801  nla_put_failure:
14802         nlmsg_free(msg);
14803 }
14804
14805 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
14806                           struct net_device *netdev, const u8 *buf,
14807                           size_t len, gfp_t gfp)
14808 {
14809         nl80211_send_mlme_event(rdev, netdev, buf, len,
14810                                 NL80211_CMD_AUTHENTICATE, gfp, -1, NULL, 0);
14811 }
14812
14813 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
14814                            struct net_device *netdev, const u8 *buf,
14815                            size_t len, gfp_t gfp, int uapsd_queues,
14816                            const u8 *req_ies, size_t req_ies_len)
14817 {
14818         nl80211_send_mlme_event(rdev, netdev, buf, len,
14819                                 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues,
14820                                 req_ies, req_ies_len);
14821 }
14822
14823 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
14824                          struct net_device *netdev, const u8 *buf,
14825                          size_t len, gfp_t gfp)
14826 {
14827         nl80211_send_mlme_event(rdev, netdev, buf, len,
14828                                 NL80211_CMD_DEAUTHENTICATE, gfp, -1, NULL, 0);
14829 }
14830
14831 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
14832                            struct net_device *netdev, const u8 *buf,
14833                            size_t len, gfp_t gfp)
14834 {
14835         nl80211_send_mlme_event(rdev, netdev, buf, len,
14836                                 NL80211_CMD_DISASSOCIATE, gfp, -1, NULL, 0);
14837 }
14838
14839 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
14840                                   size_t len)
14841 {
14842         struct wireless_dev *wdev = dev->ieee80211_ptr;
14843         struct wiphy *wiphy = wdev->wiphy;
14844         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14845         const struct ieee80211_mgmt *mgmt = (void *)buf;
14846         u32 cmd;
14847
14848         if (WARN_ON(len < 2))
14849                 return;
14850
14851         if (ieee80211_is_deauth(mgmt->frame_control))
14852                 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
14853         else
14854                 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
14855
14856         trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
14857         nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1,
14858                                 NULL, 0);
14859 }
14860 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
14861
14862 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
14863                                       struct net_device *netdev, int cmd,
14864                                       const u8 *addr, gfp_t gfp)
14865 {
14866         struct sk_buff *msg;
14867         void *hdr;
14868
14869         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14870         if (!msg)
14871                 return;
14872
14873         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
14874         if (!hdr) {
14875                 nlmsg_free(msg);
14876                 return;
14877         }
14878
14879         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14880             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14881             nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
14882             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
14883                 goto nla_put_failure;
14884
14885         genlmsg_end(msg, hdr);
14886
14887         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14888                                 NL80211_MCGRP_MLME, gfp);
14889         return;
14890
14891  nla_put_failure:
14892         nlmsg_free(msg);
14893 }
14894
14895 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
14896                                struct net_device *netdev, const u8 *addr,
14897                                gfp_t gfp)
14898 {
14899         nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
14900                                   addr, gfp);
14901 }
14902
14903 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
14904                                 struct net_device *netdev, const u8 *addr,
14905                                 gfp_t gfp)
14906 {
14907         nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
14908                                   addr, gfp);
14909 }
14910
14911 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
14912                                  struct net_device *netdev,
14913                                  struct cfg80211_connect_resp_params *cr,
14914                                  gfp_t gfp)
14915 {
14916         struct sk_buff *msg;
14917         void *hdr;
14918
14919         msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
14920                         cr->fils.kek_len + cr->fils.pmk_len +
14921                         (cr->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
14922         if (!msg)
14923                 return;
14924
14925         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
14926         if (!hdr) {
14927                 nlmsg_free(msg);
14928                 return;
14929         }
14930
14931         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14932             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14933             (cr->bssid &&
14934              nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
14935             nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
14936                         cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
14937                         cr->status) ||
14938             (cr->status < 0 &&
14939              (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
14940               nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
14941                           cr->timeout_reason))) ||
14942             (cr->req_ie &&
14943              nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
14944             (cr->resp_ie &&
14945              nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
14946                      cr->resp_ie)) ||
14947             (cr->fils.update_erp_next_seq_num &&
14948              nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
14949                          cr->fils.erp_next_seq_num)) ||
14950             (cr->status == WLAN_STATUS_SUCCESS &&
14951              ((cr->fils.kek &&
14952                nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
14953                        cr->fils.kek)) ||
14954               (cr->fils.pmk &&
14955                nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
14956               (cr->fils.pmkid &&
14957                nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
14958                 goto nla_put_failure;
14959
14960         genlmsg_end(msg, hdr);
14961
14962         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14963                                 NL80211_MCGRP_MLME, gfp);
14964         return;
14965
14966  nla_put_failure:
14967         nlmsg_free(msg);
14968 }
14969
14970 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
14971                          struct net_device *netdev,
14972                          struct cfg80211_roam_info *info, gfp_t gfp)
14973 {
14974         struct sk_buff *msg;
14975         void *hdr;
14976         const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
14977
14978         msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
14979                         info->fils.kek_len + info->fils.pmk_len +
14980                         (info->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
14981         if (!msg)
14982                 return;
14983
14984         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
14985         if (!hdr) {
14986                 nlmsg_free(msg);
14987                 return;
14988         }
14989
14990         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14991             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14992             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
14993             (info->req_ie &&
14994              nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
14995                      info->req_ie)) ||
14996             (info->resp_ie &&
14997              nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
14998                      info->resp_ie)) ||
14999             (info->fils.update_erp_next_seq_num &&
15000              nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
15001                          info->fils.erp_next_seq_num)) ||
15002             (info->fils.kek &&
15003              nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
15004                      info->fils.kek)) ||
15005             (info->fils.pmk &&
15006              nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
15007             (info->fils.pmkid &&
15008              nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
15009                 goto nla_put_failure;
15010
15011         genlmsg_end(msg, hdr);
15012
15013         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15014                                 NL80211_MCGRP_MLME, gfp);
15015         return;
15016
15017  nla_put_failure:
15018         nlmsg_free(msg);
15019 }
15020
15021 void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
15022                                   struct net_device *netdev, const u8 *bssid)
15023 {
15024         struct sk_buff *msg;
15025         void *hdr;
15026
15027         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
15028         if (!msg)
15029                 return;
15030
15031         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
15032         if (!hdr) {
15033                 nlmsg_free(msg);
15034                 return;
15035         }
15036
15037         if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
15038                 goto nla_put_failure;
15039
15040         genlmsg_end(msg, hdr);
15041
15042         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15043                                 NL80211_MCGRP_MLME, GFP_KERNEL);
15044         return;
15045
15046  nla_put_failure:
15047         nlmsg_free(msg);
15048 }
15049
15050 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
15051                                struct net_device *netdev, u16 reason,
15052                                const u8 *ie, size_t ie_len, bool from_ap)
15053 {
15054         struct sk_buff *msg;
15055         void *hdr;
15056
15057         msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
15058         if (!msg)
15059                 return;
15060
15061         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
15062         if (!hdr) {
15063                 nlmsg_free(msg);
15064                 return;
15065         }
15066
15067         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15068             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15069             (reason &&
15070              nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
15071             (from_ap &&
15072              nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
15073             (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
15074                 goto nla_put_failure;
15075
15076         genlmsg_end(msg, hdr);
15077
15078         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15079                                 NL80211_MCGRP_MLME, GFP_KERNEL);
15080         return;
15081
15082  nla_put_failure:
15083         nlmsg_free(msg);
15084 }
15085
15086 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
15087                              struct net_device *netdev, const u8 *bssid,
15088                              gfp_t gfp)
15089 {
15090         struct sk_buff *msg;
15091         void *hdr;
15092
15093         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15094         if (!msg)
15095                 return;
15096
15097         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
15098         if (!hdr) {
15099                 nlmsg_free(msg);
15100                 return;
15101         }
15102
15103         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15104             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15105             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
15106                 goto nla_put_failure;
15107
15108         genlmsg_end(msg, hdr);
15109
15110         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15111                                 NL80211_MCGRP_MLME, gfp);
15112         return;
15113
15114  nla_put_failure:
15115         nlmsg_free(msg);
15116 }
15117
15118 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
15119                                         const u8 *ie, u8 ie_len,
15120                                         int sig_dbm, gfp_t gfp)
15121 {
15122         struct wireless_dev *wdev = dev->ieee80211_ptr;
15123         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15124         struct sk_buff *msg;
15125         void *hdr;
15126
15127         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
15128                 return;
15129
15130         trace_cfg80211_notify_new_peer_candidate(dev, addr);
15131
15132         msg = nlmsg_new(100 + ie_len, gfp);
15133         if (!msg)
15134                 return;
15135
15136         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
15137         if (!hdr) {
15138                 nlmsg_free(msg);
15139                 return;
15140         }
15141
15142         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15143             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15144             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
15145             (ie_len && ie &&
15146              nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) ||
15147             (sig_dbm &&
15148              nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)))
15149                 goto nla_put_failure;
15150
15151         genlmsg_end(msg, hdr);
15152
15153         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15154                                 NL80211_MCGRP_MLME, gfp);
15155         return;
15156
15157  nla_put_failure:
15158         nlmsg_free(msg);
15159 }
15160 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
15161
15162 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
15163                                  struct net_device *netdev, const u8 *addr,
15164                                  enum nl80211_key_type key_type, int key_id,
15165                                  const u8 *tsc, gfp_t gfp)
15166 {
15167         struct sk_buff *msg;
15168         void *hdr;
15169
15170         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15171         if (!msg)
15172                 return;
15173
15174         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
15175         if (!hdr) {
15176                 nlmsg_free(msg);
15177                 return;
15178         }
15179
15180         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15181             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15182             (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
15183             nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
15184             (key_id != -1 &&
15185              nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
15186             (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
15187                 goto nla_put_failure;
15188
15189         genlmsg_end(msg, hdr);
15190
15191         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15192                                 NL80211_MCGRP_MLME, gfp);
15193         return;
15194
15195  nla_put_failure:
15196         nlmsg_free(msg);
15197 }
15198
15199 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
15200                                     struct ieee80211_channel *channel_before,
15201                                     struct ieee80211_channel *channel_after)
15202 {
15203         struct sk_buff *msg;
15204         void *hdr;
15205         struct nlattr *nl_freq;
15206
15207         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
15208         if (!msg)
15209                 return;
15210
15211         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
15212         if (!hdr) {
15213                 nlmsg_free(msg);
15214                 return;
15215         }
15216
15217         /*
15218          * Since we are applying the beacon hint to a wiphy we know its
15219          * wiphy_idx is valid
15220          */
15221         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
15222                 goto nla_put_failure;
15223
15224         /* Before */
15225         nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE);
15226         if (!nl_freq)
15227                 goto nla_put_failure;
15228
15229         if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
15230                 goto nla_put_failure;
15231         nla_nest_end(msg, nl_freq);
15232
15233         /* After */
15234         nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER);
15235         if (!nl_freq)
15236                 goto nla_put_failure;
15237
15238         if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
15239                 goto nla_put_failure;
15240         nla_nest_end(msg, nl_freq);
15241
15242         genlmsg_end(msg, hdr);
15243
15244         rcu_read_lock();
15245         genlmsg_multicast_allns(&nl80211_fam, msg, 0,
15246                                 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
15247         rcu_read_unlock();
15248
15249         return;
15250
15251 nla_put_failure:
15252         nlmsg_free(msg);
15253 }
15254
15255 static void nl80211_send_remain_on_chan_event(
15256         int cmd, struct cfg80211_registered_device *rdev,
15257         struct wireless_dev *wdev, u64 cookie,
15258         struct ieee80211_channel *chan,
15259         unsigned int duration, gfp_t gfp)
15260 {
15261         struct sk_buff *msg;
15262         void *hdr;
15263
15264         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15265         if (!msg)
15266                 return;
15267
15268         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15269         if (!hdr) {
15270                 nlmsg_free(msg);
15271                 return;
15272         }
15273
15274         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15275             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15276                                          wdev->netdev->ifindex)) ||
15277             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15278                               NL80211_ATTR_PAD) ||
15279             nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
15280             nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
15281                         NL80211_CHAN_NO_HT) ||
15282             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
15283                               NL80211_ATTR_PAD))
15284                 goto nla_put_failure;
15285
15286         if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
15287             nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
15288                 goto nla_put_failure;
15289
15290         genlmsg_end(msg, hdr);
15291
15292         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15293                                 NL80211_MCGRP_MLME, gfp);
15294         return;
15295
15296  nla_put_failure:
15297         nlmsg_free(msg);
15298 }
15299
15300 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
15301                                struct ieee80211_channel *chan,
15302                                unsigned int duration, gfp_t gfp)
15303 {
15304         struct wiphy *wiphy = wdev->wiphy;
15305         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15306
15307         trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
15308         nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
15309                                           rdev, wdev, cookie, chan,
15310                                           duration, gfp);
15311 }
15312 EXPORT_SYMBOL(cfg80211_ready_on_channel);
15313
15314 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
15315                                         struct ieee80211_channel *chan,
15316                                         gfp_t gfp)
15317 {
15318         struct wiphy *wiphy = wdev->wiphy;
15319         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15320
15321         trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
15322         nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
15323                                           rdev, wdev, cookie, chan, 0, gfp);
15324 }
15325 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
15326
15327 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
15328                       struct station_info *sinfo, gfp_t gfp)
15329 {
15330         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15331         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15332         struct sk_buff *msg;
15333
15334         trace_cfg80211_new_sta(dev, mac_addr, sinfo);
15335
15336         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15337         if (!msg)
15338                 return;
15339
15340         if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
15341                                  rdev, dev, mac_addr, sinfo) < 0) {
15342                 nlmsg_free(msg);
15343                 return;
15344         }
15345
15346         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15347                                 NL80211_MCGRP_MLME, gfp);
15348 }
15349 EXPORT_SYMBOL(cfg80211_new_sta);
15350
15351 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
15352                             struct station_info *sinfo, gfp_t gfp)
15353 {
15354         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15355         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15356         struct sk_buff *msg;
15357         struct station_info empty_sinfo = {};
15358
15359         if (!sinfo)
15360                 sinfo = &empty_sinfo;
15361
15362         trace_cfg80211_del_sta(dev, mac_addr);
15363
15364         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15365         if (!msg) {
15366                 cfg80211_sinfo_release_content(sinfo);
15367                 return;
15368         }
15369
15370         if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
15371                                  rdev, dev, mac_addr, sinfo) < 0) {
15372                 nlmsg_free(msg);
15373                 return;
15374         }
15375
15376         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15377                                 NL80211_MCGRP_MLME, gfp);
15378 }
15379 EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
15380
15381 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
15382                           enum nl80211_connect_failed_reason reason,
15383                           gfp_t gfp)
15384 {
15385         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
15386         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15387         struct sk_buff *msg;
15388         void *hdr;
15389
15390         msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
15391         if (!msg)
15392                 return;
15393
15394         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
15395         if (!hdr) {
15396                 nlmsg_free(msg);
15397                 return;
15398         }
15399
15400         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15401             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
15402             nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
15403                 goto nla_put_failure;
15404
15405         genlmsg_end(msg, hdr);
15406
15407         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15408                                 NL80211_MCGRP_MLME, gfp);
15409         return;
15410
15411  nla_put_failure:
15412         nlmsg_free(msg);
15413 }
15414 EXPORT_SYMBOL(cfg80211_conn_failed);
15415
15416 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
15417                                        const u8 *addr, gfp_t gfp)
15418 {
15419         struct wireless_dev *wdev = dev->ieee80211_ptr;
15420         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15421         struct sk_buff *msg;
15422         void *hdr;
15423         u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
15424
15425         if (!nlportid)
15426                 return false;
15427
15428         msg = nlmsg_new(100, gfp);
15429         if (!msg)
15430                 return true;
15431
15432         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
15433         if (!hdr) {
15434                 nlmsg_free(msg);
15435                 return true;
15436         }
15437
15438         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15439             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15440             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
15441                 goto nla_put_failure;
15442
15443         genlmsg_end(msg, hdr);
15444         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15445         return true;
15446
15447  nla_put_failure:
15448         nlmsg_free(msg);
15449         return true;
15450 }
15451
15452 bool cfg80211_rx_spurious_frame(struct net_device *dev,
15453                                 const u8 *addr, gfp_t gfp)
15454 {
15455         struct wireless_dev *wdev = dev->ieee80211_ptr;
15456         bool ret;
15457
15458         trace_cfg80211_rx_spurious_frame(dev, addr);
15459
15460         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
15461                     wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
15462                 trace_cfg80211_return_bool(false);
15463                 return false;
15464         }
15465         ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
15466                                          addr, gfp);
15467         trace_cfg80211_return_bool(ret);
15468         return ret;
15469 }
15470 EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
15471
15472 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
15473                                         const u8 *addr, gfp_t gfp)
15474 {
15475         struct wireless_dev *wdev = dev->ieee80211_ptr;
15476         bool ret;
15477
15478         trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
15479
15480         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
15481                     wdev->iftype != NL80211_IFTYPE_P2P_GO &&
15482                     wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
15483                 trace_cfg80211_return_bool(false);
15484                 return false;
15485         }
15486         ret = __nl80211_unexpected_frame(dev,
15487                                          NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
15488                                          addr, gfp);
15489         trace_cfg80211_return_bool(ret);
15490         return ret;
15491 }
15492 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
15493
15494 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
15495                       struct wireless_dev *wdev, u32 nlportid,
15496                       int freq, int sig_dbm,
15497                       const u8 *buf, size_t len, u32 flags, gfp_t gfp)
15498 {
15499         struct net_device *netdev = wdev->netdev;
15500         struct sk_buff *msg;
15501         void *hdr;
15502
15503         msg = nlmsg_new(100 + len, gfp);
15504         if (!msg)
15505                 return -ENOMEM;
15506
15507         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
15508         if (!hdr) {
15509                 nlmsg_free(msg);
15510                 return -ENOMEM;
15511         }
15512
15513         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15514             (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15515                                         netdev->ifindex)) ||
15516             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15517                               NL80211_ATTR_PAD) ||
15518             nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
15519             (sig_dbm &&
15520              nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
15521             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15522             (flags &&
15523              nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
15524                 goto nla_put_failure;
15525
15526         genlmsg_end(msg, hdr);
15527
15528         return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15529
15530  nla_put_failure:
15531         nlmsg_free(msg);
15532         return -ENOBUFS;
15533 }
15534
15535 void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
15536                              const u8 *buf, size_t len, bool ack, gfp_t gfp)
15537 {
15538         struct wiphy *wiphy = wdev->wiphy;
15539         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15540         struct net_device *netdev = wdev->netdev;
15541         struct sk_buff *msg;
15542         void *hdr;
15543
15544         trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
15545
15546         msg = nlmsg_new(100 + len, gfp);
15547         if (!msg)
15548                 return;
15549
15550         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
15551         if (!hdr) {
15552                 nlmsg_free(msg);
15553                 return;
15554         }
15555
15556         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15557             (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
15558                                    netdev->ifindex)) ||
15559             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15560                               NL80211_ATTR_PAD) ||
15561             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
15562             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
15563                               NL80211_ATTR_PAD) ||
15564             (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
15565                 goto nla_put_failure;
15566
15567         genlmsg_end(msg, hdr);
15568
15569         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15570                                 NL80211_MCGRP_MLME, gfp);
15571         return;
15572
15573  nla_put_failure:
15574         nlmsg_free(msg);
15575 }
15576 EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
15577
15578 static int __nl80211_rx_control_port(struct net_device *dev,
15579                                      struct sk_buff *skb,
15580                                      bool unencrypted, gfp_t gfp)
15581 {
15582         struct wireless_dev *wdev = dev->ieee80211_ptr;
15583         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15584         struct ethhdr *ehdr = eth_hdr(skb);
15585         const u8 *addr = ehdr->h_source;
15586         u16 proto = be16_to_cpu(skb->protocol);
15587         struct sk_buff *msg;
15588         void *hdr;
15589         struct nlattr *frame;
15590
15591         u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);
15592
15593         if (!nlportid)
15594                 return -ENOENT;
15595
15596         msg = nlmsg_new(100 + skb->len, gfp);
15597         if (!msg)
15598                 return -ENOMEM;
15599
15600         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
15601         if (!hdr) {
15602                 nlmsg_free(msg);
15603                 return -ENOBUFS;
15604         }
15605
15606         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15607             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
15608             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
15609                               NL80211_ATTR_PAD) ||
15610             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
15611             nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
15612             (unencrypted && nla_put_flag(msg,
15613                                          NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
15614                 goto nla_put_failure;
15615
15616         frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len);
15617         if (!frame)
15618                 goto nla_put_failure;
15619
15620         skb_copy_bits(skb, 0, nla_data(frame), skb->len);
15621         genlmsg_end(msg, hdr);
15622
15623         return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
15624
15625  nla_put_failure:
15626         nlmsg_free(msg);
15627         return -ENOBUFS;
15628 }
15629
15630 bool cfg80211_rx_control_port(struct net_device *dev,
15631                               struct sk_buff *skb, bool unencrypted)
15632 {
15633         int ret;
15634
15635         trace_cfg80211_rx_control_port(dev, skb, unencrypted);
15636         ret = __nl80211_rx_control_port(dev, skb, unencrypted, GFP_ATOMIC);
15637         trace_cfg80211_return_bool(ret == 0);
15638         return ret == 0;
15639 }
15640 EXPORT_SYMBOL(cfg80211_rx_control_port);
15641
15642 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
15643                                             const char *mac, gfp_t gfp)
15644 {
15645         struct wireless_dev *wdev = dev->ieee80211_ptr;
15646         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15647         struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15648         void **cb;
15649
15650         if (!msg)
15651                 return NULL;
15652
15653         cb = (void **)msg->cb;
15654
15655         cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
15656         if (!cb[0]) {
15657                 nlmsg_free(msg);
15658                 return NULL;
15659         }
15660
15661         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15662             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
15663                 goto nla_put_failure;
15664
15665         if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
15666                 goto nla_put_failure;
15667
15668         cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM);
15669         if (!cb[1])
15670                 goto nla_put_failure;
15671
15672         cb[2] = rdev;
15673
15674         return msg;
15675  nla_put_failure:
15676         nlmsg_free(msg);
15677         return NULL;
15678 }
15679
15680 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
15681 {
15682         void **cb = (void **)msg->cb;
15683         struct cfg80211_registered_device *rdev = cb[2];
15684
15685         nla_nest_end(msg, cb[1]);
15686         genlmsg_end(msg, cb[0]);
15687
15688         memset(msg->cb, 0, sizeof(msg->cb));
15689
15690         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15691                                 NL80211_MCGRP_MLME, gfp);
15692 }
15693
15694 void cfg80211_cqm_rssi_notify(struct net_device *dev,
15695                               enum nl80211_cqm_rssi_threshold_event rssi_event,
15696                               s32 rssi_level, gfp_t gfp)
15697 {
15698         struct sk_buff *msg;
15699         struct wireless_dev *wdev = dev->ieee80211_ptr;
15700         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
15701
15702         trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
15703
15704         if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
15705                     rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
15706                 return;
15707
15708         if (wdev->cqm_config) {
15709                 wdev->cqm_config->last_rssi_event_value = rssi_level;
15710
15711                 cfg80211_cqm_rssi_update(rdev, dev);
15712
15713                 if (rssi_level == 0)
15714                         rssi_level = wdev->cqm_config->last_rssi_event_value;
15715         }
15716
15717         msg = cfg80211_prepare_cqm(dev, NULL, gfp);
15718         if (!msg)
15719                 return;
15720
15721         if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
15722                         rssi_event))
15723                 goto nla_put_failure;
15724
15725         if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
15726                                       rssi_level))
15727                 goto nla_put_failure;
15728
15729         cfg80211_send_cqm(msg, gfp);
15730
15731         return;
15732
15733  nla_put_failure:
15734         nlmsg_free(msg);
15735 }
15736 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
15737
15738 void cfg80211_cqm_txe_notify(struct net_device *dev,
15739                              const u8 *peer, u32 num_packets,
15740                              u32 rate, u32 intvl, gfp_t gfp)
15741 {
15742         struct sk_buff *msg;
15743
15744         msg = cfg80211_prepare_cqm(dev, peer, gfp);
15745         if (!msg)
15746                 return;
15747
15748         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
15749                 goto nla_put_failure;
15750
15751         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
15752                 goto nla_put_failure;
15753
15754         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
15755                 goto nla_put_failure;
15756
15757         cfg80211_send_cqm(msg, gfp);
15758         return;
15759
15760  nla_put_failure:
15761         nlmsg_free(msg);
15762 }
15763 EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
15764
15765 void cfg80211_cqm_pktloss_notify(struct net_device *dev,
15766                                  const u8 *peer, u32 num_packets, gfp_t gfp)
15767 {
15768         struct sk_buff *msg;
15769
15770         trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
15771
15772         msg = cfg80211_prepare_cqm(dev, peer, gfp);
15773         if (!msg)
15774                 return;
15775
15776         if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
15777                 goto nla_put_failure;
15778
15779         cfg80211_send_cqm(msg, gfp);
15780         return;
15781
15782  nla_put_failure:
15783         nlmsg_free(msg);
15784 }
15785 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
15786
15787 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
15788 {
15789         struct sk_buff *msg;
15790
15791         msg = cfg80211_prepare_cqm(dev, NULL, gfp);
15792         if (!msg)
15793                 return;
15794
15795         if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
15796                 goto nla_put_failure;
15797
15798         cfg80211_send_cqm(msg, gfp);
15799         return;
15800
15801  nla_put_failure:
15802         nlmsg_free(msg);
15803 }
15804 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
15805
15806 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
15807                                      struct net_device *netdev, const u8 *bssid,
15808                                      const u8 *replay_ctr, gfp_t gfp)
15809 {
15810         struct sk_buff *msg;
15811         struct nlattr *rekey_attr;
15812         void *hdr;
15813
15814         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15815         if (!msg)
15816                 return;
15817
15818         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
15819         if (!hdr) {
15820                 nlmsg_free(msg);
15821                 return;
15822         }
15823
15824         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15825             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
15826             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
15827                 goto nla_put_failure;
15828
15829         rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA);
15830         if (!rekey_attr)
15831                 goto nla_put_failure;
15832
15833         if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
15834                     NL80211_REPLAY_CTR_LEN, replay_ctr))
15835                 goto nla_put_failure;
15836
15837         nla_nest_end(msg, rekey_attr);
15838
15839         genlmsg_end(msg, hdr);
15840
15841         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15842                                 NL80211_MCGRP_MLME, gfp);
15843         return;
15844
15845  nla_put_failure:
15846         nlmsg_free(msg);
15847 }
15848
15849 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
15850                                const u8 *replay_ctr, gfp_t gfp)
15851 {
15852         struct wireless_dev *wdev = dev->ieee80211_ptr;
15853         struct wiphy *wiphy = wdev->wiphy;
15854         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15855
15856         trace_cfg80211_gtk_rekey_notify(dev, bssid);
15857         nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
15858 }
15859 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
15860
15861 static void
15862 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
15863                                struct net_device *netdev, int index,
15864                                const u8 *bssid, bool preauth, gfp_t gfp)
15865 {
15866         struct sk_buff *msg;
15867         struct nlattr *attr;
15868         void *hdr;
15869
15870         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15871         if (!msg)
15872                 return;
15873
15874         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
15875         if (!hdr) {
15876                 nlmsg_free(msg);
15877                 return;
15878         }
15879
15880         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
15881             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
15882                 goto nla_put_failure;
15883
15884         attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE);
15885         if (!attr)
15886                 goto nla_put_failure;
15887
15888         if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
15889             nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
15890             (preauth &&
15891              nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
15892                 goto nla_put_failure;
15893
15894         nla_nest_end(msg, attr);
15895
15896         genlmsg_end(msg, hdr);
15897
15898         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15899                                 NL80211_MCGRP_MLME, gfp);
15900         return;
15901
15902  nla_put_failure:
15903         nlmsg_free(msg);
15904 }
15905
15906 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
15907                                      const u8 *bssid, bool preauth, gfp_t gfp)
15908 {
15909         struct wireless_dev *wdev = dev->ieee80211_ptr;
15910         struct wiphy *wiphy = wdev->wiphy;
15911         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15912
15913         trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
15914         nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
15915 }
15916 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
15917
15918 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
15919                                      struct net_device *netdev,
15920                                      struct cfg80211_chan_def *chandef,
15921                                      gfp_t gfp,
15922                                      enum nl80211_commands notif,
15923                                      u8 count)
15924 {
15925         struct sk_buff *msg;
15926         void *hdr;
15927
15928         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
15929         if (!msg)
15930                 return;
15931
15932         hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
15933         if (!hdr) {
15934                 nlmsg_free(msg);
15935                 return;
15936         }
15937
15938         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
15939                 goto nla_put_failure;
15940
15941         if (nl80211_send_chandef(msg, chandef))
15942                 goto nla_put_failure;
15943
15944         if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
15945             (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
15946                         goto nla_put_failure;
15947
15948         genlmsg_end(msg, hdr);
15949
15950         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
15951                                 NL80211_MCGRP_MLME, gfp);
15952         return;
15953
15954  nla_put_failure:
15955         nlmsg_free(msg);
15956 }
15957
15958 void cfg80211_ch_switch_notify(struct net_device *dev,
15959                                struct cfg80211_chan_def *chandef)
15960 {
15961         struct wireless_dev *wdev = dev->ieee80211_ptr;
15962         struct wiphy *wiphy = wdev->wiphy;
15963         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15964
15965         ASSERT_WDEV_LOCK(wdev);
15966
15967         trace_cfg80211_ch_switch_notify(dev, chandef);
15968
15969         wdev->chandef = *chandef;
15970         wdev->preset_chandef = *chandef;
15971
15972         if (wdev->iftype == NL80211_IFTYPE_STATION &&
15973             !WARN_ON(!wdev->current_bss))
15974                 wdev->current_bss->pub.channel = chandef->chan;
15975
15976         nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
15977                                  NL80211_CMD_CH_SWITCH_NOTIFY, 0);
15978 }
15979 EXPORT_SYMBOL(cfg80211_ch_switch_notify);
15980
15981 void cfg80211_ch_switch_started_notify(struct net_device *dev,
15982                                        struct cfg80211_chan_def *chandef,
15983                                        u8 count)
15984 {
15985         struct wireless_dev *wdev = dev->ieee80211_ptr;
15986         struct wiphy *wiphy = wdev->wiphy;
15987         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
15988
15989         trace_cfg80211_ch_switch_started_notify(dev, chandef);
15990
15991         nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
15992                                  NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
15993 }
15994 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
15995
15996 void
15997 nl80211_radar_notify(struct cfg80211_registered_device *rdev,
15998                      const struct cfg80211_chan_def *chandef,
15999                      enum nl80211_radar_event event,
16000                      struct net_device *netdev, gfp_t gfp)
16001 {
16002         struct sk_buff *msg;
16003         void *hdr;
16004
16005         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16006         if (!msg)
16007                 return;
16008
16009         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
16010         if (!hdr) {
16011                 nlmsg_free(msg);
16012                 return;
16013         }
16014
16015         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
16016                 goto nla_put_failure;
16017
16018         /* NOP and radar events don't need a netdev parameter */
16019         if (netdev) {
16020                 struct wireless_dev *wdev = netdev->ieee80211_ptr;
16021
16022                 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16023                     nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16024                                       NL80211_ATTR_PAD))
16025                         goto nla_put_failure;
16026         }
16027
16028         if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
16029                 goto nla_put_failure;
16030
16031         if (nl80211_send_chandef(msg, chandef))
16032                 goto nla_put_failure;
16033
16034         genlmsg_end(msg, hdr);
16035
16036         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16037                                 NL80211_MCGRP_MLME, gfp);
16038         return;
16039
16040  nla_put_failure:
16041         nlmsg_free(msg);
16042 }
16043
16044 void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
16045                                        struct sta_opmode_info *sta_opmode,
16046                                        gfp_t gfp)
16047 {
16048         struct sk_buff *msg;
16049         struct wireless_dev *wdev = dev->ieee80211_ptr;
16050         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16051         void *hdr;
16052
16053         if (WARN_ON(!mac))
16054                 return;
16055
16056         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16057         if (!msg)
16058                 return;
16059
16060         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
16061         if (!hdr) {
16062                 nlmsg_free(msg);
16063                 return;
16064         }
16065
16066         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
16067                 goto nla_put_failure;
16068
16069         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
16070                 goto nla_put_failure;
16071
16072         if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
16073                 goto nla_put_failure;
16074
16075         if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
16076             nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
16077                 goto nla_put_failure;
16078
16079         if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
16080             nla_put_u8(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
16081                 goto nla_put_failure;
16082
16083         if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
16084             nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
16085                 goto nla_put_failure;
16086
16087         genlmsg_end(msg, hdr);
16088
16089         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16090                                 NL80211_MCGRP_MLME, gfp);
16091
16092         return;
16093
16094 nla_put_failure:
16095         nlmsg_free(msg);
16096 }
16097 EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);
16098
16099 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
16100                            u64 cookie, bool acked, s32 ack_signal,
16101                            bool is_valid_ack_signal, gfp_t gfp)
16102 {
16103         struct wireless_dev *wdev = dev->ieee80211_ptr;
16104         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16105         struct sk_buff *msg;
16106         void *hdr;
16107
16108         trace_cfg80211_probe_status(dev, addr, cookie, acked);
16109
16110         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16111
16112         if (!msg)
16113                 return;
16114
16115         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
16116         if (!hdr) {
16117                 nlmsg_free(msg);
16118                 return;
16119         }
16120
16121         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16122             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16123             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
16124             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
16125                               NL80211_ATTR_PAD) ||
16126             (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
16127             (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
16128                                                 ack_signal)))
16129                 goto nla_put_failure;
16130
16131         genlmsg_end(msg, hdr);
16132
16133         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16134                                 NL80211_MCGRP_MLME, gfp);
16135         return;
16136
16137  nla_put_failure:
16138         nlmsg_free(msg);
16139 }
16140 EXPORT_SYMBOL(cfg80211_probe_status);
16141
16142 void cfg80211_report_obss_beacon(struct wiphy *wiphy,
16143                                  const u8 *frame, size_t len,
16144                                  int freq, int sig_dbm)
16145 {
16146         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16147         struct sk_buff *msg;
16148         void *hdr;
16149         struct cfg80211_beacon_registration *reg;
16150
16151         trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
16152
16153         spin_lock_bh(&rdev->beacon_registrations_lock);
16154         list_for_each_entry(reg, &rdev->beacon_registrations, list) {
16155                 msg = nlmsg_new(len + 100, GFP_ATOMIC);
16156                 if (!msg) {
16157                         spin_unlock_bh(&rdev->beacon_registrations_lock);
16158                         return;
16159                 }
16160
16161                 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
16162                 if (!hdr)
16163                         goto nla_put_failure;
16164
16165                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16166                     (freq &&
16167                      nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
16168                     (sig_dbm &&
16169                      nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
16170                     nla_put(msg, NL80211_ATTR_FRAME, len, frame))
16171                         goto nla_put_failure;
16172
16173                 genlmsg_end(msg, hdr);
16174
16175                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
16176         }
16177         spin_unlock_bh(&rdev->beacon_registrations_lock);
16178         return;
16179
16180  nla_put_failure:
16181         spin_unlock_bh(&rdev->beacon_registrations_lock);
16182         nlmsg_free(msg);
16183 }
16184 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
16185
16186 #ifdef CONFIG_PM
16187 static int cfg80211_net_detect_results(struct sk_buff *msg,
16188                                        struct cfg80211_wowlan_wakeup *wakeup)
16189 {
16190         struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
16191         struct nlattr *nl_results, *nl_match, *nl_freqs;
16192         int i, j;
16193
16194         nl_results = nla_nest_start_noflag(msg,
16195                                            NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
16196         if (!nl_results)
16197                 return -EMSGSIZE;
16198
16199         for (i = 0; i < nd->n_matches; i++) {
16200                 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
16201
16202                 nl_match = nla_nest_start_noflag(msg, i);
16203                 if (!nl_match)
16204                         break;
16205
16206                 /* The SSID attribute is optional in nl80211, but for
16207                  * simplicity reasons it's always present in the
16208                  * cfg80211 structure.  If a driver can't pass the
16209                  * SSID, that needs to be changed.  A zero length SSID
16210                  * is still a valid SSID (wildcard), so it cannot be
16211                  * used for this purpose.
16212                  */
16213                 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
16214                             match->ssid.ssid)) {
16215                         nla_nest_cancel(msg, nl_match);
16216                         goto out;
16217                 }
16218
16219                 if (match->n_channels) {
16220                         nl_freqs = nla_nest_start_noflag(msg,
16221                                                          NL80211_ATTR_SCAN_FREQUENCIES);
16222                         if (!nl_freqs) {
16223                                 nla_nest_cancel(msg, nl_match);
16224                                 goto out;
16225                         }
16226
16227                         for (j = 0; j < match->n_channels; j++) {
16228                                 if (nla_put_u32(msg, j, match->channels[j])) {
16229                                         nla_nest_cancel(msg, nl_freqs);
16230                                         nla_nest_cancel(msg, nl_match);
16231                                         goto out;
16232                                 }
16233                         }
16234
16235                         nla_nest_end(msg, nl_freqs);
16236                 }
16237
16238                 nla_nest_end(msg, nl_match);
16239         }
16240
16241 out:
16242         nla_nest_end(msg, nl_results);
16243         return 0;
16244 }
16245
16246 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
16247                                    struct cfg80211_wowlan_wakeup *wakeup,
16248                                    gfp_t gfp)
16249 {
16250         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16251         struct sk_buff *msg;
16252         void *hdr;
16253         int size = 200;
16254
16255         trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
16256
16257         if (wakeup)
16258                 size += wakeup->packet_present_len;
16259
16260         msg = nlmsg_new(size, gfp);
16261         if (!msg)
16262                 return;
16263
16264         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
16265         if (!hdr)
16266                 goto free_msg;
16267
16268         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16269             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16270                               NL80211_ATTR_PAD))
16271                 goto free_msg;
16272
16273         if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
16274                                         wdev->netdev->ifindex))
16275                 goto free_msg;
16276
16277         if (wakeup) {
16278                 struct nlattr *reasons;
16279
16280                 reasons = nla_nest_start_noflag(msg,
16281                                                 NL80211_ATTR_WOWLAN_TRIGGERS);
16282                 if (!reasons)
16283                         goto free_msg;
16284
16285                 if (wakeup->disconnect &&
16286                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
16287                         goto free_msg;
16288                 if (wakeup->magic_pkt &&
16289                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
16290                         goto free_msg;
16291                 if (wakeup->gtk_rekey_failure &&
16292                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
16293                         goto free_msg;
16294                 if (wakeup->eap_identity_req &&
16295                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
16296                         goto free_msg;
16297                 if (wakeup->four_way_handshake &&
16298                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
16299                         goto free_msg;
16300                 if (wakeup->rfkill_release &&
16301                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
16302                         goto free_msg;
16303
16304                 if (wakeup->pattern_idx >= 0 &&
16305                     nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
16306                                 wakeup->pattern_idx))
16307                         goto free_msg;
16308
16309                 if (wakeup->tcp_match &&
16310                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
16311                         goto free_msg;
16312
16313                 if (wakeup->tcp_connlost &&
16314                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
16315                         goto free_msg;
16316
16317                 if (wakeup->tcp_nomoretokens &&
16318                     nla_put_flag(msg,
16319                                  NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
16320                         goto free_msg;
16321
16322                 if (wakeup->packet) {
16323                         u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
16324                         u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
16325
16326                         if (!wakeup->packet_80211) {
16327                                 pkt_attr =
16328                                         NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
16329                                 len_attr =
16330                                         NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
16331                         }
16332
16333                         if (wakeup->packet_len &&
16334                             nla_put_u32(msg, len_attr, wakeup->packet_len))
16335                                 goto free_msg;
16336
16337                         if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
16338                                     wakeup->packet))
16339                                 goto free_msg;
16340                 }
16341
16342                 if (wakeup->net_detect &&
16343                     cfg80211_net_detect_results(msg, wakeup))
16344                                 goto free_msg;
16345
16346                 nla_nest_end(msg, reasons);
16347         }
16348
16349         genlmsg_end(msg, hdr);
16350
16351         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16352                                 NL80211_MCGRP_MLME, gfp);
16353         return;
16354
16355  free_msg:
16356         nlmsg_free(msg);
16357 }
16358 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
16359 #endif
16360
16361 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
16362                                 enum nl80211_tdls_operation oper,
16363                                 u16 reason_code, gfp_t gfp)
16364 {
16365         struct wireless_dev *wdev = dev->ieee80211_ptr;
16366         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16367         struct sk_buff *msg;
16368         void *hdr;
16369
16370         trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
16371                                          reason_code);
16372
16373         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16374         if (!msg)
16375                 return;
16376
16377         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
16378         if (!hdr) {
16379                 nlmsg_free(msg);
16380                 return;
16381         }
16382
16383         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16384             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16385             nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
16386             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
16387             (reason_code > 0 &&
16388              nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
16389                 goto nla_put_failure;
16390
16391         genlmsg_end(msg, hdr);
16392
16393         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16394                                 NL80211_MCGRP_MLME, gfp);
16395         return;
16396
16397  nla_put_failure:
16398         nlmsg_free(msg);
16399 }
16400 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
16401
16402 static int nl80211_netlink_notify(struct notifier_block * nb,
16403                                   unsigned long state,
16404                                   void *_notify)
16405 {
16406         struct netlink_notify *notify = _notify;
16407         struct cfg80211_registered_device *rdev;
16408         struct wireless_dev *wdev;
16409         struct cfg80211_beacon_registration *reg, *tmp;
16410
16411         if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
16412                 return NOTIFY_DONE;
16413
16414         rcu_read_lock();
16415
16416         list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
16417                 struct cfg80211_sched_scan_request *sched_scan_req;
16418
16419                 list_for_each_entry_rcu(sched_scan_req,
16420                                         &rdev->sched_scan_req_list,
16421                                         list) {
16422                         if (sched_scan_req->owner_nlportid == notify->portid) {
16423                                 sched_scan_req->nl_owner_dead = true;
16424                                 schedule_work(&rdev->sched_scan_stop_wk);
16425                         }
16426                 }
16427
16428                 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
16429                         cfg80211_mlme_unregister_socket(wdev, notify->portid);
16430
16431                         if (wdev->owner_nlportid == notify->portid) {
16432                                 wdev->nl_owner_dead = true;
16433                                 schedule_work(&rdev->destroy_work);
16434                         } else if (wdev->conn_owner_nlportid == notify->portid) {
16435                                 schedule_work(&wdev->disconnect_wk);
16436                         }
16437
16438                         cfg80211_release_pmsr(wdev, notify->portid);
16439                 }
16440
16441                 spin_lock_bh(&rdev->beacon_registrations_lock);
16442                 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
16443                                          list) {
16444                         if (reg->nlportid == notify->portid) {
16445                                 list_del(&reg->list);
16446                                 kfree(reg);
16447                                 break;
16448                         }
16449                 }
16450                 spin_unlock_bh(&rdev->beacon_registrations_lock);
16451         }
16452
16453         rcu_read_unlock();
16454
16455         /*
16456          * It is possible that the user space process that is controlling the
16457          * indoor setting disappeared, so notify the regulatory core.
16458          */
16459         regulatory_netlink_notify(notify->portid);
16460         return NOTIFY_OK;
16461 }
16462
16463 static struct notifier_block nl80211_netlink_notifier = {
16464         .notifier_call = nl80211_netlink_notify,
16465 };
16466
16467 void cfg80211_ft_event(struct net_device *netdev,
16468                        struct cfg80211_ft_event_params *ft_event)
16469 {
16470         struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
16471         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16472         struct sk_buff *msg;
16473         void *hdr;
16474
16475         trace_cfg80211_ft_event(wiphy, netdev, ft_event);
16476
16477         if (!ft_event->target_ap)
16478                 return;
16479
16480         msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
16481                         GFP_KERNEL);
16482         if (!msg)
16483                 return;
16484
16485         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
16486         if (!hdr)
16487                 goto out;
16488
16489         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16490             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16491             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
16492                 goto out;
16493
16494         if (ft_event->ies &&
16495             nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
16496                 goto out;
16497         if (ft_event->ric_ies &&
16498             nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
16499                     ft_event->ric_ies))
16500                 goto out;
16501
16502         genlmsg_end(msg, hdr);
16503
16504         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16505                                 NL80211_MCGRP_MLME, GFP_KERNEL);
16506         return;
16507  out:
16508         nlmsg_free(msg);
16509 }
16510 EXPORT_SYMBOL(cfg80211_ft_event);
16511
16512 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
16513 {
16514         struct cfg80211_registered_device *rdev;
16515         struct sk_buff *msg;
16516         void *hdr;
16517         u32 nlportid;
16518
16519         rdev = wiphy_to_rdev(wdev->wiphy);
16520         if (!rdev->crit_proto_nlportid)
16521                 return;
16522
16523         nlportid = rdev->crit_proto_nlportid;
16524         rdev->crit_proto_nlportid = 0;
16525
16526         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16527         if (!msg)
16528                 return;
16529
16530         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
16531         if (!hdr)
16532                 goto nla_put_failure;
16533
16534         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16535             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16536                               NL80211_ATTR_PAD))
16537                 goto nla_put_failure;
16538
16539         genlmsg_end(msg, hdr);
16540
16541         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
16542         return;
16543
16544  nla_put_failure:
16545         nlmsg_free(msg);
16546 }
16547 EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
16548
16549 void nl80211_send_ap_stopped(struct wireless_dev *wdev)
16550 {
16551         struct wiphy *wiphy = wdev->wiphy;
16552         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16553         struct sk_buff *msg;
16554         void *hdr;
16555
16556         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
16557         if (!msg)
16558                 return;
16559
16560         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
16561         if (!hdr)
16562                 goto out;
16563
16564         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16565             nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
16566             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
16567                               NL80211_ATTR_PAD))
16568                 goto out;
16569
16570         genlmsg_end(msg, hdr);
16571
16572         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
16573                                 NL80211_MCGRP_MLME, GFP_KERNEL);
16574         return;
16575  out:
16576         nlmsg_free(msg);
16577 }
16578
16579 int cfg80211_external_auth_request(struct net_device *dev,
16580                                    struct cfg80211_external_auth_params *params,
16581                                    gfp_t gfp)
16582 {
16583         struct wireless_dev *wdev = dev->ieee80211_ptr;
16584         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
16585         struct sk_buff *msg;
16586         void *hdr;
16587
16588         if (!wdev->conn_owner_nlportid)
16589                 return -EINVAL;
16590
16591         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16592         if (!msg)
16593                 return -ENOMEM;
16594
16595         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
16596         if (!hdr)
16597                 goto nla_put_failure;
16598
16599         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16600             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
16601             nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
16602             nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
16603                         params->action) ||
16604             nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
16605             nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
16606                     params->ssid.ssid))
16607                 goto nla_put_failure;
16608
16609         genlmsg_end(msg, hdr);
16610         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
16611                         wdev->conn_owner_nlportid);
16612         return 0;
16613
16614  nla_put_failure:
16615         nlmsg_free(msg);
16616         return -ENOBUFS;
16617 }
16618 EXPORT_SYMBOL(cfg80211_external_auth_request);
16619
16620 void cfg80211_update_owe_info_event(struct net_device *netdev,
16621                                     struct cfg80211_update_owe_info *owe_info,
16622                                     gfp_t gfp)
16623 {
16624         struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
16625         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
16626         struct sk_buff *msg;
16627         void *hdr;
16628
16629         trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info);
16630
16631         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
16632         if (!msg)
16633                 return;
16634
16635         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO);
16636         if (!hdr)
16637                 goto nla_put_failure;
16638
16639         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
16640             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
16641             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer))
16642                 goto nla_put_failure;
16643
16644         if (!owe_info->ie_len ||
16645             nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie))
16646                 goto nla_put_failure;
16647
16648         genlmsg_end(msg, hdr);
16649
16650         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
16651                                 NL80211_MCGRP_MLME, gfp);
16652         return;
16653
16654 nla_put_failure:
16655         genlmsg_cancel(msg, hdr);
16656         nlmsg_free(msg);
16657 }
16658 EXPORT_SYMBOL(cfg80211_update_owe_info_event);
16659
16660 /* initialisation/exit functions */
16661
16662 int __init nl80211_init(void)
16663 {
16664         int err;
16665
16666         err = genl_register_family(&nl80211_fam);
16667         if (err)
16668                 return err;
16669
16670         err = netlink_register_notifier(&nl80211_netlink_notifier);
16671         if (err)
16672                 goto err_out;
16673
16674         return 0;
16675  err_out:
16676         genl_unregister_family(&nl80211_fam);
16677         return err;
16678 }
16679
16680 void nl80211_exit(void)
16681 {
16682         netlink_unregister_notifier(&nl80211_netlink_notifier);
16683         genl_unregister_family(&nl80211_fam);
16684 }