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-2016  Intel Deutschland GmbH
   7  */
   8
   9 #include <linux/if.h>
  10 #include <linux/module.h>
  11 #include <linux/err.h>
  12 #include <linux/slab.h>
  13 #include <linux/list.h>
  14 #include <linux/if_ether.h>
  15 #include <linux/ieee80211.h>
  16 #include <linux/nl80211.h>
  17 #include <linux/rtnetlink.h>
  18 #include <linux/netlink.h>
  19 #include <linux/etherdevice.h>
  20 #include <net/net_namespace.h>
  21 #include <net/genetlink.h>
  22 #include <net/cfg80211.h>
  23 #include <net/sock.h>
  24 #include <net/inet_connection_sock.h>
  25 #include "core.h"
  26 #include "nl80211.h"
  27 #include "reg.h"
  28 #include "rdev-ops.h"
  29
  30 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  31                                    struct genl_info *info,
  32                                    struct cfg80211_crypto_settings *settings,
  33                                    int cipher_limit);
  34
  35 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
  36                             struct genl_info *info);
  37 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
  38                               struct genl_info *info);
  39
  40 /* the netlink family */
  41 static struct genl_family nl80211_fam = {
  42         .id = GENL_ID_GENERATE,         /* don't bother with a hardcoded ID */
  43         .name = NL80211_GENL_NAME,      /* have users key off the name instead */
  44         .hdrsize = 0,                   /* no private header */
  45         .version = 1,                   /* no particular meaning now */
  46         .maxattr = NL80211_ATTR_MAX,
  47         .netnsok = true,
  48         .pre_doit = nl80211_pre_doit,
  49         .post_doit = nl80211_post_doit,
  50 };
  51
  52 /* multicast groups */
  53 enum nl80211_multicast_groups {
  54         NL80211_MCGRP_CONFIG,
  55         NL80211_MCGRP_SCAN,
  56         NL80211_MCGRP_REGULATORY,
  57         NL80211_MCGRP_MLME,
  58         NL80211_MCGRP_VENDOR,
  59         NL80211_MCGRP_NAN,
  60         NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
  61 };
  62
  63 static const struct genl_multicast_group nl80211_mcgrps[] = {
  64         [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
  65         [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
  66         [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
  67         [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
  68         [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
  69         [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
  70 #ifdef CONFIG_NL80211_TESTMODE
  71         [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
  72 #endif
  73 };
  74
  75 /* returns ERR_PTR values */
  76 static struct wireless_dev *
  77 __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
  78 {
  79         struct cfg80211_registered_device *rdev;
  80         struct wireless_dev *result = NULL;
  81         bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
  82         bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
  83         u64 wdev_id;
  84         int wiphy_idx = -1;
  85         int ifidx = -1;
  86
  87         ASSERT_RTNL();
  88
  89         if (!have_ifidx && !have_wdev_id)
  90                 return ERR_PTR(-EINVAL);
  91
  92         if (have_ifidx)
  93                 ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  94         if (have_wdev_id) {
  95                 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  96                 wiphy_idx = wdev_id >> 32;
  97         }
  98
  99         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
 100                 struct wireless_dev *wdev;
 101
 102                 if (wiphy_net(&rdev->wiphy) != netns)
 103                         continue;
 104
 105                 if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
 106                         continue;
 107
 108                 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
 109                         if (have_ifidx && wdev->netdev &&
 110                             wdev->netdev->ifindex == ifidx) {
 111                                 result = wdev;
 112                                 break;
 113                         }
 114                         if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
 115                                 result = wdev;
 116                                 break;
 117                         }
 118                 }
 119
 120                 if (result)
 121                         break;
 122         }
 123
 124         if (result)
 125                 return result;
 126         return ERR_PTR(-ENODEV);
 127 }
 128
 129 static struct cfg80211_registered_device *
 130 __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
 131 {
 132         struct cfg80211_registered_device *rdev = NULL, *tmp;
 133         struct net_device *netdev;
 134
 135         ASSERT_RTNL();
 136
 137         if (!attrs[NL80211_ATTR_WIPHY] &&
 138             !attrs[NL80211_ATTR_IFINDEX] &&
 139             !attrs[NL80211_ATTR_WDEV])
 140                 return ERR_PTR(-EINVAL);
 141
 142         if (attrs[NL80211_ATTR_WIPHY])
 143                 rdev = cfg80211_rdev_by_wiphy_idx(
 144                                 nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
 145
 146         if (attrs[NL80211_ATTR_WDEV]) {
 147                 u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
 148                 struct wireless_dev *wdev;
 149                 bool found = false;
 150
 151                 tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
 152                 if (tmp) {
 153                         /* make sure wdev exists */
 154                         list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
 155                                 if (wdev->identifier != (u32)wdev_id)
 156                                         continue;
 157                                 found = true;
 158                                 break;
 159                         }
 160
 161                         if (!found)
 162                                 tmp = NULL;
 163
 164                         if (rdev && tmp != rdev)
 165                                 return ERR_PTR(-EINVAL);
 166                         rdev = tmp;
 167                 }
 168         }
 169
 170         if (attrs[NL80211_ATTR_IFINDEX]) {
 171                 int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
 172
 173                 netdev = __dev_get_by_index(netns, ifindex);
 174                 if (netdev) {
 175                         if (netdev->ieee80211_ptr)
 176                                 tmp = wiphy_to_rdev(
 177                                         netdev->ieee80211_ptr->wiphy);
 178                         else
 179                                 tmp = NULL;
 180
 181                         /* not wireless device -- return error */
 182                         if (!tmp)
 183                                 return ERR_PTR(-EINVAL);
 184
 185                         /* mismatch -- return error */
 186                         if (rdev && tmp != rdev)
 187                                 return ERR_PTR(-EINVAL);
 188
 189                         rdev = tmp;
 190                 }
 191         }
 192
 193         if (!rdev)
 194                 return ERR_PTR(-ENODEV);
 195
 196         if (netns != wiphy_net(&rdev->wiphy))
 197                 return ERR_PTR(-ENODEV);
 198
 199         return rdev;
 200 }
 201
 202 /*
 203  * This function returns a pointer to the driver
 204  * that the genl_info item that is passed refers to.
 205  *
 206  * The result of this can be a PTR_ERR and hence must
 207  * be checked with IS_ERR() for errors.
 208  */
 209 static struct cfg80211_registered_device *
 210 cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
 211 {
 212         return __cfg80211_rdev_from_attrs(netns, info->attrs);
 213 }
 214
 215 /* policy for the attributes */
 216 static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
 217         [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
 218         [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
 219                                       .len = 20-1 },
 220         [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
 221
 222         [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
 223         [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
 224         [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
 225         [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
 226         [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
 227
 228         [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
 229         [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
 230         [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
 231         [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
 232         [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
 233         [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
 234
 235         [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
 236         [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
 237         [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
 238
 239         [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
 240         [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
 241
 242         [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
 243         [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
 244                                     .len = WLAN_MAX_KEY_LEN },
 245         [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
 246         [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
 247         [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
 248         [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
 249         [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
 250
 251         [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
 252         [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
 253         [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
 254                                        .len = IEEE80211_MAX_DATA_LEN },
 255         [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
 256                                        .len = IEEE80211_MAX_DATA_LEN },
 257         [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
 258         [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
 259         [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
 260         [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
 261                                                .len = NL80211_MAX_SUPP_RATES },
 262         [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
 263         [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
 264         [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
 265         [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
 266                                    .len = IEEE80211_MAX_MESH_ID_LEN },
 267         [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
 268
 269         [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
 270         [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
 271
 272         [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
 273         [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
 274         [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
 275         [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
 276                                            .len = NL80211_MAX_SUPP_RATES },
 277         [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
 278
 279         [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
 280         [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
 281
 282         [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
 283
 284         [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
 285         [NL80211_ATTR_IE] = { .type = NLA_BINARY,
 286                               .len = IEEE80211_MAX_DATA_LEN },
 287         [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
 288         [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
 289
 290         [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
 291                                 .len = IEEE80211_MAX_SSID_LEN },
 292         [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
 293         [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
 294         [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
 295         [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
 296         [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
 297         [NL80211_ATTR_STA_FLAGS2] = {
 298                 .len = sizeof(struct nl80211_sta_flag_update),
 299         },
 300         [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
 301         [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
 302         [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
 303         [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
 304         [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
 305         [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
 306         [NL80211_ATTR_PID] = { .type = NLA_U32 },
 307         [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
 308         [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
 309                                  .len = WLAN_PMKID_LEN },
 310         [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
 311         [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
 312         [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
 313         [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
 314                                  .len = IEEE80211_MAX_DATA_LEN },
 315         [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
 316         [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
 317         [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
 318         [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
 319         [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
 320         [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
 321         [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
 322         [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
 323         [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
 324         [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
 325         [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
 326         [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
 327         [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
 328         [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
 329         [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
 330         [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
 331         [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
 332         [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
 333         [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
 334         [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
 335                                          .len = IEEE80211_MAX_DATA_LEN },
 336         [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
 337                                          .len = IEEE80211_MAX_DATA_LEN },
 338         [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
 339         [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
 340         [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
 341         [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
 342         [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
 343         [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
 344         [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
 345         [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
 346         [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
 347         [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
 348         [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
 349                                       .len = IEEE80211_MAX_DATA_LEN },
 350         [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
 351         [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
 352         [NL80211_ATTR_HT_CAPABILITY_MASK] = {
 353                 .len = NL80211_HT_CAPABILITY_LEN
 354         },
 355         [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
 356         [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
 357         [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
 358         [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
 359         [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
 360         [NL80211_ATTR_SAE_DATA] = { .type = NLA_BINARY, },
 361         [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
 362         [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
 363         [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
 364         [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
 365         [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
 366         [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
 367         [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
 368         [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
 369         [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
 370         [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
 371         [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
 372                 .len = NL80211_VHT_CAPABILITY_LEN,
 373         },
 374         [NL80211_ATTR_MDID] = { .type = NLA_U16 },
 375         [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
 376                                   .len = IEEE80211_MAX_DATA_LEN },
 377         [NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
 378         [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
 379         [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
 380         [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
 381         [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
 382         [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
 383         [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
 384         [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
 385         [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
 386         [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
 387         [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
 388         [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
 389         [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
 390         [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
 391                                    .len = IEEE80211_QOS_MAP_LEN_MAX },
 392         [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
 393         [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
 394         [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
 395         [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
 396         [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
 397         [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
 398         [NL80211_ATTR_TSID] = { .type = NLA_U8 },
 399         [NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
 400         [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
 401         [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
 402         [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
 403         [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
 404         [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
 405         [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
 406         [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
 407         [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
 408         [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
 409         [NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
 410         [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
 411                 .len = VHT_MUMIMO_GROUPS_DATA_LEN
 412         },
 413         [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
 414         [NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
 415         [NL80211_ATTR_NAN_DUAL] = { .type = NLA_U8 },
 416         [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
 417 };
 418
 419 /* policy for the key attributes */
 420 static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
 421         [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
 422         [NL80211_KEY_IDX] = { .type = NLA_U8 },
 423         [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
 424         [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
 425         [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
 426         [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
 427         [NL80211_KEY_TYPE] = { .type = NLA_U32 },
 428         [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
 429 };
 430
 431 /* policy for the key default flags */
 432 static const struct nla_policy
 433 nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
 434         [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
 435         [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
 436 };
 437
 438 /* policy for WoWLAN attributes */
 439 static const struct nla_policy
 440 nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
 441         [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
 442         [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
 443         [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
 444         [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
 445         [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
 446         [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
 447         [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
 448         [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
 449         [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
 450         [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
 451 };
 452
 453 static const struct nla_policy
 454 nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
 455         [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
 456         [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
 457         [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
 458         [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
 459         [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
 460         [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
 461         [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
 462                 .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
 463         },
 464         [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
 465                 .len = sizeof(struct nl80211_wowlan_tcp_data_token)
 466         },
 467         [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
 468         [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
 469         [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
 470 };
 471
 472 /* policy for coalesce rule attributes */
 473 static const struct nla_policy
 474 nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
 475         [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
 476         [NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
 477         [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
 478 };
 479
 480 /* policy for GTK rekey offload attributes */
 481 static const struct nla_policy
 482 nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
 483         [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
 484         [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
 485         [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
 486 };
 487
 488 static const struct nla_policy
 489 nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
 490         [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
 491                                                  .len = IEEE80211_MAX_SSID_LEN },
 492         [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
 493 };
 494
 495 static const struct nla_policy
 496 nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
 497         [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
 498         [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
 499 };
 500
 501 static const struct nla_policy
 502 nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
 503         [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
 504         [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
 505         [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
 506                 .len = sizeof(struct nl80211_bss_select_rssi_adjust)
 507         },
 508 };
 509
 510 /* policy for NAN function attributes */
 511 static const struct nla_policy
 512 nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
 513         [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
 514         [NL80211_NAN_FUNC_SERVICE_ID] = { .type = NLA_BINARY,
 515                                     .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
 516         [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
 517         [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
 518         [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
 519         [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
 520         [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
 521         [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
 522         [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
 523         [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
 524         [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
 525                         .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
 526         [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
 527         [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
 528         [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
 529         [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
 530         [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
 531 };
 532
 533 /* policy for Service Response Filter attributes */
 534 static const struct nla_policy
 535 nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
 536         [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
 537         [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
 538                                  .len =  NL80211_NAN_FUNC_SRF_MAX_LEN },
 539         [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
 540         [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
 541 };
 542
 543 static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
 544                                      struct netlink_callback *cb,
 545                                      struct cfg80211_registered_device **rdev,
 546                                      struct wireless_dev **wdev)
 547 {
 548         int err;
 549
 550         rtnl_lock();
 551
 552         if (!cb->args[0]) {
 553                 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
 554                                   nl80211_fam.attrbuf, nl80211_fam.maxattr,
 555                                   nl80211_policy);
 556                 if (err)
 557                         goto out_unlock;
 558
 559                 *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk),
 560                                                    nl80211_fam.attrbuf);
 561                 if (IS_ERR(*wdev)) {
 562                         err = PTR_ERR(*wdev);
 563                         goto out_unlock;
 564                 }
 565                 *rdev = wiphy_to_rdev((*wdev)->wiphy);
 566                 /* 0 is the first index - add 1 to parse only once */
 567                 cb->args[0] = (*rdev)->wiphy_idx + 1;
 568                 cb->args[1] = (*wdev)->identifier;
 569         } else {
 570                 /* subtract the 1 again here */
 571                 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
 572                 struct wireless_dev *tmp;
 573
 574                 if (!wiphy) {
 575                         err = -ENODEV;
 576                         goto out_unlock;
 577                 }
 578                 *rdev = wiphy_to_rdev(wiphy);
 579                 *wdev = NULL;
 580
 581                 list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
 582                         if (tmp->identifier == cb->args[1]) {
 583                                 *wdev = tmp;
 584                                 break;
 585                         }
 586                 }
 587
 588                 if (!*wdev) {
 589                         err = -ENODEV;
 590                         goto out_unlock;
 591                 }
 592         }
 593
 594         return 0;
 595  out_unlock:
 596         rtnl_unlock();
 597         return err;
 598 }
 599
 600 static void nl80211_finish_wdev_dump(struct cfg80211_registered_device *rdev)
 601 {
 602         rtnl_unlock();
 603 }
 604
 605 /* IE validation */
 606 static bool is_valid_ie_attr(const struct nlattr *attr)
 607 {
 608         const u8 *pos;
 609         int len;
 610
 611         if (!attr)
 612                 return true;
 613
 614         pos = nla_data(attr);
 615         len = nla_len(attr);
 616
 617         while (len) {
 618                 u8 elemlen;
 619
 620                 if (len < 2)
 621                         return false;
 622                 len -= 2;
 623
 624                 elemlen = pos[1];
 625                 if (elemlen > len)
 626                         return false;
 627
 628                 len -= elemlen;
 629                 pos += 2 + elemlen;
 630         }
 631
 632         return true;
 633 }
 634
 635 /* message building helper */
 636 static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
 637                                    int flags, u8 cmd)
 638 {
 639         /* since there is no private header just add the generic one */
 640         return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
 641 }
 642
 643 static int nl80211_msg_put_channel(struct sk_buff *msg,
 644                                    struct ieee80211_channel *chan,
 645                                    bool large)
 646 {
 647         /* Some channels must be completely excluded from the
 648          * list to protect old user-space tools from breaking
 649          */
 650         if (!large && chan->flags &
 651             (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
 652                 return 0;
 653
 654         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
 655                         chan->center_freq))
 656                 goto nla_put_failure;
 657
 658         if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
 659             nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
 660                 goto nla_put_failure;
 661         if (chan->flags & IEEE80211_CHAN_NO_IR) {
 662                 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
 663                         goto nla_put_failure;
 664                 if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
 665                         goto nla_put_failure;
 666         }
 667         if (chan->flags & IEEE80211_CHAN_RADAR) {
 668                 if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
 669                         goto nla_put_failure;
 670                 if (large) {
 671                         u32 time;
 672
 673                         time = elapsed_jiffies_msecs(chan->dfs_state_entered);
 674
 675                         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
 676                                         chan->dfs_state))
 677                                 goto nla_put_failure;
 678                         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
 679                                         time))
 680                                 goto nla_put_failure;
 681                         if (nla_put_u32(msg,
 682                                         NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
 683                                         chan->dfs_cac_ms))
 684                                 goto nla_put_failure;
 685                 }
 686         }
 687
 688         if (large) {
 689                 if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
 690                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
 691                         goto nla_put_failure;
 692                 if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
 693                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
 694                         goto nla_put_failure;
 695                 if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
 696                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
 697                         goto nla_put_failure;
 698                 if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
 699                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
 700                         goto nla_put_failure;
 701                 if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
 702                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
 703                         goto nla_put_failure;
 704                 if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
 705                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
 706                         goto nla_put_failure;
 707                 if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
 708                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
 709                         goto nla_put_failure;
 710                 if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
 711                     nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
 712                         goto nla_put_failure;
 713         }
 714
 715         if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
 716                         DBM_TO_MBM(chan->max_power)))
 717                 goto nla_put_failure;
 718
 719         return 0;
 720
 721  nla_put_failure:
 722         return -ENOBUFS;
 723 }
 724
 725 /* netlink command implementations */
 726
 727 struct key_parse {
 728         struct key_params p;
 729         int idx;
 730         int type;
 731         bool def, defmgmt;
 732         bool def_uni, def_multi;
 733 };
 734
 735 static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
 736 {
 737         struct nlattr *tb[NL80211_KEY_MAX + 1];
 738         int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
 739                                    nl80211_key_policy);
 740         if (err)
 741                 return err;
 742
 743         k->def = !!tb[NL80211_KEY_DEFAULT];
 744         k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
 745
 746         if (k->def) {
 747                 k->def_uni = true;
 748                 k->def_multi = true;
 749         }
 750         if (k->defmgmt)
 751                 k->def_multi = true;
 752
 753         if (tb[NL80211_KEY_IDX])
 754                 k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
 755
 756         if (tb[NL80211_KEY_DATA]) {
 757                 k->p.key = nla_data(tb[NL80211_KEY_DATA]);
 758                 k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
 759         }
 760
 761         if (tb[NL80211_KEY_SEQ]) {
 762                 k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
 763                 k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
 764         }
 765
 766         if (tb[NL80211_KEY_CIPHER])
 767                 k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
 768
 769         if (tb[NL80211_KEY_TYPE]) {
 770                 k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
 771                 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
 772                         return -EINVAL;
 773         }
 774
 775         if (tb[NL80211_KEY_DEFAULT_TYPES]) {
 776                 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
 777
 778                 err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
 779                                        tb[NL80211_KEY_DEFAULT_TYPES],
 780                                        nl80211_key_default_policy);
 781                 if (err)
 782                         return err;
 783
 784                 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
 785                 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
 786         }
 787
 788         return 0;
 789 }
 790
 791 static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
 792 {
 793         if (info->attrs[NL80211_ATTR_KEY_DATA]) {
 794                 k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
 795                 k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
 796         }
 797
 798         if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
 799                 k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
 800                 k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
 801         }
 802
 803         if (info->attrs[NL80211_ATTR_KEY_IDX])
 804                 k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
 805
 806         if (info->attrs[NL80211_ATTR_KEY_CIPHER])
 807                 k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
 808
 809         k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
 810         k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
 811
 812         if (k->def) {
 813                 k->def_uni = true;
 814                 k->def_multi = true;
 815         }
 816         if (k->defmgmt)
 817                 k->def_multi = true;
 818
 819         if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
 820                 k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
 821                 if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
 822                         return -EINVAL;
 823         }
 824
 825         if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
 826                 struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
 827                 int err = nla_parse_nested(
 828                                 kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
 829                                 info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
 830                                 nl80211_key_default_policy);
 831                 if (err)
 832                         return err;
 833
 834                 k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
 835                 k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
 836         }
 837
 838         return 0;
 839 }
 840
 841 static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
 842 {
 843         int err;
 844
 845         memset(k, 0, sizeof(*k));
 846         k->idx = -1;
 847         k->type = -1;
 848
 849         if (info->attrs[NL80211_ATTR_KEY])
 850                 err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
 851         else
 852                 err = nl80211_parse_key_old(info, k);
 853
 854         if (err)
 855                 return err;
 856
 857         if (k->def && k->defmgmt)
 858                 return -EINVAL;
 859
 860         if (k->defmgmt) {
 861                 if (k->def_uni || !k->def_multi)
 862                         return -EINVAL;
 863         }
 864
 865         if (k->idx != -1) {
 866                 if (k->defmgmt) {
 867                         if (k->idx < 4 || k->idx > 5)
 868                                 return -EINVAL;
 869                 } else if (k->def) {
 870                         if (k->idx < 0 || k->idx > 3)
 871                                 return -EINVAL;
 872                 } else {
 873                         if (k->idx < 0 || k->idx > 5)
 874                                 return -EINVAL;
 875                 }
 876         }
 877
 878         return 0;
 879 }
 880
 881 static struct cfg80211_cached_keys *
 882 nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
 883                        struct nlattr *keys, bool *no_ht)
 884 {
 885         struct key_parse parse;
 886         struct nlattr *key;
 887         struct cfg80211_cached_keys *result;
 888         int rem, err, def = 0;
 889         bool have_key = false;
 890
 891         nla_for_each_nested(key, keys, rem) {
 892                 have_key = true;
 893                 break;
 894         }
 895
 896         if (!have_key)
 897                 return NULL;
 898
 899         result = kzalloc(sizeof(*result), GFP_KERNEL);
 900         if (!result)
 901                 return ERR_PTR(-ENOMEM);
 902
 903         result->def = -1;
 904
 905         nla_for_each_nested(key, keys, rem) {
 906                 memset(&parse, 0, sizeof(parse));
 907                 parse.idx = -1;
 908
 909                 err = nl80211_parse_key_new(key, &parse);
 910                 if (err)
 911                         goto error;
 912                 err = -EINVAL;
 913                 if (!parse.p.key)
 914                         goto error;
 915                 if (parse.idx < 0 || parse.idx > 3)
 916                         goto error;
 917                 if (parse.def) {
 918                         if (def)
 919                                 goto error;
 920                         def = 1;
 921                         result->def = parse.idx;
 922                         if (!parse.def_uni || !parse.def_multi)
 923                                 goto error;
 924                 } else if (parse.defmgmt)
 925                         goto error;
 926                 err = cfg80211_validate_key_settings(rdev, &parse.p,
 927                                                      parse.idx, false, NULL);
 928                 if (err)
 929                         goto error;
 930                 if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
 931                     parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
 932                         err = -EINVAL;
 933                         goto error;
 934                 }
 935                 result->params[parse.idx].cipher = parse.p.cipher;
 936                 result->params[parse.idx].key_len = parse.p.key_len;
 937                 result->params[parse.idx].key = result->data[parse.idx];
 938                 memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
 939
 940                 /* must be WEP key if we got here */
 941                 if (no_ht)
 942                         *no_ht = true;
 943         }
 944
 945         if (result->def < 0) {
 946                 err = -EINVAL;
 947                 goto error;
 948         }
 949
 950         return result;
 951  error:
 952         kfree(result);
 953         return ERR_PTR(err);
 954 }
 955
 956 static int nl80211_key_allowed(struct wireless_dev *wdev)
 957 {
 958         ASSERT_WDEV_LOCK(wdev);
 959
 960         switch (wdev->iftype) {
 961         case NL80211_IFTYPE_AP:
 962         case NL80211_IFTYPE_AP_VLAN:
 963         case NL80211_IFTYPE_P2P_GO:
 964         case NL80211_IFTYPE_MESH_POINT:
 965                 break;
 966         case NL80211_IFTYPE_ADHOC:
 967         case NL80211_IFTYPE_STATION:
 968         case NL80211_IFTYPE_P2P_CLIENT:
 969                 if (!wdev->current_bss)
 970                         return -ENOLINK;
 971                 break;
 972         case NL80211_IFTYPE_UNSPECIFIED:
 973         case NL80211_IFTYPE_OCB:
 974         case NL80211_IFTYPE_MONITOR:
 975         case NL80211_IFTYPE_NAN:
 976         case NL80211_IFTYPE_P2P_DEVICE:
 977         case NL80211_IFTYPE_WDS:
 978         case NUM_NL80211_IFTYPES:
 979                 return -EINVAL;
 980         }
 981
 982         return 0;
 983 }
 984
 985 static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
 986                                                         struct nlattr *tb)
 987 {
 988         struct ieee80211_channel *chan;
 989
 990         if (tb == NULL)
 991                 return NULL;
 992         chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
 993         if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
 994                 return NULL;
 995         return chan;
 996 }
 997
 998 static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
 999 {
1000         struct nlattr *nl_modes = nla_nest_start(msg, attr);
1001         int i;
1002
1003         if (!nl_modes)
1004                 goto nla_put_failure;
1005
1006         i = 0;
1007         while (ifmodes) {
1008                 if ((ifmodes & 1) && nla_put_flag(msg, i))
1009                         goto nla_put_failure;
1010                 ifmodes >>= 1;
1011                 i++;
1012         }
1013
1014         nla_nest_end(msg, nl_modes);
1015         return 0;
1016
1017 nla_put_failure:
1018         return -ENOBUFS;
1019 }
1020
1021 static int nl80211_put_iface_combinations(struct wiphy *wiphy,
1022                                           struct sk_buff *msg,
1023                                           bool large)
1024 {
1025         struct nlattr *nl_combis;
1026         int i, j;
1027
1028         nl_combis = nla_nest_start(msg,
1029                                 NL80211_ATTR_INTERFACE_COMBINATIONS);
1030         if (!nl_combis)
1031                 goto nla_put_failure;
1032
1033         for (i = 0; i < wiphy->n_iface_combinations; i++) {
1034                 const struct ieee80211_iface_combination *c;
1035                 struct nlattr *nl_combi, *nl_limits;
1036
1037                 c = &wiphy->iface_combinations[i];
1038
1039                 nl_combi = nla_nest_start(msg, i + 1);
1040                 if (!nl_combi)
1041                         goto nla_put_failure;
1042
1043                 nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
1044                 if (!nl_limits)
1045                         goto nla_put_failure;
1046
1047                 for (j = 0; j < c->n_limits; j++) {
1048                         struct nlattr *nl_limit;
1049
1050                         nl_limit = nla_nest_start(msg, j + 1);
1051                         if (!nl_limit)
1052                                 goto nla_put_failure;
1053                         if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
1054                                         c->limits[j].max))
1055                                 goto nla_put_failure;
1056                         if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
1057                                                 c->limits[j].types))
1058                                 goto nla_put_failure;
1059                         nla_nest_end(msg, nl_limit);
1060                 }
1061
1062                 nla_nest_end(msg, nl_limits);
1063
1064                 if (c->beacon_int_infra_match &&
1065                     nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
1066                         goto nla_put_failure;
1067                 if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
1068                                 c->num_different_channels) ||
1069                     nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
1070                                 c->max_interfaces))
1071                         goto nla_put_failure;
1072                 if (large &&
1073                     (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
1074                                 c->radar_detect_widths) ||
1075                      nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
1076                                 c->radar_detect_regions)))
1077                         goto nla_put_failure;
1078
1079                 nla_nest_end(msg, nl_combi);
1080         }
1081
1082         nla_nest_end(msg, nl_combis);
1083
1084         return 0;
1085 nla_put_failure:
1086         return -ENOBUFS;
1087 }
1088
1089 #ifdef CONFIG_PM
1090 static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
1091                                         struct sk_buff *msg)
1092 {
1093         const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
1094         struct nlattr *nl_tcp;
1095
1096         if (!tcp)
1097                 return 0;
1098
1099         nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
1100         if (!nl_tcp)
1101                 return -ENOBUFS;
1102
1103         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1104                         tcp->data_payload_max))
1105                 return -ENOBUFS;
1106
1107         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
1108                         tcp->data_payload_max))
1109                 return -ENOBUFS;
1110
1111         if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
1112                 return -ENOBUFS;
1113
1114         if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
1115                                 sizeof(*tcp->tok), tcp->tok))
1116                 return -ENOBUFS;
1117
1118         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
1119                         tcp->data_interval_max))
1120                 return -ENOBUFS;
1121
1122         if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
1123                         tcp->wake_payload_max))
1124                 return -ENOBUFS;
1125
1126         nla_nest_end(msg, nl_tcp);
1127         return 0;
1128 }
1129
1130 static int nl80211_send_wowlan(struct sk_buff *msg,
1131                                struct cfg80211_registered_device *rdev,
1132                                bool large)
1133 {
1134         struct nlattr *nl_wowlan;
1135
1136         if (!rdev->wiphy.wowlan)
1137                 return 0;
1138
1139         nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
1140         if (!nl_wowlan)
1141                 return -ENOBUFS;
1142
1143         if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
1144              nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
1145             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
1146              nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
1147             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
1148              nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
1149             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
1150              nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
1151             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
1152              nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
1153             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
1154              nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
1155             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
1156              nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
1157             ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
1158              nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
1159                 return -ENOBUFS;
1160
1161         if (rdev->wiphy.wowlan->n_patterns) {
1162                 struct nl80211_pattern_support pat = {
1163                         .max_patterns = rdev->wiphy.wowlan->n_patterns,
1164                         .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
1165                         .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
1166                         .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
1167                 };
1168
1169                 if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
1170                             sizeof(pat), &pat))
1171                         return -ENOBUFS;
1172         }
1173
1174         if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
1175             nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
1176                         rdev->wiphy.wowlan->max_nd_match_sets))
1177                 return -ENOBUFS;
1178
1179         if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
1180                 return -ENOBUFS;
1181
1182         nla_nest_end(msg, nl_wowlan);
1183
1184         return 0;
1185 }
1186 #endif
1187
1188 static int nl80211_send_coalesce(struct sk_buff *msg,
1189                                  struct cfg80211_registered_device *rdev)
1190 {
1191         struct nl80211_coalesce_rule_support rule;
1192
1193         if (!rdev->wiphy.coalesce)
1194                 return 0;
1195
1196         rule.max_rules = rdev->wiphy.coalesce->n_rules;
1197         rule.max_delay = rdev->wiphy.coalesce->max_delay;
1198         rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
1199         rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
1200         rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
1201         rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
1202
1203         if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
1204                 return -ENOBUFS;
1205
1206         return 0;
1207 }
1208
1209 static int nl80211_send_band_rateinfo(struct sk_buff *msg,
1210                                       struct ieee80211_supported_band *sband)
1211 {
1212         struct nlattr *nl_rates, *nl_rate;
1213         struct ieee80211_rate *rate;
1214         int i;
1215
1216         /* add HT info */
1217         if (sband->ht_cap.ht_supported &&
1218             (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
1219                      sizeof(sband->ht_cap.mcs),
1220                      &sband->ht_cap.mcs) ||
1221              nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
1222                          sband->ht_cap.cap) ||
1223              nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
1224                         sband->ht_cap.ampdu_factor) ||
1225              nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
1226                         sband->ht_cap.ampdu_density)))
1227                 return -ENOBUFS;
1228
1229         /* add VHT info */
1230         if (sband->vht_cap.vht_supported &&
1231             (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
1232                      sizeof(sband->vht_cap.vht_mcs),
1233                      &sband->vht_cap.vht_mcs) ||
1234              nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
1235                          sband->vht_cap.cap)))
1236                 return -ENOBUFS;
1237
1238         /* add bitrates */
1239         nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
1240         if (!nl_rates)
1241                 return -ENOBUFS;
1242
1243         for (i = 0; i < sband->n_bitrates; i++) {
1244                 nl_rate = nla_nest_start(msg, i);
1245                 if (!nl_rate)
1246                         return -ENOBUFS;
1247
1248                 rate = &sband->bitrates[i];
1249                 if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
1250                                 rate->bitrate))
1251                         return -ENOBUFS;
1252                 if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
1253                     nla_put_flag(msg,
1254                                  NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
1255                         return -ENOBUFS;
1256
1257                 nla_nest_end(msg, nl_rate);
1258         }
1259
1260         nla_nest_end(msg, nl_rates);
1261
1262         return 0;
1263 }
1264
1265 static int
1266 nl80211_send_mgmt_stypes(struct sk_buff *msg,
1267                          const struct ieee80211_txrx_stypes *mgmt_stypes)
1268 {
1269         u16 stypes;
1270         struct nlattr *nl_ftypes, *nl_ifs;
1271         enum nl80211_iftype ift;
1272         int i;
1273
1274         if (!mgmt_stypes)
1275                 return 0;
1276
1277         nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
1278         if (!nl_ifs)
1279                 return -ENOBUFS;
1280
1281         for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1282                 nl_ftypes = nla_nest_start(msg, ift);
1283                 if (!nl_ftypes)
1284                         return -ENOBUFS;
1285                 i = 0;
1286                 stypes = mgmt_stypes[ift].tx;
1287                 while (stypes) {
1288                         if ((stypes & 1) &&
1289                             nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1290                                         (i << 4) | IEEE80211_FTYPE_MGMT))
1291                                 return -ENOBUFS;
1292                         stypes >>= 1;
1293                         i++;
1294                 }
1295                 nla_nest_end(msg, nl_ftypes);
1296         }
1297
1298         nla_nest_end(msg, nl_ifs);
1299
1300         nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
1301         if (!nl_ifs)
1302                 return -ENOBUFS;
1303
1304         for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
1305                 nl_ftypes = nla_nest_start(msg, ift);
1306                 if (!nl_ftypes)
1307                         return -ENOBUFS;
1308                 i = 0;
1309                 stypes = mgmt_stypes[ift].rx;
1310                 while (stypes) {
1311                         if ((stypes & 1) &&
1312                             nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
1313                                         (i << 4) | IEEE80211_FTYPE_MGMT))
1314                                 return -ENOBUFS;
1315                         stypes >>= 1;
1316                         i++;
1317                 }
1318                 nla_nest_end(msg, nl_ftypes);
1319         }
1320         nla_nest_end(msg, nl_ifs);
1321
1322         return 0;
1323 }
1324
1325 struct nl80211_dump_wiphy_state {
1326         s64 filter_wiphy;
1327         long start;
1328         long split_start, band_start, chan_start, capa_start;
1329         bool split;
1330 };
1331
1332 static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
1333                               enum nl80211_commands cmd,
1334                               struct sk_buff *msg, u32 portid, u32 seq,
1335                               int flags, struct nl80211_dump_wiphy_state *state)
1336 {
1337         void *hdr;
1338         struct nlattr *nl_bands, *nl_band;
1339         struct nlattr *nl_freqs, *nl_freq;
1340         struct nlattr *nl_cmds;
1341         enum nl80211_band band;
1342         struct ieee80211_channel *chan;
1343         int i;
1344         const struct ieee80211_txrx_stypes *mgmt_stypes =
1345                                 rdev->wiphy.mgmt_stypes;
1346         u32 features;
1347
1348         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
1349         if (!hdr)
1350                 return -ENOBUFS;
1351
1352         if (WARN_ON(!state))
1353                 return -EINVAL;
1354
1355         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
1356             nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
1357                            wiphy_name(&rdev->wiphy)) ||
1358             nla_put_u32(msg, NL80211_ATTR_GENERATION,
1359                         cfg80211_rdev_list_generation))
1360                 goto nla_put_failure;
1361
1362         if (cmd != NL80211_CMD_NEW_WIPHY)
1363                 goto finish;
1364
1365         switch (state->split_start) {
1366         case 0:
1367                 if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
1368                                rdev->wiphy.retry_short) ||
1369                     nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
1370                                rdev->wiphy.retry_long) ||
1371                     nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
1372                                 rdev->wiphy.frag_threshold) ||
1373                     nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
1374                                 rdev->wiphy.rts_threshold) ||
1375                     nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
1376                                rdev->wiphy.coverage_class) ||
1377                     nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
1378                                rdev->wiphy.max_scan_ssids) ||
1379                     nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
1380                                rdev->wiphy.max_sched_scan_ssids) ||
1381                     nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
1382                                 rdev->wiphy.max_scan_ie_len) ||
1383                     nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
1384                                 rdev->wiphy.max_sched_scan_ie_len) ||
1385                     nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
1386                                rdev->wiphy.max_match_sets) ||
1387                     nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
1388                                 rdev->wiphy.max_sched_scan_plans) ||
1389                     nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
1390                                 rdev->wiphy.max_sched_scan_plan_interval) ||
1391                     nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
1392                                 rdev->wiphy.max_sched_scan_plan_iterations))
1393                         goto nla_put_failure;
1394
1395                 if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
1396                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
1397                         goto nla_put_failure;
1398                 if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
1399                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
1400                         goto nla_put_failure;
1401                 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
1402                     nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
1403                         goto nla_put_failure;
1404                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
1405                     nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
1406                         goto nla_put_failure;
1407                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
1408                     nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
1409                         goto nla_put_failure;
1410                 if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
1411                     nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
1412                         goto nla_put_failure;
1413                 state->split_start++;
1414                 if (state->split)
1415                         break;
1416         case 1:
1417                 if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
1418                             sizeof(u32) * rdev->wiphy.n_cipher_suites,
1419                             rdev->wiphy.cipher_suites))
1420                         goto nla_put_failure;
1421
1422                 if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
1423                                rdev->wiphy.max_num_pmkids))
1424                         goto nla_put_failure;
1425
1426                 if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
1427                     nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
1428                         goto nla_put_failure;
1429
1430                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
1431                                 rdev->wiphy.available_antennas_tx) ||
1432                     nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
1433                                 rdev->wiphy.available_antennas_rx))
1434                         goto nla_put_failure;
1435
1436                 if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
1437                     nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
1438                                 rdev->wiphy.probe_resp_offload))
1439                         goto nla_put_failure;
1440
1441                 if ((rdev->wiphy.available_antennas_tx ||
1442                      rdev->wiphy.available_antennas_rx) &&
1443                     rdev->ops->get_antenna) {
1444                         u32 tx_ant = 0, rx_ant = 0;
1445                         int res;
1446
1447                         res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
1448                         if (!res) {
1449                                 if (nla_put_u32(msg,
1450                                                 NL80211_ATTR_WIPHY_ANTENNA_TX,
1451                                                 tx_ant) ||
1452                                     nla_put_u32(msg,
1453                                                 NL80211_ATTR_WIPHY_ANTENNA_RX,
1454                                                 rx_ant))
1455                                         goto nla_put_failure;
1456                         }
1457                 }
1458
1459                 state->split_start++;
1460                 if (state->split)
1461                         break;
1462         case 2:
1463                 if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
1464                                         rdev->wiphy.interface_modes))
1465                                 goto nla_put_failure;
1466                 state->split_start++;
1467                 if (state->split)
1468                         break;
1469         case 3:
1470                 nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
1471                 if (!nl_bands)
1472                         goto nla_put_failure;
1473
1474                 for (band = state->band_start;
1475                      band < NUM_NL80211_BANDS; band++) {
1476                         struct ieee80211_supported_band *sband;
1477
1478                         sband = rdev->wiphy.bands[band];
1479
1480                         if (!sband)
1481                                 continue;
1482
1483                         nl_band = nla_nest_start(msg, band);
1484                         if (!nl_band)
1485                                 goto nla_put_failure;
1486
1487                         switch (state->chan_start) {
1488                         case 0:
1489                                 if (nl80211_send_band_rateinfo(msg, sband))
1490                                         goto nla_put_failure;
1491                                 state->chan_start++;
1492                                 if (state->split)
1493                                         break;
1494                         default:
1495                                 /* add frequencies */
1496                                 nl_freqs = nla_nest_start(
1497                                         msg, NL80211_BAND_ATTR_FREQS);
1498                                 if (!nl_freqs)
1499                                         goto nla_put_failure;
1500
1501                                 for (i = state->chan_start - 1;
1502                                      i < sband->n_channels;
1503                                      i++) {
1504                                         nl_freq = nla_nest_start(msg, i);
1505                                         if (!nl_freq)
1506                                                 goto nla_put_failure;
1507
1508                                         chan = &sband->channels[i];
1509
1510                                         if (nl80211_msg_put_channel(
1511                                                         msg, chan,
1512                                                         state->split))
1513                                                 goto nla_put_failure;
1514
1515                                         nla_nest_end(msg, nl_freq);
1516                                         if (state->split)
1517                                                 break;
1518                                 }
1519                                 if (i < sband->n_channels)
1520                                         state->chan_start = i + 2;
1521                                 else
1522                                         state->chan_start = 0;
1523                                 nla_nest_end(msg, nl_freqs);
1524                         }
1525
1526                         nla_nest_end(msg, nl_band);
1527
1528                         if (state->split) {
1529                                 /* start again here */
1530                                 if (state->chan_start)
1531                                         band--;
1532                                 break;
1533                         }
1534                 }
1535                 nla_nest_end(msg, nl_bands);
1536
1537                 if (band < NUM_NL80211_BANDS)
1538                         state->band_start = band + 1;
1539                 else
1540                         state->band_start = 0;
1541
1542                 /* if bands & channels are done, continue outside */
1543                 if (state->band_start == 0 && state->chan_start == 0)
1544                         state->split_start++;
1545                 if (state->split)
1546                         break;
1547         case 4:
1548                 nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
1549                 if (!nl_cmds)
1550                         goto nla_put_failure;
1551
1552                 i = 0;
1553 #define CMD(op, n)                                                      \
1554                  do {                                                   \
1555                         if (rdev->ops->op) {                            \
1556                                 i++;                                    \
1557                                 if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
1558                                         goto nla_put_failure;           \
1559                         }                                               \
1560                 } while (0)
1561
1562                 CMD(add_virtual_intf, NEW_INTERFACE);
1563                 CMD(change_virtual_intf, SET_INTERFACE);
1564                 CMD(add_key, NEW_KEY);
1565                 CMD(start_ap, START_AP);
1566                 CMD(add_station, NEW_STATION);
1567                 CMD(add_mpath, NEW_MPATH);
1568                 CMD(update_mesh_config, SET_MESH_CONFIG);
1569                 CMD(change_bss, SET_BSS);
1570                 CMD(auth, AUTHENTICATE);
1571                 CMD(assoc, ASSOCIATE);
1572                 CMD(deauth, DEAUTHENTICATE);
1573                 CMD(disassoc, DISASSOCIATE);
1574                 CMD(join_ibss, JOIN_IBSS);
1575                 CMD(join_mesh, JOIN_MESH);
1576                 CMD(set_pmksa, SET_PMKSA);
1577                 CMD(del_pmksa, DEL_PMKSA);
1578                 CMD(flush_pmksa, FLUSH_PMKSA);
1579                 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
1580                         CMD(remain_on_channel, REMAIN_ON_CHANNEL);
1581                 CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
1582                 CMD(mgmt_tx, FRAME);
1583                 CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
1584                 if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
1585                         i++;
1586                         if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
1587                                 goto nla_put_failure;
1588                 }
1589                 if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
1590                     rdev->ops->join_mesh) {
1591                         i++;
1592                         if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
1593                                 goto nla_put_failure;
1594                 }
1595                 CMD(set_wds_peer, SET_WDS_PEER);
1596                 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
1597                         CMD(tdls_mgmt, TDLS_MGMT);
1598                         CMD(tdls_oper, TDLS_OPER);
1599                 }
1600                 if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
1601                         CMD(sched_scan_start, START_SCHED_SCAN);
1602                 CMD(probe_client, PROBE_CLIENT);
1603                 CMD(set_noack_map, SET_NOACK_MAP);
1604                 if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
1605                         i++;
1606                         if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
1607                                 goto nla_put_failure;
1608                 }
1609                 CMD(start_p2p_device, START_P2P_DEVICE);
1610                 CMD(set_mcast_rate, SET_MCAST_RATE);
1611 #ifdef CONFIG_NL80211_TESTMODE
1612                 CMD(testmode_cmd, TESTMODE);
1613 #endif
1614                 if (state->split) {
1615                         CMD(crit_proto_start, CRIT_PROTOCOL_START);
1616                         CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
1617                         if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
1618                                 CMD(channel_switch, CHANNEL_SWITCH);
1619                         CMD(set_qos_map, SET_QOS_MAP);
1620                         if (rdev->wiphy.features &
1621                                         NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
1622                                 CMD(add_tx_ts, ADD_TX_TS);
1623                 }
1624                 /* add into the if now */
1625 #undef CMD
1626
1627                 if (rdev->ops->connect || rdev->ops->auth) {
1628                         i++;
1629                         if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
1630                                 goto nla_put_failure;
1631                 }
1632
1633                 if (rdev->ops->disconnect || rdev->ops->deauth) {
1634                         i++;
1635                         if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
1636                                 goto nla_put_failure;
1637                 }
1638
1639                 nla_nest_end(msg, nl_cmds);
1640                 state->split_start++;
1641                 if (state->split)
1642                         break;
1643         case 5:
1644                 if (rdev->ops->remain_on_channel &&
1645                     (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
1646                     nla_put_u32(msg,
1647                                 NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
1648                                 rdev->wiphy.max_remain_on_channel_duration))
1649                         goto nla_put_failure;
1650
1651                 if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
1652                     nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
1653                         goto nla_put_failure;
1654
1655                 if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
1656                         goto nla_put_failure;
1657                 state->split_start++;
1658                 if (state->split)
1659                         break;
1660         case 6:
1661 #ifdef CONFIG_PM
1662                 if (nl80211_send_wowlan(msg, rdev, state->split))
1663                         goto nla_put_failure;
1664                 state->split_start++;
1665                 if (state->split)
1666                         break;
1667 #else
1668                 state->split_start++;
1669 #endif
1670         case 7:
1671                 if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
1672                                         rdev->wiphy.software_iftypes))
1673                         goto nla_put_failure;
1674
1675                 if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
1676                                                    state->split))
1677                         goto nla_put_failure;
1678
1679                 state->split_start++;
1680                 if (state->split)
1681                         break;
1682         case 8:
1683                 if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
1684                     nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
1685                                 rdev->wiphy.ap_sme_capa))
1686                         goto nla_put_failure;
1687
1688                 features = rdev->wiphy.features;
1689                 /*
1690                  * We can only add the per-channel limit information if the
1691                  * dump is split, otherwise it makes it too big. Therefore
1692                  * only advertise it in that case.
1693                  */
1694                 if (state->split)
1695                         features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
1696                 if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
1697                         goto nla_put_failure;
1698
1699                 if (rdev->wiphy.ht_capa_mod_mask &&
1700                     nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
1701                             sizeof(*rdev->wiphy.ht_capa_mod_mask),
1702                             rdev->wiphy.ht_capa_mod_mask))
1703                         goto nla_put_failure;
1704
1705                 if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
1706                     rdev->wiphy.max_acl_mac_addrs &&
1707                     nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
1708                                 rdev->wiphy.max_acl_mac_addrs))
1709                         goto nla_put_failure;
1710
1711                 /*
1712                  * Any information below this point is only available to
1713                  * applications that can deal with it being split. This
1714                  * helps ensure that newly added capabilities don't break
1715                  * older tools by overrunning their buffers.
1716                  *
1717                  * We still increment split_start so that in the split
1718                  * case we'll continue with more data in the next round,
1719                  * but break unconditionally so unsplit data stops here.
1720                  */
1721                 state->split_start++;
1722                 break;
1723         case 9:
1724                 if (rdev->wiphy.extended_capabilities &&
1725                     (nla_put(msg, NL80211_ATTR_EXT_CAPA,
1726                              rdev->wiphy.extended_capabilities_len,
1727                              rdev->wiphy.extended_capabilities) ||
1728                      nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1729                              rdev->wiphy.extended_capabilities_len,
1730                              rdev->wiphy.extended_capabilities_mask)))
1731                         goto nla_put_failure;
1732
1733                 if (rdev->wiphy.vht_capa_mod_mask &&
1734                     nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
1735                             sizeof(*rdev->wiphy.vht_capa_mod_mask),
1736                             rdev->wiphy.vht_capa_mod_mask))
1737                         goto nla_put_failure;
1738
1739                 state->split_start++;
1740                 break;
1741         case 10:
1742                 if (nl80211_send_coalesce(msg, rdev))
1743                         goto nla_put_failure;
1744
1745                 if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
1746                     (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
1747                      nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
1748                         goto nla_put_failure;
1749
1750                 if (rdev->wiphy.max_ap_assoc_sta &&
1751                     nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
1752                                 rdev->wiphy.max_ap_assoc_sta))
1753                         goto nla_put_failure;
1754
1755                 state->split_start++;
1756                 break;
1757         case 11:
1758                 if (rdev->wiphy.n_vendor_commands) {
1759                         const struct nl80211_vendor_cmd_info *info;
1760                         struct nlattr *nested;
1761
1762                         nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
1763                         if (!nested)
1764                                 goto nla_put_failure;
1765
1766                         for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
1767                                 info = &rdev->wiphy.vendor_commands[i].info;
1768                                 if (nla_put(msg, i + 1, sizeof(*info), info))
1769                                         goto nla_put_failure;
1770                         }
1771                         nla_nest_end(msg, nested);
1772                 }
1773
1774                 if (rdev->wiphy.n_vendor_events) {
1775                         const struct nl80211_vendor_cmd_info *info;
1776                         struct nlattr *nested;
1777
1778                         nested = nla_nest_start(msg,
1779                                                 NL80211_ATTR_VENDOR_EVENTS);
1780                         if (!nested)
1781                                 goto nla_put_failure;
1782
1783                         for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
1784                                 info = &rdev->wiphy.vendor_events[i];
1785                                 if (nla_put(msg, i + 1, sizeof(*info), info))
1786                                         goto nla_put_failure;
1787                         }
1788                         nla_nest_end(msg, nested);
1789                 }
1790                 state->split_start++;
1791                 break;
1792         case 12:
1793                 if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
1794                     nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
1795                                rdev->wiphy.max_num_csa_counters))
1796                         goto nla_put_failure;
1797
1798                 if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
1799                     nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
1800                         goto nla_put_failure;
1801
1802                 if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
1803                             sizeof(rdev->wiphy.ext_features),
1804                             rdev->wiphy.ext_features))
1805                         goto nla_put_failure;
1806
1807                 if (rdev->wiphy.bss_select_support) {
1808                         struct nlattr *nested;
1809                         u32 bss_select_support = rdev->wiphy.bss_select_support;
1810
1811                         nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
1812                         if (!nested)
1813                                 goto nla_put_failure;
1814
1815                         i = 0;
1816                         while (bss_select_support) {
1817                                 if ((bss_select_support & 1) &&
1818                                     nla_put_flag(msg, i))
1819                                         goto nla_put_failure;
1820                                 i++;
1821                                 bss_select_support >>= 1;
1822                         }
1823                         nla_nest_end(msg, nested);
1824                 }
1825
1826                 state->split_start++;
1827                 break;
1828         case 13:
1829                 if (rdev->wiphy.num_iftype_ext_capab &&
1830                     rdev->wiphy.iftype_ext_capab) {
1831                         struct nlattr *nested_ext_capab, *nested;
1832
1833                         nested = nla_nest_start(msg,
1834                                                 NL80211_ATTR_IFTYPE_EXT_CAPA);
1835                         if (!nested)
1836                                 goto nla_put_failure;
1837
1838                         for (i = state->capa_start;
1839                              i < rdev->wiphy.num_iftype_ext_capab; i++) {
1840                                 const struct wiphy_iftype_ext_capab *capab;
1841
1842                                 capab = &rdev->wiphy.iftype_ext_capab[i];
1843
1844                                 nested_ext_capab = nla_nest_start(msg, i);
1845                                 if (!nested_ext_capab ||
1846                                     nla_put_u32(msg, NL80211_ATTR_IFTYPE,
1847                                                 capab->iftype) ||
1848                                     nla_put(msg, NL80211_ATTR_EXT_CAPA,
1849                                             capab->extended_capabilities_len,
1850                                             capab->extended_capabilities) ||
1851                                     nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
1852                                             capab->extended_capabilities_len,
1853                                             capab->extended_capabilities_mask))
1854                                         goto nla_put_failure;
1855
1856                                 nla_nest_end(msg, nested_ext_capab);
1857                                 if (state->split)
1858                                         break;
1859                         }
1860                         nla_nest_end(msg, nested);
1861                         if (i < rdev->wiphy.num_iftype_ext_capab) {
1862                                 state->capa_start = i + 1;
1863                                 break;
1864                         }
1865                 }
1866
1867                 /* done */
1868                 state->split_start = 0;
1869                 break;
1870         }
1871  finish:
1872         genlmsg_end(msg, hdr);
1873         return 0;
1874
1875  nla_put_failure:
1876         genlmsg_cancel(msg, hdr);
1877         return -EMSGSIZE;
1878 }
1879
1880 static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
1881                                     struct netlink_callback *cb,
1882                                     struct nl80211_dump_wiphy_state *state)
1883 {
1884         struct nlattr **tb = nl80211_fam.attrbuf;
1885         int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
1886                               tb, nl80211_fam.maxattr, nl80211_policy);
1887         /* ignore parse errors for backward compatibility */
1888         if (ret)
1889                 return 0;
1890
1891         state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
1892         if (tb[NL80211_ATTR_WIPHY])
1893                 state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
1894         if (tb[NL80211_ATTR_WDEV])
1895                 state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
1896         if (tb[NL80211_ATTR_IFINDEX]) {
1897                 struct net_device *netdev;
1898                 struct cfg80211_registered_device *rdev;
1899                 int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
1900
1901                 netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
1902                 if (!netdev)
1903                         return -ENODEV;
1904                 if (netdev->ieee80211_ptr) {
1905                         rdev = wiphy_to_rdev(
1906                                 netdev->ieee80211_ptr->wiphy);
1907                         state->filter_wiphy = rdev->wiphy_idx;
1908                 }
1909         }
1910
1911         return 0;
1912 }
1913
1914 static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
1915 {
1916         int idx = 0, ret;
1917         struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
1918         struct cfg80211_registered_device *rdev;
1919
1920         rtnl_lock();
1921         if (!state) {
1922                 state = kzalloc(sizeof(*state), GFP_KERNEL);
1923                 if (!state) {
1924                         rtnl_unlock();
1925                         return -ENOMEM;
1926                 }
1927                 state->filter_wiphy = -1;
1928                 ret = nl80211_dump_wiphy_parse(skb, cb, state);
1929                 if (ret) {
1930                         kfree(state);
1931                         rtnl_unlock();
1932                         return ret;
1933                 }
1934                 cb->args[0] = (long)state;
1935         }
1936
1937         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1938                 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
1939                         continue;
1940                 if (++idx <= state->start)
1941                         continue;
1942                 if (state->filter_wiphy != -1 &&
1943                     state->filter_wiphy != rdev->wiphy_idx)
1944                         continue;
1945                 /* attempt to fit multiple wiphy data chunks into the skb */
1946                 do {
1947                         ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
1948                                                  skb,
1949                                                  NETLINK_CB(cb->skb).portid,
1950                                                  cb->nlh->nlmsg_seq,
1951                                                  NLM_F_MULTI, state);
1952                         if (ret < 0) {
1953                                 /*
1954                                  * If sending the wiphy data didn't fit (ENOBUFS
1955                                  * or EMSGSIZE returned), this SKB is still
1956                                  * empty (so it's not too big because another
1957                                  * wiphy dataset is already in the skb) and
1958                                  * we've not tried to adjust the dump allocation
1959                                  * yet ... then adjust the alloc size to be
1960                                  * bigger, and return 1 but with the empty skb.
1961                                  * This results in an empty message being RX'ed
1962                                  * in userspace, but that is ignored.
1963                                  *
1964                                  * We can then retry with the larger buffer.
1965                                  */
1966                                 if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
1967                                     !skb->len && !state->split &&
1968                                     cb->min_dump_alloc < 4096) {
1969                                         cb->min_dump_alloc = 4096;
1970                                         state->split_start = 0;
1971                                         rtnl_unlock();
1972                                         return 1;
1973                                 }
1974                                 idx--;
1975                                 break;
1976                         }
1977                 } while (state->split_start > 0);
1978                 break;
1979         }
1980         rtnl_unlock();
1981
1982         state->start = idx;
1983
1984         return skb->len;
1985 }
1986
1987 static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
1988 {
1989         kfree((void *)cb->args[0]);
1990         return 0;
1991 }
1992
1993 static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
1994 {
1995         struct sk_buff *msg;
1996         struct cfg80211_registered_device *rdev = info->user_ptr[0];
1997         struct nl80211_dump_wiphy_state state = {};
1998
1999         msg = nlmsg_new(4096, GFP_KERNEL);
2000         if (!msg)
2001                 return -ENOMEM;
2002
2003         if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
2004                                info->snd_portid, info->snd_seq, 0,
2005                                &state) < 0) {
2006                 nlmsg_free(msg);
2007                 return -ENOBUFS;
2008         }
2009
2010         return genlmsg_reply(msg, info);
2011 }
2012
2013 static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
2014         [NL80211_TXQ_ATTR_QUEUE]                = { .type = NLA_U8 },
2015         [NL80211_TXQ_ATTR_TXOP]                 = { .type = NLA_U16 },
2016         [NL80211_TXQ_ATTR_CWMIN]                = { .type = NLA_U16 },
2017         [NL80211_TXQ_ATTR_CWMAX]                = { .type = NLA_U16 },
2018         [NL80211_TXQ_ATTR_AIFS]                 = { .type = NLA_U8 },
2019 };
2020
2021 static int parse_txq_params(struct nlattr *tb[],
2022                             struct ieee80211_txq_params *txq_params)
2023 {
2024         if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
2025             !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
2026             !tb[NL80211_TXQ_ATTR_AIFS])
2027                 return -EINVAL;
2028
2029         txq_params->ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
2030         txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
2031         txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
2032         txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
2033         txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
2034
2035         if (txq_params->ac >= NL80211_NUM_ACS)
2036                 return -EINVAL;
2037
2038         return 0;
2039 }
2040
2041 static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
2042 {
2043         /*
2044          * You can only set the channel explicitly for WDS interfaces,
2045          * all others have their channel managed via their respective
2046          * "establish a connection" command (connect, join, ...)
2047          *
2048          * For AP/GO and mesh mode, the channel can be set with the
2049          * channel userspace API, but is only stored and passed to the
2050          * low-level driver when the AP starts or the mesh is joined.
2051          * This is for backward compatibility, userspace can also give
2052          * the channel in the start-ap or join-mesh commands instead.
2053          *
2054          * Monitors are special as they are normally slaved to
2055          * whatever else is going on, so they have their own special
2056          * operation to set the monitor channel if possible.
2057          */
2058         return !wdev ||
2059                 wdev->iftype == NL80211_IFTYPE_AP ||
2060                 wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
2061                 wdev->iftype == NL80211_IFTYPE_MONITOR ||
2062                 wdev->iftype == NL80211_IFTYPE_P2P_GO;
2063 }
2064
2065 static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
2066                                  struct genl_info *info,
2067                                  struct cfg80211_chan_def *chandef)
2068 {
2069         u32 control_freq;
2070
2071         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
2072                 return -EINVAL;
2073
2074         control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
2075
2076         chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
2077         chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
2078         chandef->center_freq1 = control_freq;
2079         chandef->center_freq2 = 0;
2080
2081         /* Primary channel not allowed */
2082         if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
2083                 return -EINVAL;
2084
2085         if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
2086                 enum nl80211_channel_type chantype;
2087
2088                 chantype = nla_get_u32(
2089                                 info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
2090
2091                 switch (chantype) {
2092                 case NL80211_CHAN_NO_HT:
2093                 case NL80211_CHAN_HT20:
2094                 case NL80211_CHAN_HT40PLUS:
2095                 case NL80211_CHAN_HT40MINUS:
2096                         cfg80211_chandef_create(chandef, chandef->chan,
2097                                                 chantype);
2098                         break;
2099                 default:
2100                         return -EINVAL;
2101                 }
2102         } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
2103                 chandef->width =
2104                         nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
2105                 if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
2106                         chandef->center_freq1 =
2107                                 nla_get_u32(
2108                                         info->attrs[NL80211_ATTR_CENTER_FREQ1]);
2109                 if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
2110                         chandef->center_freq2 =
2111                                 nla_get_u32(
2112                                         info->attrs[NL80211_ATTR_CENTER_FREQ2]);
2113         }
2114
2115         if (!cfg80211_chandef_valid(chandef))
2116                 return -EINVAL;
2117
2118         if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
2119                                      IEEE80211_CHAN_DISABLED))
2120                 return -EINVAL;
2121
2122         if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
2123              chandef->width == NL80211_CHAN_WIDTH_10) &&
2124             !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
2125                 return -EINVAL;
2126
2127         return 0;
2128 }
2129
2130 static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
2131                                  struct net_device *dev,
2132                                  struct genl_info *info)
2133 {
2134         struct cfg80211_chan_def chandef;
2135         int result;
2136         enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
2137         struct wireless_dev *wdev = NULL;
2138
2139         if (dev)
2140                 wdev = dev->ieee80211_ptr;
2141         if (!nl80211_can_set_dev_channel(wdev))
2142                 return -EOPNOTSUPP;
2143         if (wdev)
2144                 iftype = wdev->iftype;
2145
2146         result = nl80211_parse_chandef(rdev, info, &chandef);
2147         if (result)
2148                 return result;
2149
2150         switch (iftype) {
2151         case NL80211_IFTYPE_AP:
2152         case NL80211_IFTYPE_P2P_GO:
2153                 if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
2154                                                    iftype)) {
2155                         result = -EINVAL;
2156                         break;
2157                 }
2158                 if (wdev->beacon_interval) {
2159                         if (!dev || !rdev->ops->set_ap_chanwidth ||
2160                             !(rdev->wiphy.features &
2161                               NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
2162                                 result = -EBUSY;
2163                                 break;
2164                         }
2165
2166                         /* Only allow dynamic channel width changes */
2167                         if (chandef.chan != wdev->preset_chandef.chan) {
2168                                 result = -EBUSY;
2169                                 break;
2170                         }
2171                         result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
2172                         if (result)
2173                                 break;
2174                 }
2175                 wdev->preset_chandef = chandef;
2176                 result = 0;
2177                 break;
2178         case NL80211_IFTYPE_MESH_POINT:
2179                 result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
2180                 break;
2181         case NL80211_IFTYPE_MONITOR:
2182                 result = cfg80211_set_monitor_channel(rdev, &chandef);
2183                 break;
2184         default:
2185                 result = -EINVAL;
2186         }
2187
2188         return result;
2189 }
2190
2191 static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
2192 {
2193         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2194         struct net_device *netdev = info->user_ptr[1];
2195
2196         return __nl80211_set_channel(rdev, netdev, info);
2197 }
2198
2199 static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
2200 {
2201         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2202         struct net_device *dev = info->user_ptr[1];
2203         struct wireless_dev *wdev = dev->ieee80211_ptr;
2204         const u8 *bssid;
2205
2206         if (!info->attrs[NL80211_ATTR_MAC])
2207                 return -EINVAL;
2208
2209         if (netif_running(dev))
2210                 return -EBUSY;
2211
2212         if (!rdev->ops->set_wds_peer)
2213                 return -EOPNOTSUPP;
2214
2215         if (wdev->iftype != NL80211_IFTYPE_WDS)
2216                 return -EOPNOTSUPP;
2217
2218         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
2219         return rdev_set_wds_peer(rdev, dev, bssid);
2220 }
2221
2222 static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
2223 {
2224         struct cfg80211_registered_device *rdev;
2225         struct net_device *netdev = NULL;
2226         struct wireless_dev *wdev;
2227         int result = 0, rem_txq_params = 0;
2228         struct nlattr *nl_txq_params;
2229         u32 changed;
2230         u8 retry_short = 0, retry_long = 0;
2231         u32 frag_threshold = 0, rts_threshold = 0;
2232         u8 coverage_class = 0;
2233
2234         ASSERT_RTNL();
2235
2236         /*
2237          * Try to find the wiphy and netdev. Normally this
2238          * function shouldn't need the netdev, but this is
2239          * done for backward compatibility -- previously
2240          * setting the channel was done per wiphy, but now
2241          * it is per netdev. Previous userland like hostapd
2242          * also passed a netdev to set_wiphy, so that it is
2243          * possible to let that go to the right netdev!
2244          */
2245
2246         if (info->attrs[NL80211_ATTR_IFINDEX]) {
2247                 int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
2248
2249                 netdev = __dev_get_by_index(genl_info_net(info), ifindex);
2250                 if (netdev && netdev->ieee80211_ptr)
2251                         rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
2252                 else
2253                         netdev = NULL;
2254         }
2255
2256         if (!netdev) {
2257                 rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
2258                                                   info->attrs);
2259                 if (IS_ERR(rdev))
2260                         return PTR_ERR(rdev);
2261                 wdev = NULL;
2262                 netdev = NULL;
2263                 result = 0;
2264         } else
2265                 wdev = netdev->ieee80211_ptr;
2266
2267         /*
2268          * end workaround code, by now the rdev is available
2269          * and locked, and wdev may or may not be NULL.
2270          */
2271
2272         if (info->attrs[NL80211_ATTR_WIPHY_NAME])
2273                 result = cfg80211_dev_rename(
2274                         rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
2275
2276         if (result)
2277                 return result;
2278
2279         if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
2280                 struct ieee80211_txq_params txq_params;
2281                 struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
2282
2283                 if (!rdev->ops->set_txq_params)
2284                         return -EOPNOTSUPP;
2285
2286                 if (!netdev)
2287                         return -EINVAL;
2288
2289                 if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
2290                     netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
2291                         return -EINVAL;
2292
2293                 if (!netif_running(netdev))
2294                         return -ENETDOWN;
2295
2296                 nla_for_each_nested(nl_txq_params,
2297                                     info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
2298                                     rem_txq_params) {
2299                         result = nla_parse(tb, NL80211_TXQ_ATTR_MAX,
2300                                            nla_data(nl_txq_params),
2301                                            nla_len(nl_txq_params),
2302                                            txq_params_policy);
2303                         if (result)
2304                                 return result;
2305                         result = parse_txq_params(tb, &txq_params);
2306                         if (result)
2307                                 return result;
2308
2309                         result = rdev_set_txq_params(rdev, netdev,
2310                                                      &txq_params);
2311                         if (result)
2312                                 return result;
2313                 }
2314         }
2315
2316         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
2317                 result = __nl80211_set_channel(
2318                         rdev,
2319                         nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
2320                         info);
2321                 if (result)
2322                         return result;
2323         }
2324
2325         if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
2326                 struct wireless_dev *txp_wdev = wdev;
2327                 enum nl80211_tx_power_setting type;
2328                 int idx, mbm = 0;
2329
2330                 if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
2331                         txp_wdev = NULL;
2332
2333                 if (!rdev->ops->set_tx_power)
2334                         return -EOPNOTSUPP;
2335
2336                 idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
2337                 type = nla_get_u32(info->attrs[idx]);
2338
2339                 if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
2340                     (type != NL80211_TX_POWER_AUTOMATIC))
2341                         return -EINVAL;
2342
2343                 if (type != NL80211_TX_POWER_AUTOMATIC) {
2344                         idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
2345                         mbm = nla_get_u32(info->attrs[idx]);
2346                 }
2347
2348                 result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
2349                 if (result)
2350                         return result;
2351         }
2352
2353         if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
2354             info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
2355                 u32 tx_ant, rx_ant;
2356
2357                 if ((!rdev->wiphy.available_antennas_tx &&
2358                      !rdev->wiphy.available_antennas_rx) ||
2359                     !rdev->ops->set_antenna)
2360                         return -EOPNOTSUPP;
2361
2362                 tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
2363                 rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
2364
2365                 /* reject antenna configurations which don't match the
2366                  * available antenna masks, except for the "all" mask */
2367                 if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
2368                     (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
2369                         return -EINVAL;
2370
2371                 tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
2372                 rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
2373
2374                 result = rdev_set_antenna(rdev, tx_ant, rx_ant);
2375                 if (result)
2376                         return result;
2377         }
2378
2379         changed = 0;
2380
2381         if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
2382                 retry_short = nla_get_u8(
2383                         info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
2384                 if (retry_short == 0)
2385                         return -EINVAL;
2386
2387                 changed |= WIPHY_PARAM_RETRY_SHORT;
2388         }
2389
2390         if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
2391                 retry_long = nla_get_u8(
2392                         info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
2393                 if (retry_long == 0)
2394                         return -EINVAL;
2395
2396                 changed |= WIPHY_PARAM_RETRY_LONG;
2397         }
2398
2399         if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
2400                 frag_threshold = nla_get_u32(
2401                         info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
2402                 if (frag_threshold < 256)
2403                         return -EINVAL;
2404
2405                 if (frag_threshold != (u32) -1) {
2406                         /*
2407                          * Fragments (apart from the last one) are required to
2408                          * have even length. Make the fragmentation code
2409                          * simpler by stripping LSB should someone try to use
2410                          * odd threshold value.
2411                          */
2412                         frag_threshold &= ~0x1;
2413                 }
2414                 changed |= WIPHY_PARAM_FRAG_THRESHOLD;
2415         }
2416
2417         if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
2418                 rts_threshold = nla_get_u32(
2419                         info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
2420                 changed |= WIPHY_PARAM_RTS_THRESHOLD;
2421         }
2422
2423         if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
2424                 if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
2425                         return -EINVAL;
2426
2427                 coverage_class = nla_get_u8(
2428                         info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
2429                 changed |= WIPHY_PARAM_COVERAGE_CLASS;
2430         }
2431
2432         if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
2433                 if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
2434                         return -EOPNOTSUPP;
2435
2436                 changed |= WIPHY_PARAM_DYN_ACK;
2437         }
2438
2439         if (changed) {
2440                 u8 old_retry_short, old_retry_long;
2441                 u32 old_frag_threshold, old_rts_threshold;
2442                 u8 old_coverage_class;
2443
2444                 if (!rdev->ops->set_wiphy_params)
2445                         return -EOPNOTSUPP;
2446
2447                 old_retry_short = rdev->wiphy.retry_short;
2448                 old_retry_long = rdev->wiphy.retry_long;
2449                 old_frag_threshold = rdev->wiphy.frag_threshold;
2450                 old_rts_threshold = rdev->wiphy.rts_threshold;
2451                 old_coverage_class = rdev->wiphy.coverage_class;
2452
2453                 if (changed & WIPHY_PARAM_RETRY_SHORT)
2454                         rdev->wiphy.retry_short = retry_short;
2455                 if (changed & WIPHY_PARAM_RETRY_LONG)
2456                         rdev->wiphy.retry_long = retry_long;
2457                 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
2458                         rdev->wiphy.frag_threshold = frag_threshold;
2459                 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
2460                         rdev->wiphy.rts_threshold = rts_threshold;
2461                 if (changed & WIPHY_PARAM_COVERAGE_CLASS)
2462                         rdev->wiphy.coverage_class = coverage_class;
2463
2464                 result = rdev_set_wiphy_params(rdev, changed);
2465                 if (result) {
2466                         rdev->wiphy.retry_short = old_retry_short;
2467                         rdev->wiphy.retry_long = old_retry_long;
2468                         rdev->wiphy.frag_threshold = old_frag_threshold;
2469                         rdev->wiphy.rts_threshold = old_rts_threshold;
2470                         rdev->wiphy.coverage_class = old_coverage_class;
2471                         return result;
2472                 }
2473         }
2474         return 0;
2475 }
2476
2477 static inline u64 wdev_id(struct wireless_dev *wdev)
2478 {
2479         return (u64)wdev->identifier |
2480                ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
2481 }
2482
2483 static int nl80211_send_chandef(struct sk_buff *msg,
2484                                 const struct cfg80211_chan_def *chandef)
2485 {
2486         if (WARN_ON(!cfg80211_chandef_valid(chandef)))
2487                 return -EINVAL;
2488
2489         if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
2490                         chandef->chan->center_freq))
2491                 return -ENOBUFS;
2492         switch (chandef->width) {
2493         case NL80211_CHAN_WIDTH_20_NOHT:
2494         case NL80211_CHAN_WIDTH_20:
2495         case NL80211_CHAN_WIDTH_40:
2496                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
2497                                 cfg80211_get_chandef_type(chandef)))
2498                         return -ENOBUFS;
2499                 break;
2500         default:
2501                 break;
2502         }
2503         if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
2504                 return -ENOBUFS;
2505         if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
2506                 return -ENOBUFS;
2507         if (chandef->center_freq2 &&
2508             nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
2509                 return -ENOBUFS;
2510         return 0;
2511 }
2512
2513 static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
2514                               struct cfg80211_registered_device *rdev,
2515                               struct wireless_dev *wdev, bool removal)
2516 {
2517         struct net_device *dev = wdev->netdev;
2518         u8 cmd = NL80211_CMD_NEW_INTERFACE;
2519         void *hdr;
2520
2521         if (removal)
2522                 cmd = NL80211_CMD_DEL_INTERFACE;
2523
2524         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
2525         if (!hdr)
2526                 return -1;
2527
2528         if (dev &&
2529             (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
2530              nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
2531                 goto nla_put_failure;
2532
2533         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
2534             nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
2535             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
2536                               NL80211_ATTR_PAD) ||
2537             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
2538             nla_put_u32(msg, NL80211_ATTR_GENERATION,
2539                         rdev->devlist_generation ^
2540                         (cfg80211_rdev_list_generation << 2)))
2541                 goto nla_put_failure;
2542
2543         if (rdev->ops->get_channel) {
2544                 int ret;
2545                 struct cfg80211_chan_def chandef;
2546
2547                 ret = rdev_get_channel(rdev, wdev, &chandef);
2548                 if (ret == 0) {
2549                         if (nl80211_send_chandef(msg, &chandef))
2550                                 goto nla_put_failure;
2551                 }
2552         }
2553
2554         if (rdev->ops->get_tx_power) {
2555                 int dbm, ret;
2556
2557                 ret = rdev_get_tx_power(rdev, wdev, &dbm);
2558                 if (ret == 0 &&
2559                     nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
2560                                 DBM_TO_MBM(dbm)))
2561                         goto nla_put_failure;
2562         }
2563
2564         if (wdev->ssid_len) {
2565                 if (nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
2566                         goto nla_put_failure;
2567         }
2568
2569         genlmsg_end(msg, hdr);
2570         return 0;
2571
2572  nla_put_failure:
2573         genlmsg_cancel(msg, hdr);
2574         return -EMSGSIZE;
2575 }
2576
2577 static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
2578 {
2579         int wp_idx = 0;
2580         int if_idx = 0;
2581         int wp_start = cb->args[0];
2582         int if_start = cb->args[1];
2583         int filter_wiphy = -1;
2584         struct cfg80211_registered_device *rdev;
2585         struct wireless_dev *wdev;
2586
2587         rtnl_lock();
2588         if (!cb->args[2]) {
2589                 struct nl80211_dump_wiphy_state state = {
2590                         .filter_wiphy = -1,
2591                 };
2592                 int ret;
2593
2594                 ret = nl80211_dump_wiphy_parse(skb, cb, &state);
2595                 if (ret)
2596                         return ret;
2597
2598                 filter_wiphy = state.filter_wiphy;
2599
2600                 /*
2601                  * if filtering, set cb->args[2] to +1 since 0 is the default
2602                  * value needed to determine that parsing is necessary.
2603                  */
2604                 if (filter_wiphy >= 0)
2605                         cb->args[2] = filter_wiphy + 1;
2606                 else
2607                         cb->args[2] = -1;
2608         } else if (cb->args[2] > 0) {
2609                 filter_wiphy = cb->args[2] - 1;
2610         }
2611
2612         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
2613                 if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
2614                         continue;
2615                 if (wp_idx < wp_start) {
2616                         wp_idx++;
2617                         continue;
2618                 }
2619
2620                 if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
2621                         continue;
2622
2623                 if_idx = 0;
2624
2625                 list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
2626                         if (if_idx < if_start) {
2627                                 if_idx++;
2628                                 continue;
2629                         }
2630                         if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
2631                                                cb->nlh->nlmsg_seq, NLM_F_MULTI,
2632                                                rdev, wdev, false) < 0) {
2633                                 goto out;
2634                         }
2635                         if_idx++;
2636                 }
2637
2638                 wp_idx++;
2639         }
2640  out:
2641         rtnl_unlock();
2642
2643         cb->args[0] = wp_idx;
2644         cb->args[1] = if_idx;
2645
2646         return skb->len;
2647 }
2648
2649 static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
2650 {
2651         struct sk_buff *msg;
2652         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2653         struct wireless_dev *wdev = info->user_ptr[1];
2654
2655         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2656         if (!msg)
2657                 return -ENOMEM;
2658
2659         if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
2660                                rdev, wdev, false) < 0) {
2661                 nlmsg_free(msg);
2662                 return -ENOBUFS;
2663         }
2664
2665         return genlmsg_reply(msg, info);
2666 }
2667
2668 static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
2669         [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
2670         [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
2671         [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
2672         [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
2673         [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
2674         [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
2675 };
2676
2677 static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
2678 {
2679         struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
2680         int flag;
2681
2682         *mntrflags = 0;
2683
2684         if (!nla)
2685                 return -EINVAL;
2686
2687         if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
2688                              nla, mntr_flags_policy))
2689                 return -EINVAL;
2690
2691         for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
2692                 if (flags[flag])
2693                         *mntrflags |= (1<<flag);
2694
2695         return 0;
2696 }
2697
2698 static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
2699                                struct net_device *netdev, u8 use_4addr,
2700                                enum nl80211_iftype iftype)
2701 {
2702         if (!use_4addr) {
2703                 if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
2704                         return -EBUSY;
2705                 return 0;
2706         }
2707
2708         switch (iftype) {
2709         case NL80211_IFTYPE_AP_VLAN:
2710                 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
2711                         return 0;
2712                 break;
2713         case NL80211_IFTYPE_STATION:
2714                 if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
2715                         return 0;
2716                 break;
2717         default:
2718                 break;
2719         }
2720
2721         return -EOPNOTSUPP;
2722 }
2723
2724 static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
2725 {
2726         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2727         struct vif_params params;
2728         int err;
2729         enum nl80211_iftype otype, ntype;
2730         struct net_device *dev = info->user_ptr[1];
2731         u32 _flags, *flags = NULL;
2732         bool change = false;
2733
2734         memset(&params, 0, sizeof(params));
2735
2736         otype = ntype = dev->ieee80211_ptr->iftype;
2737
2738         if (info->attrs[NL80211_ATTR_IFTYPE]) {
2739                 ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2740                 if (otype != ntype)
2741                         change = true;
2742                 if (ntype > NL80211_IFTYPE_MAX)
2743                         return -EINVAL;
2744         }
2745
2746         if (info->attrs[NL80211_ATTR_MESH_ID]) {
2747                 struct wireless_dev *wdev = dev->ieee80211_ptr;
2748
2749                 if (ntype != NL80211_IFTYPE_MESH_POINT)
2750                         return -EINVAL;
2751                 if (netif_running(dev))
2752                         return -EBUSY;
2753
2754                 wdev_lock(wdev);
2755                 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2756                              IEEE80211_MAX_MESH_ID_LEN);
2757                 wdev->mesh_id_up_len =
2758                         nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2759                 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2760                        wdev->mesh_id_up_len);
2761                 wdev_unlock(wdev);
2762         }
2763
2764         if (info->attrs[NL80211_ATTR_4ADDR]) {
2765                 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2766                 change = true;
2767                 err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
2768                 if (err)
2769                         return err;
2770         } else {
2771                 params.use_4addr = -1;
2772         }
2773
2774         if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
2775                 if (ntype != NL80211_IFTYPE_MONITOR)
2776                         return -EINVAL;
2777                 err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
2778                                           &_flags);
2779                 if (err)
2780                         return err;
2781
2782                 flags = &_flags;
2783                 change = true;
2784         }
2785
2786         if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
2787                 const u8 *mumimo_groups;
2788                 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2789
2790                 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2791                         return -EOPNOTSUPP;
2792
2793                 mumimo_groups =
2794                         nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
2795
2796                 /* bits 0 and 63 are reserved and must be zero */
2797                 if ((mumimo_groups[0] & BIT(7)) ||
2798                     (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(0)))
2799                         return -EINVAL;
2800
2801                 memcpy(params.vht_mumimo_groups, mumimo_groups,
2802                        VHT_MUMIMO_GROUPS_DATA_LEN);
2803                 change = true;
2804         }
2805
2806         if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
2807                 u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
2808
2809                 if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
2810                         return -EOPNOTSUPP;
2811
2812                 nla_memcpy(params.macaddr,
2813                            info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR],
2814                            ETH_ALEN);
2815                 change = true;
2816         }
2817
2818         if (flags && (*flags & MONITOR_FLAG_ACTIVE) &&
2819             !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2820                 return -EOPNOTSUPP;
2821
2822         if (change)
2823                 err = cfg80211_change_iface(rdev, dev, ntype, flags, &params);
2824         else
2825                 err = 0;
2826
2827         if (!err && params.use_4addr != -1)
2828                 dev->ieee80211_ptr->use_4addr = params.use_4addr;
2829
2830         return err;
2831 }
2832
2833 static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
2834 {
2835         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2836         struct vif_params params;
2837         struct wireless_dev *wdev;
2838         struct sk_buff *msg;
2839         int err;
2840         enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
2841         u32 flags;
2842
2843         /* to avoid failing a new interface creation due to pending removal */
2844         cfg80211_destroy_ifaces(rdev);
2845
2846         memset(&params, 0, sizeof(params));
2847
2848         if (!info->attrs[NL80211_ATTR_IFNAME])
2849                 return -EINVAL;
2850
2851         if (info->attrs[NL80211_ATTR_IFTYPE]) {
2852                 type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
2853                 if (type > NL80211_IFTYPE_MAX)
2854                         return -EINVAL;
2855         }
2856
2857         if (!rdev->ops->add_virtual_intf ||
2858             !(rdev->wiphy.interface_modes & (1 << type)))
2859                 return -EOPNOTSUPP;
2860
2861         if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
2862              rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
2863             info->attrs[NL80211_ATTR_MAC]) {
2864                 nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
2865                            ETH_ALEN);
2866                 if (!is_valid_ether_addr(params.macaddr))
2867                         return -EADDRNOTAVAIL;
2868         }
2869
2870         if (info->attrs[NL80211_ATTR_4ADDR]) {
2871                 params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
2872                 err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
2873                 if (err)
2874                         return err;
2875         }
2876
2877         err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
2878                                   info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
2879                                   &flags);
2880
2881         if (!err && (flags & MONITOR_FLAG_ACTIVE) &&
2882             !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
2883                 return -EOPNOTSUPP;
2884
2885         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2886         if (!msg)
2887                 return -ENOMEM;
2888
2889         wdev = rdev_add_virtual_intf(rdev,
2890                                 nla_data(info->attrs[NL80211_ATTR_IFNAME]),
2891                                 NET_NAME_USER, type, err ? NULL : &flags,
2892                                 &params);
2893         if (WARN_ON(!wdev)) {
2894                 nlmsg_free(msg);
2895                 return -EPROTO;
2896         } else if (IS_ERR(wdev)) {
2897                 nlmsg_free(msg);
2898                 return PTR_ERR(wdev);
2899         }
2900
2901         if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
2902                 wdev->owner_nlportid = info->snd_portid;
2903
2904         switch (type) {
2905         case NL80211_IFTYPE_MESH_POINT:
2906                 if (!info->attrs[NL80211_ATTR_MESH_ID])
2907                         break;
2908                 wdev_lock(wdev);
2909                 BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
2910                              IEEE80211_MAX_MESH_ID_LEN);
2911                 wdev->mesh_id_up_len =
2912                         nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
2913                 memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
2914                        wdev->mesh_id_up_len);
2915                 wdev_unlock(wdev);
2916                 break;
2917         case NL80211_IFTYPE_NAN:
2918         case NL80211_IFTYPE_P2P_DEVICE:
2919                 /*
2920                  * P2P Device and NAN do not have a netdev, so don't go
2921                  * through the netdev notifier and must be added here
2922                  */
2923                 mutex_init(&wdev->mtx);
2924                 INIT_LIST_HEAD(&wdev->event_list);
2925                 spin_lock_init(&wdev->event_lock);
2926                 INIT_LIST_HEAD(&wdev->mgmt_registrations);
2927                 spin_lock_init(&wdev->mgmt_registrations_lock);
2928
2929                 wdev->identifier = ++rdev->wdev_id;
2930                 list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
2931                 rdev->devlist_generation++;
2932                 break;
2933         default:
2934                 break;
2935         }
2936
2937         if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
2938                                rdev, wdev, false) < 0) {
2939                 nlmsg_free(msg);
2940                 return -ENOBUFS;
2941         }
2942
2943         /*
2944          * For wdevs which have no associated netdev object (e.g. of type
2945          * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
2946          * For all other types, the event will be generated from the
2947          * netdev notifier
2948          */
2949         if (!wdev->netdev)
2950                 nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
2951
2952         return genlmsg_reply(msg, info);
2953 }
2954
2955 static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
2956 {
2957         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2958         struct wireless_dev *wdev = info->user_ptr[1];
2959
2960         if (!rdev->ops->del_virtual_intf)
2961                 return -EOPNOTSUPP;
2962
2963         /*
2964          * If we remove a wireless device without a netdev then clear
2965          * user_ptr[1] so that nl80211_post_doit won't dereference it
2966          * to check if it needs to do dev_put(). Otherwise it crashes
2967          * since the wdev has been freed, unlike with a netdev where
2968          * we need the dev_put() for the netdev to really be freed.
2969          */
2970         if (!wdev->netdev)
2971                 info->user_ptr[1] = NULL;
2972
2973         return rdev_del_virtual_intf(rdev, wdev);
2974 }
2975
2976 static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
2977 {
2978         struct cfg80211_registered_device *rdev = info->user_ptr[0];
2979         struct net_device *dev = info->user_ptr[1];
2980         u16 noack_map;
2981
2982         if (!info->attrs[NL80211_ATTR_NOACK_MAP])
2983                 return -EINVAL;
2984
2985         if (!rdev->ops->set_noack_map)
2986                 return -EOPNOTSUPP;
2987
2988         noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
2989
2990         return rdev_set_noack_map(rdev, dev, noack_map);
2991 }
2992
2993 struct get_key_cookie {
2994         struct sk_buff *msg;
2995         int error;
2996         int idx;
2997 };
2998
2999 static void get_key_callback(void *c, struct key_params *params)
3000 {
3001         struct nlattr *key;
3002         struct get_key_cookie *cookie = c;
3003
3004         if ((params->key &&
3005              nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
3006                      params->key_len, params->key)) ||
3007             (params->seq &&
3008              nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
3009                      params->seq_len, params->seq)) ||
3010             (params->cipher &&
3011              nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
3012                          params->cipher)))
3013                 goto nla_put_failure;
3014
3015         key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
3016         if (!key)
3017                 goto nla_put_failure;
3018
3019         if ((params->key &&
3020              nla_put(cookie->msg, NL80211_KEY_DATA,
3021                      params->key_len, params->key)) ||
3022             (params->seq &&
3023              nla_put(cookie->msg, NL80211_KEY_SEQ,
3024                      params->seq_len, params->seq)) ||
3025             (params->cipher &&
3026              nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
3027                          params->cipher)))
3028                 goto nla_put_failure;
3029
3030         if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
3031                 goto nla_put_failure;
3032
3033         nla_nest_end(cookie->msg, key);
3034
3035         return;
3036  nla_put_failure:
3037         cookie->error = 1;
3038 }
3039
3040 static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
3041 {
3042         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3043         int err;
3044         struct net_device *dev = info->user_ptr[1];
3045         u8 key_idx = 0;
3046         const u8 *mac_addr = NULL;
3047         bool pairwise;
3048         struct get_key_cookie cookie = {
3049                 .error = 0,
3050         };
3051         void *hdr;
3052         struct sk_buff *msg;
3053
3054         if (info->attrs[NL80211_ATTR_KEY_IDX])
3055                 key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
3056
3057         if (key_idx > 5)
3058                 return -EINVAL;
3059
3060         if (info->attrs[NL80211_ATTR_MAC])
3061                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3062
3063         pairwise = !!mac_addr;
3064         if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
3065                 u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
3066
3067                 if (kt >= NUM_NL80211_KEYTYPES)
3068                         return -EINVAL;
3069                 if (kt != NL80211_KEYTYPE_GROUP &&
3070                     kt != NL80211_KEYTYPE_PAIRWISE)
3071                         return -EINVAL;
3072                 pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
3073         }
3074
3075         if (!rdev->ops->get_key)
3076                 return -EOPNOTSUPP;
3077
3078         if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3079                 return -ENOENT;
3080
3081         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
3082         if (!msg)
3083                 return -ENOMEM;
3084
3085         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
3086                              NL80211_CMD_NEW_KEY);
3087         if (!hdr)
3088                 goto nla_put_failure;
3089
3090         cookie.msg = msg;
3091         cookie.idx = key_idx;
3092
3093         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
3094             nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
3095                 goto nla_put_failure;
3096         if (mac_addr &&
3097             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
3098                 goto nla_put_failure;
3099
3100         err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
3101                            get_key_callback);
3102
3103         if (err)
3104                 goto free_msg;
3105
3106         if (cookie.error)
3107                 goto nla_put_failure;
3108
3109         genlmsg_end(msg, hdr);
3110         return genlmsg_reply(msg, info);
3111
3112  nla_put_failure:
3113         err = -ENOBUFS;
3114  free_msg:
3115         nlmsg_free(msg);
3116         return err;
3117 }
3118
3119 static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
3120 {
3121         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3122         struct key_parse key;
3123         int err;
3124         struct net_device *dev = info->user_ptr[1];
3125
3126         err = nl80211_parse_key(info, &key);
3127         if (err)
3128                 return err;
3129
3130         if (key.idx < 0)
3131                 return -EINVAL;
3132
3133         /* only support setting default key */
3134         if (!key.def && !key.defmgmt)
3135                 return -EINVAL;
3136
3137         wdev_lock(dev->ieee80211_ptr);
3138
3139         if (key.def) {
3140                 if (!rdev->ops->set_default_key) {
3141                         err = -EOPNOTSUPP;
3142                         goto out;
3143                 }
3144
3145                 err = nl80211_key_allowed(dev->ieee80211_ptr);
3146                 if (err)
3147                         goto out;
3148
3149                 err = rdev_set_default_key(rdev, dev, key.idx,
3150                                                  key.def_uni, key.def_multi);
3151
3152                 if (err)
3153                         goto out;
3154
3155 #ifdef CONFIG_CFG80211_WEXT
3156                 dev->ieee80211_ptr->wext.default_key = key.idx;
3157 #endif
3158         } else {
3159                 if (key.def_uni || !key.def_multi) {
3160                         err = -EINVAL;
3161                         goto out;
3162                 }
3163
3164                 if (!rdev->ops->set_default_mgmt_key) {
3165                         err = -EOPNOTSUPP;
3166                         goto out;
3167                 }
3168
3169                 err = nl80211_key_allowed(dev->ieee80211_ptr);
3170                 if (err)
3171                         goto out;
3172
3173                 err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
3174                 if (err)
3175                         goto out;
3176
3177 #ifdef CONFIG_CFG80211_WEXT
3178                 dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
3179 #endif
3180         }
3181
3182  out:
3183         wdev_unlock(dev->ieee80211_ptr);
3184
3185         return err;
3186 }
3187
3188 static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
3189 {
3190         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3191         int err;
3192         struct net_device *dev = info->user_ptr[1];
3193         struct key_parse key;
3194         const u8 *mac_addr = NULL;
3195
3196         err = nl80211_parse_key(info, &key);
3197         if (err)
3198                 return err;
3199
3200         if (!key.p.key)
3201                 return -EINVAL;
3202
3203         if (info->attrs[NL80211_ATTR_MAC])
3204                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3205
3206         if (key.type == -1) {
3207                 if (mac_addr)
3208                         key.type = NL80211_KEYTYPE_PAIRWISE;
3209                 else
3210                         key.type = NL80211_KEYTYPE_GROUP;
3211         }
3212
3213         /* for now */
3214         if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3215             key.type != NL80211_KEYTYPE_GROUP)
3216                 return -EINVAL;
3217
3218         if (!rdev->ops->add_key)
3219                 return -EOPNOTSUPP;
3220
3221         if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
3222                                            key.type == NL80211_KEYTYPE_PAIRWISE,
3223                                            mac_addr))
3224                 return -EINVAL;
3225
3226         wdev_lock(dev->ieee80211_ptr);
3227         err = nl80211_key_allowed(dev->ieee80211_ptr);
3228         if (!err)
3229                 err = rdev_add_key(rdev, dev, key.idx,
3230                                    key.type == NL80211_KEYTYPE_PAIRWISE,
3231                                     mac_addr, &key.p);
3232         wdev_unlock(dev->ieee80211_ptr);
3233
3234         return err;
3235 }
3236
3237 static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
3238 {
3239         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3240         int err;
3241         struct net_device *dev = info->user_ptr[1];
3242         u8 *mac_addr = NULL;
3243         struct key_parse key;
3244
3245         err = nl80211_parse_key(info, &key);
3246         if (err)
3247                 return err;
3248
3249         if (info->attrs[NL80211_ATTR_MAC])
3250                 mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
3251
3252         if (key.type == -1) {
3253                 if (mac_addr)
3254                         key.type = NL80211_KEYTYPE_PAIRWISE;
3255                 else
3256                         key.type = NL80211_KEYTYPE_GROUP;
3257         }
3258
3259         /* for now */
3260         if (key.type != NL80211_KEYTYPE_PAIRWISE &&
3261             key.type != NL80211_KEYTYPE_GROUP)
3262                 return -EINVAL;
3263
3264         if (!rdev->ops->del_key)
3265                 return -EOPNOTSUPP;
3266
3267         wdev_lock(dev->ieee80211_ptr);
3268         err = nl80211_key_allowed(dev->ieee80211_ptr);
3269
3270         if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
3271             !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
3272                 err = -ENOENT;
3273
3274         if (!err)
3275                 err = rdev_del_key(rdev, dev, key.idx,
3276                                    key.type == NL80211_KEYTYPE_PAIRWISE,
3277                                    mac_addr);
3278
3279 #ifdef CONFIG_CFG80211_WEXT
3280         if (!err) {
3281                 if (key.idx == dev->ieee80211_ptr->wext.default_key)
3282                         dev->ieee80211_ptr->wext.default_key = -1;
3283                 else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
3284                         dev->ieee80211_ptr->wext.default_mgmt_key = -1;
3285         }
3286 #endif
3287         wdev_unlock(dev->ieee80211_ptr);
3288
3289         return err;
3290 }
3291
3292 /* This function returns an error or the number of nested attributes */
3293 static int validate_acl_mac_addrs(struct nlattr *nl_attr)
3294 {
3295         struct nlattr *attr;
3296         int n_entries = 0, tmp;
3297
3298         nla_for_each_nested(attr, nl_attr, tmp) {
3299                 if (nla_len(attr) != ETH_ALEN)
3300                         return -EINVAL;
3301
3302                 n_entries++;
3303         }
3304
3305         return n_entries;
3306 }
3307
3308 /*
3309  * This function parses ACL information and allocates memory for ACL data.
3310  * On successful return, the calling function is responsible to free the
3311  * ACL buffer returned by this function.
3312  */
3313 static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
3314                                                 struct genl_info *info)
3315 {
3316         enum nl80211_acl_policy acl_policy;
3317         struct nlattr *attr;
3318         struct cfg80211_acl_data *acl;
3319         int i = 0, n_entries, tmp;
3320
3321         if (!wiphy->max_acl_mac_addrs)
3322                 return ERR_PTR(-EOPNOTSUPP);
3323
3324         if (!info->attrs[NL80211_ATTR_ACL_POLICY])
3325                 return ERR_PTR(-EINVAL);
3326
3327         acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
3328         if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
3329             acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
3330                 return ERR_PTR(-EINVAL);
3331
3332         if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
3333                 return ERR_PTR(-EINVAL);
3334
3335         n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
3336         if (n_entries < 0)
3337                 return ERR_PTR(n_entries);
3338
3339         if (n_entries > wiphy->max_acl_mac_addrs)
3340                 return ERR_PTR(-ENOTSUPP);
3341
3342         acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
3343                       GFP_KERNEL);
3344         if (!acl)
3345                 return ERR_PTR(-ENOMEM);
3346
3347         nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
3348                 memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
3349                 i++;
3350         }
3351
3352         acl->n_acl_entries = n_entries;
3353         acl->acl_policy = acl_policy;
3354
3355         return acl;
3356 }
3357
3358 static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
3359 {
3360         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3361         struct net_device *dev = info->user_ptr[1];
3362         struct cfg80211_acl_data *acl;
3363         int err;
3364
3365         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3366             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3367                 return -EOPNOTSUPP;
3368
3369         if (!dev->ieee80211_ptr->beacon_interval)
3370                 return -EINVAL;
3371
3372         acl = parse_acl_data(&rdev->wiphy, info);
3373         if (IS_ERR(acl))
3374                 return PTR_ERR(acl);
3375
3376         err = rdev_set_mac_acl(rdev, dev, acl);
3377
3378         kfree(acl);
3379
3380         return err;
3381 }
3382
3383 static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
3384                            u8 *rates, u8 rates_len)
3385 {
3386         u8 i;
3387         u32 mask = 0;
3388
3389         for (i = 0; i < rates_len; i++) {
3390                 int rate = (rates[i] & 0x7f) * 5;
3391                 int ridx;
3392
3393                 for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
3394                         struct ieee80211_rate *srate =
3395                                 &sband->bitrates[ridx];
3396                         if (rate == srate->bitrate) {
3397                                 mask |= 1 << ridx;
3398                                 break;
3399                         }
3400                 }
3401                 if (ridx == sband->n_bitrates)
3402                         return 0; /* rate not found */
3403         }
3404
3405         return mask;
3406 }
3407
3408 static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
3409                                u8 *rates, u8 rates_len,
3410                                u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
3411 {
3412         u8 i;
3413
3414         memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
3415
3416         for (i = 0; i < rates_len; i++) {
3417                 int ridx, rbit;
3418
3419                 ridx = rates[i] / 8;
3420                 rbit = BIT(rates[i] % 8);
3421
3422                 /* check validity */
3423                 if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
3424                         return false;
3425
3426                 /* check availability */
3427                 if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
3428                         mcs[ridx] |= rbit;
3429                 else
3430                         return false;
3431         }
3432
3433         return true;
3434 }
3435
3436 static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
3437 {
3438         u16 mcs_mask = 0;
3439
3440         switch (vht_mcs_map) {
3441         case IEEE80211_VHT_MCS_NOT_SUPPORTED:
3442                 break;
3443         case IEEE80211_VHT_MCS_SUPPORT_0_7:
3444                 mcs_mask = 0x00FF;
3445                 break;
3446         case IEEE80211_VHT_MCS_SUPPORT_0_8:
3447                 mcs_mask = 0x01FF;
3448                 break;
3449         case IEEE80211_VHT_MCS_SUPPORT_0_9:
3450                 mcs_mask = 0x03FF;
3451                 break;
3452         default:
3453                 break;
3454         }
3455
3456         return mcs_mask;
3457 }
3458
3459 static void vht_build_mcs_mask(u16 vht_mcs_map,
3460                                u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
3461 {
3462         u8 nss;
3463
3464         for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
3465                 vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
3466                 vht_mcs_map >>= 2;
3467         }
3468 }
3469
3470 static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
3471                              struct nl80211_txrate_vht *txrate,
3472                              u16 mcs[NL80211_VHT_NSS_MAX])
3473 {
3474         u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3475         u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
3476         u8 i;
3477
3478         if (!sband->vht_cap.vht_supported)
3479                 return false;
3480
3481         memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
3482
3483         /* Build vht_mcs_mask from VHT capabilities */
3484         vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
3485
3486         for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3487                 if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
3488                         mcs[i] = txrate->mcs[i];
3489                 else
3490                         return false;
3491         }
3492
3493         return true;
3494 }
3495
3496 static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
3497         [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
3498                                     .len = NL80211_MAX_SUPP_RATES },
3499         [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
3500                                 .len = NL80211_MAX_SUPP_HT_RATES },
3501         [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
3502         [NL80211_TXRATE_GI] = { .type = NLA_U8 },
3503 };
3504
3505 static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
3506                                          struct cfg80211_bitrate_mask *mask)
3507 {
3508         struct nlattr *tb[NL80211_TXRATE_MAX + 1];
3509         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3510         int rem, i;
3511         struct nlattr *tx_rates;
3512         struct ieee80211_supported_band *sband;
3513         u16 vht_tx_mcs_map;
3514
3515         memset(mask, 0, sizeof(*mask));
3516         /* Default to all rates enabled */
3517         for (i = 0; i < NUM_NL80211_BANDS; i++) {
3518                 sband = rdev->wiphy.bands[i];
3519
3520                 if (!sband)
3521                         continue;
3522
3523                 mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
3524                 memcpy(mask->control[i].ht_mcs,
3525                        sband->ht_cap.mcs.rx_mask,
3526                        sizeof(mask->control[i].ht_mcs));
3527
3528                 if (!sband->vht_cap.vht_supported)
3529                         continue;
3530
3531                 vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
3532                 vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
3533         }
3534
3535         /* if no rates are given set it back to the defaults */
3536         if (!info->attrs[NL80211_ATTR_TX_RATES])
3537                 goto out;
3538
3539         /* The nested attribute uses enum nl80211_band as the index. This maps
3540          * directly to the enum nl80211_band values used in cfg80211.
3541          */
3542         BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
3543         nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
3544                 enum nl80211_band band = nla_type(tx_rates);
3545                 int err;
3546
3547                 if (band < 0 || band >= NUM_NL80211_BANDS)
3548                         return -EINVAL;
3549                 sband = rdev->wiphy.bands[band];
3550                 if (sband == NULL)
3551                         return -EINVAL;
3552                 err = nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
3553                                 nla_len(tx_rates), nl80211_txattr_policy);
3554                 if (err)
3555                         return err;
3556                 if (tb[NL80211_TXRATE_LEGACY]) {
3557                         mask->control[band].legacy = rateset_to_mask(
3558                                 sband,
3559                                 nla_data(tb[NL80211_TXRATE_LEGACY]),
3560                                 nla_len(tb[NL80211_TXRATE_LEGACY]));
3561                         if ((mask->control[band].legacy == 0) &&
3562                             nla_len(tb[NL80211_TXRATE_LEGACY]))
3563                                 return -EINVAL;
3564                 }
3565                 if (tb[NL80211_TXRATE_HT]) {
3566                         if (!ht_rateset_to_mask(
3567                                         sband,
3568                                         nla_data(tb[NL80211_TXRATE_HT]),
3569                                         nla_len(tb[NL80211_TXRATE_HT]),
3570                                         mask->control[band].ht_mcs))
3571                                 return -EINVAL;
3572                 }
3573                 if (tb[NL80211_TXRATE_VHT]) {
3574                         if (!vht_set_mcs_mask(
3575                                         sband,
3576                                         nla_data(tb[NL80211_TXRATE_VHT]),
3577                                         mask->control[band].vht_mcs))
3578                                 return -EINVAL;
3579                 }
3580                 if (tb[NL80211_TXRATE_GI]) {
3581                         mask->control[band].gi =
3582                                 nla_get_u8(tb[NL80211_TXRATE_GI]);
3583                         if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
3584                                 return -EINVAL;
3585                 }
3586
3587                 if (mask->control[band].legacy == 0) {
3588                         /* don't allow empty legacy rates if HT or VHT
3589                          * are not even supported.
3590                          */
3591                         if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
3592                               rdev->wiphy.bands[band]->vht_cap.vht_supported))
3593                                 return -EINVAL;
3594
3595                         for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
3596                                 if (mask->control[band].ht_mcs[i])
3597                                         goto out;
3598
3599                         for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
3600                                 if (mask->control[band].vht_mcs[i])
3601                                         goto out;
3602
3603                         /* legacy and mcs rates may not be both empty */
3604                         return -EINVAL;
3605                 }
3606         }
3607
3608 out:
3609         return 0;
3610 }
3611
3612 static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
3613                                    enum nl80211_band band,
3614                                    struct cfg80211_bitrate_mask *beacon_rate)
3615 {
3616         u32 count_ht, count_vht, i;
3617         u32 rate = beacon_rate->control[band].legacy;
3618
3619         /* Allow only one rate */
3620         if (hweight32(rate) > 1)
3621                 return -EINVAL;
3622
3623         count_ht = 0;
3624         for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
3625                 if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
3626                         return -EINVAL;
3627                 } else if (beacon_rate->control[band].ht_mcs[i]) {
3628                         count_ht++;
3629                         if (count_ht > 1)
3630                                 return -EINVAL;
3631                 }
3632                 if (count_ht && rate)
3633                         return -EINVAL;
3634         }
3635
3636         count_vht = 0;
3637         for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
3638                 if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
3639                         return -EINVAL;
3640                 } else if (beacon_rate->control[band].vht_mcs[i]) {
3641                         count_vht++;
3642                         if (count_vht > 1)
3643                                 return -EINVAL;
3644                 }
3645                 if (count_vht && rate)
3646                         return -EINVAL;
3647         }
3648
3649         if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
3650                 return -EINVAL;
3651
3652         if (rate &&
3653             !wiphy_ext_feature_isset(&rdev->wiphy,
3654                                      NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
3655                 return -EINVAL;
3656         if (count_ht &&
3657             !wiphy_ext_feature_isset(&rdev->wiphy,
3658                                      NL80211_EXT_FEATURE_BEACON_RATE_HT))
3659                 return -EINVAL;
3660         if (count_vht &&
3661             !wiphy_ext_feature_isset(&rdev->wiphy,
3662                                      NL80211_EXT_FEATURE_BEACON_RATE_VHT))
3663                 return -EINVAL;
3664
3665         return 0;
3666 }
3667
3668 static int nl80211_parse_beacon(struct nlattr *attrs[],
3669                                 struct cfg80211_beacon_data *bcn)
3670 {
3671         bool haveinfo = false;
3672
3673         if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
3674             !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
3675             !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
3676             !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
3677                 return -EINVAL;
3678
3679         memset(bcn, 0, sizeof(*bcn));
3680
3681         if (attrs[NL80211_ATTR_BEACON_HEAD]) {
3682                 bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
3683                 bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
3684                 if (!bcn->head_len)
3685                         return -EINVAL;
3686                 haveinfo = true;
3687         }
3688
3689         if (attrs[NL80211_ATTR_BEACON_TAIL]) {
3690                 bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
3691                 bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
3692                 haveinfo = true;
3693         }
3694
3695         if (!haveinfo)
3696                 return -EINVAL;
3697
3698         if (attrs[NL80211_ATTR_IE]) {
3699                 bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
3700                 bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
3701         }
3702
3703         if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
3704                 bcn->proberesp_ies =
3705                         nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3706                 bcn->proberesp_ies_len =
3707                         nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
3708         }
3709
3710         if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
3711                 bcn->assocresp_ies =
3712                         nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3713                 bcn->assocresp_ies_len =
3714                         nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
3715         }
3716
3717         if (attrs[NL80211_ATTR_PROBE_RESP]) {
3718                 bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
3719                 bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
3720         }
3721
3722         return 0;
3723 }
3724
3725 static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
3726                                    struct cfg80211_ap_settings *params)
3727 {
3728         struct wireless_dev *wdev;
3729         bool ret = false;
3730
3731         list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
3732                 if (wdev->iftype != NL80211_IFTYPE_AP &&
3733                     wdev->iftype != NL80211_IFTYPE_P2P_GO)
3734                         continue;
3735
3736                 if (!wdev->preset_chandef.chan)
3737                         continue;
3738
3739                 params->chandef = wdev->preset_chandef;
3740                 ret = true;
3741                 break;
3742         }
3743
3744         return ret;
3745 }
3746
3747 static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
3748                                     enum nl80211_auth_type auth_type,
3749                                     enum nl80211_commands cmd)
3750 {
3751         if (auth_type > NL80211_AUTHTYPE_MAX)
3752                 return false;
3753
3754         switch (cmd) {
3755         case NL80211_CMD_AUTHENTICATE:
3756                 if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
3757                     auth_type == NL80211_AUTHTYPE_SAE)
3758                         return false;
3759                 return true;
3760         case NL80211_CMD_CONNECT:
3761         case NL80211_CMD_START_AP:
3762                 /* SAE not supported yet */
3763                 if (auth_type == NL80211_AUTHTYPE_SAE)
3764                         return false;
3765                 return true;
3766         default:
3767                 return false;
3768         }
3769 }
3770
3771 static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
3772 {
3773         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3774         struct net_device *dev = info->user_ptr[1];
3775         struct wireless_dev *wdev = dev->ieee80211_ptr;
3776         struct cfg80211_ap_settings params;
3777         int err;
3778
3779         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3780             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3781                 return -EOPNOTSUPP;
3782
3783         if (!rdev->ops->start_ap)
3784                 return -EOPNOTSUPP;
3785
3786         if (wdev->beacon_interval)
3787                 return -EALREADY;
3788
3789         memset(&params, 0, sizeof(params));
3790
3791         /* these are required for START_AP */
3792         if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
3793             !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
3794             !info->attrs[NL80211_ATTR_BEACON_HEAD])
3795                 return -EINVAL;
3796
3797         err = nl80211_parse_beacon(info->attrs, &params.beacon);
3798         if (err)
3799                 return err;
3800
3801         params.beacon_interval =
3802                 nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
3803         params.dtim_period =
3804                 nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
3805
3806         err = cfg80211_validate_beacon_int(rdev, params.beacon_interval);
3807         if (err)
3808                 return err;
3809
3810         /*
3811          * In theory, some of these attributes should be required here
3812          * but since they were not used when the command was originally
3813          * added, keep them optional for old user space programs to let
3814          * them continue to work with drivers that do not need the
3815          * additional information -- drivers must check!
3816          */
3817         if (info->attrs[NL80211_ATTR_SSID]) {
3818                 params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
3819                 params.ssid_len =
3820                         nla_len(info->attrs[NL80211_ATTR_SSID]);
3821                 if (params.ssid_len == 0 ||
3822                     params.ssid_len > IEEE80211_MAX_SSID_LEN)
3823                         return -EINVAL;
3824         }
3825
3826         if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
3827                 params.hidden_ssid = nla_get_u32(
3828                         info->attrs[NL80211_ATTR_HIDDEN_SSID]);
3829                 if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
3830                     params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
3831                     params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
3832                         return -EINVAL;
3833         }
3834
3835         params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
3836
3837         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
3838                 params.auth_type = nla_get_u32(
3839                         info->attrs[NL80211_ATTR_AUTH_TYPE]);
3840                 if (!nl80211_valid_auth_type(rdev, params.auth_type,
3841                                              NL80211_CMD_START_AP))
3842                         return -EINVAL;
3843         } else
3844                 params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
3845
3846         err = nl80211_crypto_settings(rdev, info, &params.crypto,
3847                                       NL80211_MAX_NR_CIPHER_SUITES);
3848         if (err)
3849                 return err;
3850
3851         if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
3852                 if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
3853                         return -EOPNOTSUPP;
3854                 params.inactivity_timeout = nla_get_u16(
3855                         info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
3856         }
3857
3858         if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
3859                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3860                         return -EINVAL;
3861                 params.p2p_ctwindow =
3862                         nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
3863                 if (params.p2p_ctwindow > 127)
3864                         return -EINVAL;
3865                 if (params.p2p_ctwindow != 0 &&
3866                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
3867                         return -EINVAL;
3868         }
3869
3870         if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
3871                 u8 tmp;
3872
3873                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3874                         return -EINVAL;
3875                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
3876                 if (tmp > 1)
3877                         return -EINVAL;
3878                 params.p2p_opp_ps = tmp;
3879                 if (params.p2p_opp_ps != 0 &&
3880                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
3881                         return -EINVAL;
3882         }
3883
3884         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
3885                 err = nl80211_parse_chandef(rdev, info, &params.chandef);
3886                 if (err)
3887                         return err;
3888         } else if (wdev->preset_chandef.chan) {
3889                 params.chandef = wdev->preset_chandef;
3890         } else if (!nl80211_get_ap_channel(rdev, &params))
3891                 return -EINVAL;
3892
3893         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
3894                                            wdev->iftype))
3895                 return -EINVAL;
3896
3897         if (info->attrs[NL80211_ATTR_TX_RATES]) {
3898                 err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
3899                 if (err)
3900                         return err;
3901
3902                 err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
3903                                               &params.beacon_rate);
3904                 if (err)
3905                         return err;
3906         }
3907
3908         if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
3909                 params.smps_mode =
3910                         nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
3911                 switch (params.smps_mode) {
3912                 case NL80211_SMPS_OFF:
3913                         break;
3914                 case NL80211_SMPS_STATIC:
3915                         if (!(rdev->wiphy.features &
3916                               NL80211_FEATURE_STATIC_SMPS))
3917                                 return -EINVAL;
3918                         break;
3919                 case NL80211_SMPS_DYNAMIC:
3920                         if (!(rdev->wiphy.features &
3921                               NL80211_FEATURE_DYNAMIC_SMPS))
3922                                 return -EINVAL;
3923                         break;
3924                 default:
3925                         return -EINVAL;
3926                 }
3927         } else {
3928                 params.smps_mode = NL80211_SMPS_OFF;
3929         }
3930
3931         params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
3932         if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
3933                 return -EOPNOTSUPP;
3934
3935         if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
3936                 params.acl = parse_acl_data(&rdev->wiphy, info);
3937                 if (IS_ERR(params.acl))
3938                         return PTR_ERR(params.acl);
3939         }
3940
3941         wdev_lock(wdev);
3942         err = rdev_start_ap(rdev, dev, &params);
3943         if (!err) {
3944                 wdev->preset_chandef = params.chandef;
3945                 wdev->beacon_interval = params.beacon_interval;
3946                 wdev->chandef = params.chandef;
3947                 wdev->ssid_len = params.ssid_len;
3948                 memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
3949         }
3950         wdev_unlock(wdev);
3951
3952         kfree(params.acl);
3953
3954         return err;
3955 }
3956
3957 static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
3958 {
3959         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3960         struct net_device *dev = info->user_ptr[1];
3961         struct wireless_dev *wdev = dev->ieee80211_ptr;
3962         struct cfg80211_beacon_data params;
3963         int err;
3964
3965         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
3966             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
3967                 return -EOPNOTSUPP;
3968
3969         if (!rdev->ops->change_beacon)
3970                 return -EOPNOTSUPP;
3971
3972         if (!wdev->beacon_interval)
3973                 return -EINVAL;
3974
3975         err = nl80211_parse_beacon(info->attrs, &params);
3976         if (err)
3977                 return err;
3978
3979         wdev_lock(wdev);
3980         err = rdev_change_beacon(rdev, dev, &params);
3981         wdev_unlock(wdev);
3982
3983         return err;
3984 }
3985
3986 static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
3987 {
3988         struct cfg80211_registered_device *rdev = info->user_ptr[0];
3989         struct net_device *dev = info->user_ptr[1];
3990
3991         return cfg80211_stop_ap(rdev, dev, false);
3992 }
3993
3994 static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
3995         [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
3996         [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
3997         [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
3998         [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
3999         [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
4000         [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
4001 };
4002
4003 static int parse_station_flags(struct genl_info *info,
4004                                enum nl80211_iftype iftype,
4005                                struct station_parameters *params)
4006 {
4007         struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
4008         struct nlattr *nla;
4009         int flag;
4010
4011         /*
4012          * Try parsing the new attribute first so userspace
4013          * can specify both for older kernels.
4014          */
4015         nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
4016         if (nla) {
4017                 struct nl80211_sta_flag_update *sta_flags;
4018
4019                 sta_flags = nla_data(nla);
4020                 params->sta_flags_mask = sta_flags->mask;
4021                 params->sta_flags_set = sta_flags->set;
4022                 params->sta_flags_set &= params->sta_flags_mask;
4023                 if ((params->sta_flags_mask |
4024                      params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
4025                         return -EINVAL;
4026                 return 0;
4027         }
4028
4029         /* if present, parse the old attribute */
4030
4031         nla = info->attrs[NL80211_ATTR_STA_FLAGS];
4032         if (!nla)
4033                 return 0;
4034
4035         if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
4036                              nla, sta_flags_policy))
4037                 return -EINVAL;
4038
4039         /*
4040          * Only allow certain flags for interface types so that
4041          * other attributes are silently ignored. Remember that
4042          * this is backward compatibility code with old userspace
4043          * and shouldn't be hit in other cases anyway.
4044          */
4045         switch (iftype) {
4046         case NL80211_IFTYPE_AP:
4047         case NL80211_IFTYPE_AP_VLAN:
4048         case NL80211_IFTYPE_P2P_GO:
4049                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4050                                          BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4051                                          BIT(NL80211_STA_FLAG_WME) |
4052                                          BIT(NL80211_STA_FLAG_MFP);
4053                 break;
4054         case NL80211_IFTYPE_P2P_CLIENT:
4055         case NL80211_IFTYPE_STATION:
4056                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
4057                                          BIT(NL80211_STA_FLAG_TDLS_PEER);
4058                 break;
4059         case NL80211_IFTYPE_MESH_POINT:
4060                 params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4061                                          BIT(NL80211_STA_FLAG_MFP) |
4062                                          BIT(NL80211_STA_FLAG_AUTHORIZED);
4063         default:
4064                 return -EINVAL;
4065         }
4066
4067         for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
4068                 if (flags[flag]) {
4069                         params->sta_flags_set |= (1<<flag);
4070
4071                         /* no longer support new API additions in old API */
4072                         if (flag > NL80211_STA_FLAG_MAX_OLD_API)
4073                                 return -EINVAL;
4074                 }
4075         }
4076
4077         return 0;
4078 }
4079
4080 static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
4081                                  int attr)
4082 {
4083         struct nlattr *rate;
4084         u32 bitrate;
4085         u16 bitrate_compat;
4086         enum nl80211_attrs rate_flg;
4087
4088         rate = nla_nest_start(msg, attr);
4089         if (!rate)
4090                 return false;
4091
4092         /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
4093         bitrate = cfg80211_calculate_bitrate(info);
4094         /* report 16-bit bitrate only if we can */
4095         bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
4096         if (bitrate > 0 &&
4097             nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
4098                 return false;
4099         if (bitrate_compat > 0 &&
4100             nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
4101                 return false;
4102
4103         switch (info->bw) {
4104         case RATE_INFO_BW_5:
4105                 rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
4106                 break;
4107         case RATE_INFO_BW_10:
4108                 rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
4109                 break;
4110         default:
4111                 WARN_ON(1);
4112                 /* fall through */
4113         case RATE_INFO_BW_20:
4114                 rate_flg = 0;
4115                 break;
4116         case RATE_INFO_BW_40:
4117                 rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
4118                 break;
4119         case RATE_INFO_BW_80:
4120                 rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
4121                 break;
4122         case RATE_INFO_BW_160:
4123                 rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
4124                 break;
4125         }
4126
4127         if (rate_flg && nla_put_flag(msg, rate_flg))
4128                 return false;
4129
4130         if (info->flags & RATE_INFO_FLAGS_MCS) {
4131                 if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
4132                         return false;
4133                 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4134                     nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4135                         return false;
4136         } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
4137                 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
4138                         return false;
4139                 if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
4140                         return false;
4141                 if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
4142                     nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
4143                         return false;
4144         }
4145
4146         nla_nest_end(msg, rate);
4147         return true;
4148 }
4149
4150 static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
4151                                int id)
4152 {
4153         void *attr;
4154         int i = 0;
4155
4156         if (!mask)
4157                 return true;
4158
4159         attr = nla_nest_start(msg, id);
4160         if (!attr)
4161                 return false;
4162
4163         for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
4164                 if (!(mask & BIT(i)))
4165                         continue;
4166
4167                 if (nla_put_u8(msg, i, signal[i]))
4168                         return false;
4169         }
4170
4171         nla_nest_end(msg, attr);
4172
4173         return true;
4174 }
4175
4176 static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
4177                                 u32 seq, int flags,
4178                                 struct cfg80211_registered_device *rdev,
4179                                 struct net_device *dev,
4180                                 const u8 *mac_addr, struct station_info *sinfo)
4181 {
4182         void *hdr;
4183         struct nlattr *sinfoattr, *bss_param;
4184
4185         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
4186         if (!hdr)
4187                 return -1;
4188
4189         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
4190             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
4191             nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
4192                 goto nla_put_failure;
4193
4194         sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
4195         if (!sinfoattr)
4196                 goto nla_put_failure;
4197
4198 #define PUT_SINFO(attr, memb, type) do {                                \
4199         BUILD_BUG_ON(sizeof(type) == sizeof(u64));                      \
4200         if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) &&      \
4201             nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr,            \
4202                              sinfo->memb))                              \
4203                 goto nla_put_failure;                                   \
4204         } while (0)
4205 #define PUT_SINFO_U64(attr, memb) do {                                  \
4206         if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) &&      \
4207             nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr,           \
4208                               sinfo->memb, NL80211_STA_INFO_PAD))       \
4209                 goto nla_put_failure;                                   \
4210         } while (0)
4211
4212         PUT_SINFO(CONNECTED_TIME, connected_time, u32);
4213         PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
4214
4215         if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
4216                              BIT(NL80211_STA_INFO_RX_BYTES64)) &&
4217             nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
4218                         (u32)sinfo->rx_bytes))
4219                 goto nla_put_failure;
4220
4221         if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
4222                              BIT(NL80211_STA_INFO_TX_BYTES64)) &&
4223             nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
4224                         (u32)sinfo->tx_bytes))
4225                 goto nla_put_failure;
4226
4227         PUT_SINFO_U64(RX_BYTES64, rx_bytes);
4228         PUT_SINFO_U64(TX_BYTES64, tx_bytes);
4229         PUT_SINFO(LLID, llid, u16);
4230         PUT_SINFO(PLID, plid, u16);
4231         PUT_SINFO(PLINK_STATE, plink_state, u8);
4232         PUT_SINFO_U64(RX_DURATION, rx_duration);
4233
4234         switch (rdev->wiphy.signal_type) {
4235         case CFG80211_SIGNAL_TYPE_MBM:
4236                 PUT_SINFO(SIGNAL, signal, u8);
4237                 PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
4238                 break;
4239         default:
4240                 break;
4241         }
4242         if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
4243                 if (!nl80211_put_signal(msg, sinfo->chains,
4244                                         sinfo->chain_signal,
4245                                         NL80211_STA_INFO_CHAIN_SIGNAL))
4246                         goto nla_put_failure;
4247         }
4248         if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
4249                 if (!nl80211_put_signal(msg, sinfo->chains,
4250                                         sinfo->chain_signal_avg,
4251                                         NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
4252                         goto nla_put_failure;
4253         }
4254         if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
4255                 if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
4256                                           NL80211_STA_INFO_TX_BITRATE))
4257                         goto nla_put_failure;
4258         }
4259         if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
4260                 if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
4261                                           NL80211_STA_INFO_RX_BITRATE))
4262                         goto nla_put_failure;
4263         }
4264
4265         PUT_SINFO(RX_PACKETS, rx_packets, u32);
4266         PUT_SINFO(TX_PACKETS, tx_packets, u32);
4267         PUT_SINFO(TX_RETRIES, tx_retries, u32);
4268         PUT_SINFO(TX_FAILED, tx_failed, u32);
4269         PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
4270         PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
4271         PUT_SINFO(LOCAL_PM, local_pm, u32);
4272         PUT_SINFO(PEER_PM, peer_pm, u32);
4273         PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
4274
4275         if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
4276                 bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
4277                 if (!bss_param)
4278                         goto nla_put_failure;
4279
4280                 if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
4281                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
4282                     ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
4283                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
4284                     ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
4285                      nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
4286                     nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
4287                                sinfo->bss_param.dtim_period) ||
4288                     nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
4289                                 sinfo->bss_param.beacon_interval))
4290                         goto nla_put_failure;
4291
4292                 nla_nest_end(msg, bss_param);
4293         }
4294         if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
4295             nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
4296                     sizeof(struct nl80211_sta_flag_update),
4297                     &sinfo->sta_flags))
4298                 goto nla_put_failure;
4299
4300         PUT_SINFO_U64(T_OFFSET, t_offset);
4301         PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
4302         PUT_SINFO_U64(BEACON_RX, rx_beacon);
4303         PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
4304
4305 #undef PUT_SINFO
4306 #undef PUT_SINFO_U64
4307
4308         if (sinfo->filled & BIT(NL80211_STA_INFO_TID_STATS)) {
4309                 struct nlattr *tidsattr;
4310                 int tid;
4311
4312                 tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
4313                 if (!tidsattr)
4314                         goto nla_put_failure;
4315
4316                 for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
4317                         struct cfg80211_tid_stats *tidstats;
4318                         struct nlattr *tidattr;
4319
4320                         tidstats = &sinfo->pertid[tid];
4321
4322                         if (!tidstats->filled)
4323                                 continue;
4324
4325                         tidattr = nla_nest_start(msg, tid + 1);
4326                         if (!tidattr)
4327                                 goto nla_put_failure;
4328
4329 #define PUT_TIDVAL_U64(attr, memb) do {                                 \
4330         if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) &&       \
4331             nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr,          \
4332                               tidstats->memb, NL80211_TID_STATS_PAD))   \
4333                 goto nla_put_failure;                                   \
4334         } while (0)
4335
4336                         PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
4337                         PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
4338                         PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
4339                         PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
4340
4341 #undef PUT_TIDVAL_U64
4342                         nla_nest_end(msg, tidattr);
4343                 }
4344
4345                 nla_nest_end(msg, tidsattr);
4346         }
4347
4348         nla_nest_end(msg, sinfoattr);
4349
4350         if (sinfo->assoc_req_ies_len &&
4351             nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
4352                     sinfo->assoc_req_ies))
4353                 goto nla_put_failure;
4354
4355         genlmsg_end(msg, hdr);
4356         return 0;
4357
4358  nla_put_failure:
4359         genlmsg_cancel(msg, hdr);
4360         return -EMSGSIZE;
4361 }
4362
4363 static int nl80211_dump_station(struct sk_buff *skb,
4364                                 struct netlink_callback *cb)
4365 {
4366         struct station_info sinfo;
4367         struct cfg80211_registered_device *rdev;
4368         struct wireless_dev *wdev;
4369         u8 mac_addr[ETH_ALEN];
4370         int sta_idx = cb->args[2];
4371         int err;
4372
4373         err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
4374         if (err)
4375                 return err;
4376
4377         if (!wdev->netdev) {
4378                 err = -EINVAL;
4379                 goto out_err;
4380         }
4381
4382         if (!rdev->ops->dump_station) {
4383                 err = -EOPNOTSUPP;
4384                 goto out_err;
4385         }
4386
4387         while (1) {
4388                 memset(&sinfo, 0, sizeof(sinfo));
4389                 err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
4390                                         mac_addr, &sinfo);
4391                 if (err == -ENOENT)
4392                         break;
4393                 if (err)
4394                         goto out_err;
4395
4396                 if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
4397                                 NETLINK_CB(cb->skb).portid,
4398                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
4399                                 rdev, wdev->netdev, mac_addr,
4400                                 &sinfo) < 0)
4401                         goto out;
4402
4403                 sta_idx++;
4404         }
4405
4406  out:
4407         cb->args[2] = sta_idx;
4408         err = skb->len;
4409  out_err:
4410         nl80211_finish_wdev_dump(rdev);
4411
4412         return err;
4413 }
4414
4415 static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
4416 {
4417         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4418         struct net_device *dev = info->user_ptr[1];
4419         struct station_info sinfo;
4420         struct sk_buff *msg;
4421         u8 *mac_addr = NULL;
4422         int err;
4423
4424         memset(&sinfo, 0, sizeof(sinfo));
4425
4426         if (!info->attrs[NL80211_ATTR_MAC])
4427                 return -EINVAL;
4428
4429         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4430
4431         if (!rdev->ops->get_station)
4432                 return -EOPNOTSUPP;
4433
4434         err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
4435         if (err)
4436                 return err;
4437
4438         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
4439         if (!msg)
4440                 return -ENOMEM;
4441
4442         if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
4443                                  info->snd_portid, info->snd_seq, 0,
4444                                  rdev, dev, mac_addr, &sinfo) < 0) {
4445                 nlmsg_free(msg);
4446                 return -ENOBUFS;
4447         }
4448
4449         return genlmsg_reply(msg, info);
4450 }
4451
4452 int cfg80211_check_station_change(struct wiphy *wiphy,
4453                                   struct station_parameters *params,
4454                                   enum cfg80211_station_type statype)
4455 {
4456         if (params->listen_interval != -1 &&
4457             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4458                 return -EINVAL;
4459
4460         if (params->support_p2p_ps != -1 &&
4461             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4462                 return -EINVAL;
4463
4464         if (params->aid &&
4465             !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
4466             statype != CFG80211_STA_AP_CLIENT_UNASSOC)
4467                 return -EINVAL;
4468
4469         /* When you run into this, adjust the code below for the new flag */
4470         BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4471
4472         switch (statype) {
4473         case CFG80211_STA_MESH_PEER_KERNEL:
4474         case CFG80211_STA_MESH_PEER_USER:
4475                 /*
4476                  * No ignoring the TDLS flag here -- the userspace mesh
4477                  * code doesn't have the bug of including TDLS in the
4478                  * mask everywhere.
4479                  */
4480                 if (params->sta_flags_mask &
4481                                 ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4482                                   BIT(NL80211_STA_FLAG_MFP) |
4483                                   BIT(NL80211_STA_FLAG_AUTHORIZED)))
4484                         return -EINVAL;
4485                 break;
4486         case CFG80211_STA_TDLS_PEER_SETUP:
4487         case CFG80211_STA_TDLS_PEER_ACTIVE:
4488                 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
4489                         return -EINVAL;
4490                 /* ignore since it can't change */
4491                 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4492                 break;
4493         default:
4494                 /* disallow mesh-specific things */
4495                 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
4496                         return -EINVAL;
4497                 if (params->local_pm)
4498                         return -EINVAL;
4499                 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4500                         return -EINVAL;
4501         }
4502
4503         if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4504             statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
4505                 /* TDLS can't be set, ... */
4506                 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
4507                         return -EINVAL;
4508                 /*
4509                  * ... but don't bother the driver with it. This works around
4510                  * a hostapd/wpa_supplicant issue -- it always includes the
4511                  * TLDS_PEER flag in the mask even for AP mode.
4512                  */
4513                 params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4514         }
4515
4516         if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
4517             statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4518                 /* reject other things that can't change */
4519                 if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
4520                         return -EINVAL;
4521                 if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
4522                         return -EINVAL;
4523                 if (params->supported_rates)
4524                         return -EINVAL;
4525                 if (params->ext_capab || params->ht_capa || params->vht_capa)
4526                         return -EINVAL;
4527         }
4528
4529         if (statype != CFG80211_STA_AP_CLIENT &&
4530             statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
4531                 if (params->vlan)
4532                         return -EINVAL;
4533         }
4534
4535         switch (statype) {
4536         case CFG80211_STA_AP_MLME_CLIENT:
4537                 /* Use this only for authorizing/unauthorizing a station */
4538                 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
4539                         return -EOPNOTSUPP;
4540                 break;
4541         case CFG80211_STA_AP_CLIENT:
4542         case CFG80211_STA_AP_CLIENT_UNASSOC:
4543                 /* accept only the listed bits */
4544                 if (params->sta_flags_mask &
4545                                 ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4546                                   BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4547                                   BIT(NL80211_STA_FLAG_ASSOCIATED) |
4548                                   BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
4549                                   BIT(NL80211_STA_FLAG_WME) |
4550                                   BIT(NL80211_STA_FLAG_MFP)))
4551                         return -EINVAL;
4552
4553                 /* but authenticated/associated only if driver handles it */
4554                 if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
4555                     params->sta_flags_mask &
4556                                 (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4557                                  BIT(NL80211_STA_FLAG_ASSOCIATED)))
4558                         return -EINVAL;
4559                 break;
4560         case CFG80211_STA_IBSS:
4561         case CFG80211_STA_AP_STA:
4562                 /* reject any changes other than AUTHORIZED */
4563                 if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
4564                         return -EINVAL;
4565                 break;
4566         case CFG80211_STA_TDLS_PEER_SETUP:
4567                 /* reject any changes other than AUTHORIZED or WME */
4568                 if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
4569                                                BIT(NL80211_STA_FLAG_WME)))
4570                         return -EINVAL;
4571                 /* force (at least) rates when authorizing */
4572                 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
4573                     !params->supported_rates)
4574                         return -EINVAL;
4575                 break;
4576         case CFG80211_STA_TDLS_PEER_ACTIVE:
4577                 /* reject any changes */
4578                 return -EINVAL;
4579         case CFG80211_STA_MESH_PEER_KERNEL:
4580                 if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
4581                         return -EINVAL;
4582                 break;
4583         case CFG80211_STA_MESH_PEER_USER:
4584                 if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
4585                     params->plink_action != NL80211_PLINK_ACTION_BLOCK)
4586                         return -EINVAL;
4587                 break;
4588         }
4589
4590         return 0;
4591 }
4592 EXPORT_SYMBOL(cfg80211_check_station_change);
4593
4594 /*
4595  * Get vlan interface making sure it is running and on the right wiphy.
4596  */
4597 static struct net_device *get_vlan(struct genl_info *info,
4598                                    struct cfg80211_registered_device *rdev)
4599 {
4600         struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
4601         struct net_device *v;
4602         int ret;
4603
4604         if (!vlanattr)
4605                 return NULL;
4606
4607         v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
4608         if (!v)
4609                 return ERR_PTR(-ENODEV);
4610
4611         if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
4612                 ret = -EINVAL;
4613                 goto error;
4614         }
4615
4616         if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
4617             v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
4618             v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
4619                 ret = -EINVAL;
4620                 goto error;
4621         }
4622
4623         if (!netif_running(v)) {
4624                 ret = -ENETDOWN;
4625                 goto error;
4626         }
4627
4628         return v;
4629  error:
4630         dev_put(v);
4631         return ERR_PTR(ret);
4632 }
4633
4634 static const struct nla_policy
4635 nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
4636         [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
4637         [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
4638 };
4639
4640 static int nl80211_parse_sta_wme(struct genl_info *info,
4641                                  struct station_parameters *params)
4642 {
4643         struct nlattr *tb[NL80211_STA_WME_MAX + 1];
4644         struct nlattr *nla;
4645         int err;
4646
4647         /* parse WME attributes if present */
4648         if (!info->attrs[NL80211_ATTR_STA_WME])
4649                 return 0;
4650
4651         nla = info->attrs[NL80211_ATTR_STA_WME];
4652         err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
4653                                nl80211_sta_wme_policy);
4654         if (err)
4655                 return err;
4656
4657         if (tb[NL80211_STA_WME_UAPSD_QUEUES])
4658                 params->uapsd_queues = nla_get_u8(
4659                         tb[NL80211_STA_WME_UAPSD_QUEUES]);
4660         if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
4661                 return -EINVAL;
4662
4663         if (tb[NL80211_STA_WME_MAX_SP])
4664                 params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
4665
4666         if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
4667                 return -EINVAL;
4668
4669         params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
4670
4671         return 0;
4672 }
4673
4674 static int nl80211_parse_sta_channel_info(struct genl_info *info,
4675                                       struct station_parameters *params)
4676 {
4677         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
4678                 params->supported_channels =
4679                      nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4680                 params->supported_channels_len =
4681                      nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
4682                 /*
4683                  * Need to include at least one (first channel, number of
4684                  * channels) tuple for each subband, and must have proper
4685                  * tuples for the rest of the data as well.
4686                  */
4687                 if (params->supported_channels_len < 2)
4688                         return -EINVAL;
4689                 if (params->supported_channels_len % 2)
4690                         return -EINVAL;
4691         }
4692
4693         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
4694                 params->supported_oper_classes =
4695                  nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4696                 params->supported_oper_classes_len =
4697                   nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
4698                 /*
4699                  * The value of the Length field of the Supported Operating
4700                  * Classes element is between 2 and 253.
4701                  */
4702                 if (params->supported_oper_classes_len < 2 ||
4703                     params->supported_oper_classes_len > 253)
4704                         return -EINVAL;
4705         }
4706         return 0;
4707 }
4708
4709 static int nl80211_set_station_tdls(struct genl_info *info,
4710                                     struct station_parameters *params)
4711 {
4712         int err;
4713         /* Dummy STA entry gets updated once the peer capabilities are known */
4714         if (info->attrs[NL80211_ATTR_PEER_AID])
4715                 params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
4716         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4717                 params->ht_capa =
4718                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
4719         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4720                 params->vht_capa =
4721                         nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4722
4723         err = nl80211_parse_sta_channel_info(info, params);
4724         if (err)
4725                 return err;
4726
4727         return nl80211_parse_sta_wme(info, params);
4728 }
4729
4730 static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
4731 {
4732         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4733         struct net_device *dev = info->user_ptr[1];
4734         struct station_parameters params;
4735         u8 *mac_addr;
4736         int err;
4737
4738         memset(&params, 0, sizeof(params));
4739
4740         if (!rdev->ops->change_station)
4741                 return -EOPNOTSUPP;
4742
4743         /*
4744          * AID and listen_interval properties can be set only for unassociated
4745          * station. Include these parameters here and will check them in
4746          * cfg80211_check_station_change().
4747          */
4748         if (info->attrs[NL80211_ATTR_STA_AID])
4749                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
4750
4751         if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4752                 params.listen_interval =
4753                      nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
4754         else
4755                 params.listen_interval = -1;
4756
4757         if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4758                 u8 tmp;
4759
4760                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4761                 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4762                         return -EINVAL;
4763
4764                 params.support_p2p_ps = tmp;
4765         } else {
4766                 params.support_p2p_ps = -1;
4767         }
4768
4769         if (!info->attrs[NL80211_ATTR_MAC])
4770                 return -EINVAL;
4771
4772         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4773
4774         if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
4775                 params.supported_rates =
4776                         nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4777                 params.supported_rates_len =
4778                         nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4779         }
4780
4781         if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4782                 params.capability =
4783                         nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
4784                 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
4785         }
4786
4787         if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
4788                 params.ext_capab =
4789                         nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4790                 params.ext_capab_len =
4791                         nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4792         }
4793
4794         if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
4795                 return -EINVAL;
4796
4797         if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
4798                 params.plink_action =
4799                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
4800                 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
4801                         return -EINVAL;
4802         }
4803
4804         if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
4805                 params.plink_state =
4806                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
4807                 if (params.plink_state >= NUM_NL80211_PLINK_STATES)
4808                         return -EINVAL;
4809                 if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
4810                         params.peer_aid = nla_get_u16(
4811                                 info->attrs[NL80211_ATTR_MESH_PEER_AID]);
4812                         if (params.peer_aid > IEEE80211_MAX_AID)
4813                                 return -EINVAL;
4814                 }
4815                 params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
4816         }
4817
4818         if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
4819                 enum nl80211_mesh_power_mode pm = nla_get_u32(
4820                         info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
4821
4822                 if (pm <= NL80211_MESH_POWER_UNKNOWN ||
4823                     pm > NL80211_MESH_POWER_MAX)
4824                         return -EINVAL;
4825
4826                 params.local_pm = pm;
4827         }
4828
4829         /* Include parameters for TDLS peer (will check later) */
4830         err = nl80211_set_station_tdls(info, &params);
4831         if (err)
4832                 return err;
4833
4834         params.vlan = get_vlan(info, rdev);
4835         if (IS_ERR(params.vlan))
4836                 return PTR_ERR(params.vlan);
4837
4838         switch (dev->ieee80211_ptr->iftype) {
4839         case NL80211_IFTYPE_AP:
4840         case NL80211_IFTYPE_AP_VLAN:
4841         case NL80211_IFTYPE_P2P_GO:
4842         case NL80211_IFTYPE_P2P_CLIENT:
4843         case NL80211_IFTYPE_STATION:
4844         case NL80211_IFTYPE_ADHOC:
4845         case NL80211_IFTYPE_MESH_POINT:
4846                 break;
4847         default:
4848                 err = -EOPNOTSUPP;
4849                 goto out_put_vlan;
4850         }
4851
4852         /* driver will call cfg80211_check_station_change() */
4853         err = rdev_change_station(rdev, dev, mac_addr, &params);
4854
4855  out_put_vlan:
4856         if (params.vlan)
4857                 dev_put(params.vlan);
4858
4859         return err;
4860 }
4861
4862 static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
4863 {
4864         struct cfg80211_registered_device *rdev = info->user_ptr[0];
4865         int err;
4866         struct net_device *dev = info->user_ptr[1];
4867         struct station_parameters params;
4868         u8 *mac_addr = NULL;
4869         u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
4870                          BIT(NL80211_STA_FLAG_ASSOCIATED);
4871
4872         memset(&params, 0, sizeof(params));
4873
4874         if (!rdev->ops->add_station)
4875                 return -EOPNOTSUPP;
4876
4877         if (!info->attrs[NL80211_ATTR_MAC])
4878                 return -EINVAL;
4879
4880         if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
4881                 return -EINVAL;
4882
4883         if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
4884                 return -EINVAL;
4885
4886         if (!info->attrs[NL80211_ATTR_STA_AID] &&
4887             !info->attrs[NL80211_ATTR_PEER_AID])
4888                 return -EINVAL;
4889
4890         mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
4891         params.supported_rates =
4892                 nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4893         params.supported_rates_len =
4894                 nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
4895         params.listen_interval =
4896                 nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
4897
4898         if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
4899                 u8 tmp;
4900
4901                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
4902                 if (tmp >= NUM_NL80211_P2P_PS_STATUS)
4903                         return -EINVAL;
4904
4905                 params.support_p2p_ps = tmp;
4906         } else {
4907                 /*
4908                  * if not specified, assume it's supported for P2P GO interface,
4909                  * and is NOT supported for AP interface
4910                  */
4911                 params.support_p2p_ps =
4912                         dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
4913         }
4914
4915         if (info->attrs[NL80211_ATTR_PEER_AID])
4916                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
4917         else
4918                 params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
4919         if (!params.aid || params.aid > IEEE80211_MAX_AID)
4920                 return -EINVAL;
4921
4922         if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
4923                 params.capability =
4924                         nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
4925                 params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
4926         }
4927
4928         if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
4929                 params.ext_capab =
4930                         nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4931                 params.ext_capab_len =
4932                         nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
4933         }
4934
4935         if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
4936                 params.ht_capa =
4937                         nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
4938
4939         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
4940                 params.vht_capa =
4941                         nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
4942
4943         if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
4944                 params.opmode_notif_used = true;
4945                 params.opmode_notif =
4946                         nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
4947         }
4948
4949         if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
4950                 params.plink_action =
4951                         nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
4952                 if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
4953                         return -EINVAL;
4954         }
4955
4956         err = nl80211_parse_sta_channel_info(info, &params);
4957         if (err)
4958                 return err;
4959
4960         err = nl80211_parse_sta_wme(info, &params);
4961         if (err)
4962                 return err;
4963
4964         if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
4965                 return -EINVAL;
4966
4967         /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
4968          * as userspace might just pass through the capabilities from the IEs
4969          * directly, rather than enforcing this restriction and returning an
4970          * error in this case.
4971          */
4972         if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
4973                 params.ht_capa = NULL;
4974                 params.vht_capa = NULL;
4975         }
4976
4977         /* When you run into this, adjust the code below for the new flag */
4978         BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
4979
4980         switch (dev->ieee80211_ptr->iftype) {
4981         case NL80211_IFTYPE_AP:
4982         case NL80211_IFTYPE_AP_VLAN:
4983         case NL80211_IFTYPE_P2P_GO:
4984                 /* ignore WME attributes if iface/sta is not capable */
4985                 if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
4986                     !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
4987                         params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
4988
4989                 /* TDLS peers cannot be added */
4990                 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
4991                     info->attrs[NL80211_ATTR_PEER_AID])
4992                         return -EINVAL;
4993                 /* but don't bother the driver with it */
4994                 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
4995
4996                 /* allow authenticated/associated only if driver handles it */
4997                 if (!(rdev->wiphy.features &
4998                                 NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
4999                     params.sta_flags_mask & auth_assoc)
5000                         return -EINVAL;
5001
5002                 /* Older userspace, or userspace wanting to be compatible with
5003                  * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
5004                  * and assoc flags in the mask, but assumes the station will be
5005                  * added as associated anyway since this was the required driver
5006                  * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
5007                  * introduced.
5008                  * In order to not bother drivers with this quirk in the API
5009                  * set the flags in both the mask and set for new stations in
5010                  * this case.
5011                  */
5012                 if (!(params.sta_flags_mask & auth_assoc)) {
5013                         params.sta_flags_mask |= auth_assoc;
5014                         params.sta_flags_set |= auth_assoc;
5015                 }
5016
5017                 /* must be last in here for error handling */
5018                 params.vlan = get_vlan(info, rdev);
5019                 if (IS_ERR(params.vlan))
5020                         return PTR_ERR(params.vlan);
5021                 break;
5022         case NL80211_IFTYPE_MESH_POINT:
5023                 /* ignore uAPSD data */
5024                 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5025
5026                 /* associated is disallowed */
5027                 if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
5028                         return -EINVAL;
5029                 /* TDLS peers cannot be added */
5030                 if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
5031                     info->attrs[NL80211_ATTR_PEER_AID])
5032                         return -EINVAL;
5033                 break;
5034         case NL80211_IFTYPE_STATION:
5035         case NL80211_IFTYPE_P2P_CLIENT:
5036                 /* ignore uAPSD data */
5037                 params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
5038
5039                 /* these are disallowed */
5040                 if (params.sta_flags_mask &
5041                                 (BIT(NL80211_STA_FLAG_ASSOCIATED) |
5042                                  BIT(NL80211_STA_FLAG_AUTHENTICATED)))
5043                         return -EINVAL;
5044                 /* Only TDLS peers can be added */
5045                 if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
5046                         return -EINVAL;
5047                 /* Can only add if TDLS ... */
5048                 if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
5049                         return -EOPNOTSUPP;
5050                 /* ... with external setup is supported */
5051                 if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
5052                         return -EOPNOTSUPP;
5053                 /*
5054                  * Older wpa_supplicant versions always mark the TDLS peer
5055                  * as authorized, but it shouldn't yet be.
5056                  */
5057                 params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
5058                 break;
5059         default:
5060                 return -EOPNOTSUPP;
5061         }
5062
5063         /* be aware of params.vlan when changing code here */
5064
5065         err = rdev_add_station(rdev, dev, mac_addr, &params);
5066
5067         if (params.vlan)
5068                 dev_put(params.vlan);
5069         return err;
5070 }
5071
5072 static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
5073 {
5074         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5075         struct net_device *dev = info->user_ptr[1];
5076         struct station_del_parameters params;
5077
5078         memset(&params, 0, sizeof(params));
5079
5080         if (info->attrs[NL80211_ATTR_MAC])
5081                 params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
5082
5083         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5084             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
5085             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
5086             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5087                 return -EINVAL;
5088
5089         if (!rdev->ops->del_station)
5090                 return -EOPNOTSUPP;
5091
5092         if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
5093                 params.subtype =
5094                         nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
5095                 if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
5096                     params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
5097                         return -EINVAL;
5098         } else {
5099                 /* Default to Deauthentication frame */
5100                 params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
5101         }
5102
5103         if (info->attrs[NL80211_ATTR_REASON_CODE]) {
5104                 params.reason_code =
5105                         nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
5106                 if (params.reason_code == 0)
5107                         return -EINVAL; /* 0 is reserved */
5108         } else {
5109                 /* Default to reason code 2 */
5110                 params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
5111         }
5112
5113         return rdev_del_station(rdev, dev, &params);
5114 }
5115
5116 static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
5117                                 int flags, struct net_device *dev,
5118                                 u8 *dst, u8 *next_hop,
5119                                 struct mpath_info *pinfo)
5120 {
5121         void *hdr;
5122         struct nlattr *pinfoattr;
5123
5124         hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
5125         if (!hdr)
5126                 return -1;
5127
5128         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5129             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
5130             nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
5131             nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
5132                 goto nla_put_failure;
5133
5134         pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
5135         if (!pinfoattr)
5136                 goto nla_put_failure;
5137         if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
5138             nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
5139                         pinfo->frame_qlen))
5140                 goto nla_put_failure;
5141         if (((pinfo->filled & MPATH_INFO_SN) &&
5142              nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
5143             ((pinfo->filled & MPATH_INFO_METRIC) &&
5144              nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
5145                          pinfo->metric)) ||
5146             ((pinfo->filled & MPATH_INFO_EXPTIME) &&
5147              nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
5148                          pinfo->exptime)) ||
5149             ((pinfo->filled & MPATH_INFO_FLAGS) &&
5150              nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
5151                         pinfo->flags)) ||
5152             ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
5153              nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
5154                          pinfo->discovery_timeout)) ||
5155             ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
5156              nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
5157                         pinfo->discovery_retries)))
5158                 goto nla_put_failure;
5159
5160         nla_nest_end(msg, pinfoattr);
5161
5162         genlmsg_end(msg, hdr);
5163         return 0;
5164
5165  nla_put_failure:
5166         genlmsg_cancel(msg, hdr);
5167         return -EMSGSIZE;
5168 }
5169
5170 static int nl80211_dump_mpath(struct sk_buff *skb,
5171                               struct netlink_callback *cb)
5172 {
5173         struct mpath_info pinfo;
5174         struct cfg80211_registered_device *rdev;
5175         struct wireless_dev *wdev;
5176         u8 dst[ETH_ALEN];
5177         u8 next_hop[ETH_ALEN];
5178         int path_idx = cb->args[2];
5179         int err;
5180
5181         err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5182         if (err)
5183                 return err;
5184
5185         if (!rdev->ops->dump_mpath) {
5186                 err = -EOPNOTSUPP;
5187                 goto out_err;
5188         }
5189
5190         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5191                 err = -EOPNOTSUPP;
5192                 goto out_err;
5193         }
5194
5195         while (1) {
5196                 err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
5197                                       next_hop, &pinfo);
5198                 if (err == -ENOENT)
5199                         break;
5200                 if (err)
5201                         goto out_err;
5202
5203                 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5204                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
5205                                        wdev->netdev, dst, next_hop,
5206                                        &pinfo) < 0)
5207                         goto out;
5208
5209                 path_idx++;
5210         }
5211
5212  out:
5213         cb->args[2] = path_idx;
5214         err = skb->len;
5215  out_err:
5216         nl80211_finish_wdev_dump(rdev);
5217         return err;
5218 }
5219
5220 static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
5221 {
5222         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5223         int err;
5224         struct net_device *dev = info->user_ptr[1];
5225         struct mpath_info pinfo;
5226         struct sk_buff *msg;
5227         u8 *dst = NULL;
5228         u8 next_hop[ETH_ALEN];
5229
5230         memset(&pinfo, 0, sizeof(pinfo));
5231
5232         if (!info->attrs[NL80211_ATTR_MAC])
5233                 return -EINVAL;
5234
5235         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5236
5237         if (!rdev->ops->get_mpath)
5238                 return -EOPNOTSUPP;
5239
5240         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5241                 return -EOPNOTSUPP;
5242
5243         err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
5244         if (err)
5245                 return err;
5246
5247         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5248         if (!msg)
5249                 return -ENOMEM;
5250
5251         if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5252                                  dev, dst, next_hop, &pinfo) < 0) {
5253                 nlmsg_free(msg);
5254                 return -ENOBUFS;
5255         }
5256
5257         return genlmsg_reply(msg, info);
5258 }
5259
5260 static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
5261 {
5262         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5263         struct net_device *dev = info->user_ptr[1];
5264         u8 *dst = NULL;
5265         u8 *next_hop = NULL;
5266
5267         if (!info->attrs[NL80211_ATTR_MAC])
5268                 return -EINVAL;
5269
5270         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5271                 return -EINVAL;
5272
5273         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5274         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5275
5276         if (!rdev->ops->change_mpath)
5277                 return -EOPNOTSUPP;
5278
5279         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5280                 return -EOPNOTSUPP;
5281
5282         return rdev_change_mpath(rdev, dev, dst, next_hop);
5283 }
5284
5285 static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
5286 {
5287         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5288         struct net_device *dev = info->user_ptr[1];
5289         u8 *dst = NULL;
5290         u8 *next_hop = NULL;
5291
5292         if (!info->attrs[NL80211_ATTR_MAC])
5293                 return -EINVAL;
5294
5295         if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
5296                 return -EINVAL;
5297
5298         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5299         next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
5300
5301         if (!rdev->ops->add_mpath)
5302                 return -EOPNOTSUPP;
5303
5304         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5305                 return -EOPNOTSUPP;
5306
5307         return rdev_add_mpath(rdev, dev, dst, next_hop);
5308 }
5309
5310 static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
5311 {
5312         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5313         struct net_device *dev = info->user_ptr[1];
5314         u8 *dst = NULL;
5315
5316         if (info->attrs[NL80211_ATTR_MAC])
5317                 dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5318
5319         if (!rdev->ops->del_mpath)
5320                 return -EOPNOTSUPP;
5321
5322         return rdev_del_mpath(rdev, dev, dst);
5323 }
5324
5325 static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
5326 {
5327         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5328         int err;
5329         struct net_device *dev = info->user_ptr[1];
5330         struct mpath_info pinfo;
5331         struct sk_buff *msg;
5332         u8 *dst = NULL;
5333         u8 mpp[ETH_ALEN];
5334
5335         memset(&pinfo, 0, sizeof(pinfo));
5336
5337         if (!info->attrs[NL80211_ATTR_MAC])
5338                 return -EINVAL;
5339
5340         dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
5341
5342         if (!rdev->ops->get_mpp)
5343                 return -EOPNOTSUPP;
5344
5345         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
5346                 return -EOPNOTSUPP;
5347
5348         err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
5349         if (err)
5350                 return err;
5351
5352         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5353         if (!msg)
5354                 return -ENOMEM;
5355
5356         if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
5357                                dev, dst, mpp, &pinfo) < 0) {
5358                 nlmsg_free(msg);
5359                 return -ENOBUFS;
5360         }
5361
5362         return genlmsg_reply(msg, info);
5363 }
5364
5365 static int nl80211_dump_mpp(struct sk_buff *skb,
5366                             struct netlink_callback *cb)
5367 {
5368         struct mpath_info pinfo;
5369         struct cfg80211_registered_device *rdev;
5370         struct wireless_dev *wdev;
5371         u8 dst[ETH_ALEN];
5372         u8 mpp[ETH_ALEN];
5373         int path_idx = cb->args[2];
5374         int err;
5375
5376         err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
5377         if (err)
5378                 return err;
5379
5380         if (!rdev->ops->dump_mpp) {
5381                 err = -EOPNOTSUPP;
5382                 goto out_err;
5383         }
5384
5385         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
5386                 err = -EOPNOTSUPP;
5387                 goto out_err;
5388         }
5389
5390         while (1) {
5391                 err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
5392                                     mpp, &pinfo);
5393                 if (err == -ENOENT)
5394                         break;
5395                 if (err)
5396                         goto out_err;
5397
5398                 if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
5399                                        cb->nlh->nlmsg_seq, NLM_F_MULTI,
5400                                        wdev->netdev, dst, mpp,
5401                                        &pinfo) < 0)
5402                         goto out;
5403
5404                 path_idx++;
5405         }
5406
5407  out:
5408         cb->args[2] = path_idx;
5409         err = skb->len;
5410  out_err:
5411         nl80211_finish_wdev_dump(rdev);
5412         return err;
5413 }
5414
5415 static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
5416 {
5417         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5418         struct net_device *dev = info->user_ptr[1];
5419         struct wireless_dev *wdev = dev->ieee80211_ptr;
5420         struct bss_parameters params;
5421         int err;
5422
5423         memset(&params, 0, sizeof(params));
5424         /* default to not changing parameters */
5425         params.use_cts_prot = -1;
5426         params.use_short_preamble = -1;
5427         params.use_short_slot_time = -1;
5428         params.ap_isolate = -1;
5429         params.ht_opmode = -1;
5430         params.p2p_ctwindow = -1;
5431         params.p2p_opp_ps = -1;
5432
5433         if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
5434                 params.use_cts_prot =
5435                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
5436         if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
5437                 params.use_short_preamble =
5438                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
5439         if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
5440                 params.use_short_slot_time =
5441                     nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
5442         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
5443                 params.basic_rates =
5444                         nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5445                 params.basic_rates_len =
5446                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
5447         }
5448         if (info->attrs[NL80211_ATTR_AP_ISOLATE])
5449                 params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
5450         if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
5451                 params.ht_opmode =
5452                         nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
5453
5454         if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
5455                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5456                         return -EINVAL;
5457                 params.p2p_ctwindow =
5458                         nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
5459                 if (params.p2p_ctwindow < 0)
5460                         return -EINVAL;
5461                 if (params.p2p_ctwindow != 0 &&
5462                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
5463                         return -EINVAL;
5464         }
5465
5466         if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
5467                 u8 tmp;
5468
5469                 if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5470                         return -EINVAL;
5471                 tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
5472                 if (tmp > 1)
5473                         return -EINVAL;
5474                 params.p2p_opp_ps = tmp;
5475                 if (params.p2p_opp_ps &&
5476                     !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
5477                         return -EINVAL;
5478         }
5479
5480         if (!rdev->ops->change_bss)
5481                 return -EOPNOTSUPP;
5482
5483         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
5484             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
5485                 return -EOPNOTSUPP;
5486
5487         wdev_lock(wdev);
5488         err = rdev_change_bss(rdev, dev, &params);
5489         wdev_unlock(wdev);
5490
5491         return err;
5492 }
5493
5494 static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
5495 {
5496         char *data = NULL;
5497         bool is_indoor;
5498         enum nl80211_user_reg_hint_type user_reg_hint_type;
5499         u32 owner_nlportid;
5500
5501         /*
5502          * You should only get this when cfg80211 hasn't yet initialized
5503          * completely when built-in to the kernel right between the time
5504          * window between nl80211_init() and regulatory_init(), if that is
5505          * even possible.
5506          */
5507         if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
5508                 return -EINPROGRESS;
5509
5510         if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
5511                 user_reg_hint_type =
5512                   nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
5513         else
5514                 user_reg_hint_type = NL80211_USER_REG_HINT_USER;
5515
5516         switch (user_reg_hint_type) {
5517         case NL80211_USER_REG_HINT_USER:
5518         case NL80211_USER_REG_HINT_CELL_BASE:
5519                 if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
5520                         return -EINVAL;
5521
5522                 data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
5523                 return regulatory_hint_user(data, user_reg_hint_type);
5524         case NL80211_USER_REG_HINT_INDOOR:
5525                 if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
5526                         owner_nlportid = info->snd_portid;
5527                         is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
5528                 } else {
5529                         owner_nlportid = 0;
5530                         is_indoor = true;
5531                 }
5532
5533                 return regulatory_hint_indoor(is_indoor, owner_nlportid);
5534         default:
5535                 return -EINVAL;
5536         }
5537 }
5538
5539 static int nl80211_get_mesh_config(struct sk_buff *skb,
5540                                    struct genl_info *info)
5541 {
5542         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5543         struct net_device *dev = info->user_ptr[1];
5544         struct wireless_dev *wdev = dev->ieee80211_ptr;
5545         struct mesh_config cur_params;
5546         int err = 0;
5547         void *hdr;
5548         struct nlattr *pinfoattr;
5549         struct sk_buff *msg;
5550
5551         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5552                 return -EOPNOTSUPP;
5553
5554         if (!rdev->ops->get_mesh_config)
5555                 return -EOPNOTSUPP;
5556
5557         wdev_lock(wdev);
5558         /* If not connected, get default parameters */
5559         if (!wdev->mesh_id_len)
5560                 memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
5561         else
5562                 err = rdev_get_mesh_config(rdev, dev, &cur_params);
5563         wdev_unlock(wdev);
5564
5565         if (err)
5566                 return err;
5567
5568         /* Draw up a netlink message to send back */
5569         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
5570         if (!msg)
5571                 return -ENOMEM;
5572         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
5573                              NL80211_CMD_GET_MESH_CONFIG);
5574         if (!hdr)
5575                 goto out;
5576         pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
5577         if (!pinfoattr)
5578                 goto nla_put_failure;
5579         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
5580             nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
5581                         cur_params.dot11MeshRetryTimeout) ||
5582             nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5583                         cur_params.dot11MeshConfirmTimeout) ||
5584             nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
5585                         cur_params.dot11MeshHoldingTimeout) ||
5586             nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
5587                         cur_params.dot11MeshMaxPeerLinks) ||
5588             nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
5589                        cur_params.dot11MeshMaxRetries) ||
5590             nla_put_u8(msg, NL80211_MESHCONF_TTL,
5591                        cur_params.dot11MeshTTL) ||
5592             nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
5593                        cur_params.element_ttl) ||
5594             nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5595                        cur_params.auto_open_plinks) ||
5596             nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5597                         cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
5598             nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5599                        cur_params.dot11MeshHWMPmaxPREQretries) ||
5600             nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
5601                         cur_params.path_refresh_time) ||
5602             nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5603                         cur_params.min_discovery_timeout) ||
5604             nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5605                         cur_params.dot11MeshHWMPactivePathTimeout) ||
5606             nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5607                         cur_params.dot11MeshHWMPpreqMinInterval) ||
5608             nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5609                         cur_params.dot11MeshHWMPperrMinInterval) ||
5610             nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5611                         cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
5612             nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
5613                        cur_params.dot11MeshHWMPRootMode) ||
5614             nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5615                         cur_params.dot11MeshHWMPRannInterval) ||
5616             nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5617                        cur_params.dot11MeshGateAnnouncementProtocol) ||
5618             nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
5619                        cur_params.dot11MeshForwarding) ||
5620             nla_put_u32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
5621                         cur_params.rssi_threshold) ||
5622             nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
5623                         cur_params.ht_opmode) ||
5624             nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
5625                         cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
5626             nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
5627                         cur_params.dot11MeshHWMProotInterval) ||
5628             nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
5629                         cur_params.dot11MeshHWMPconfirmationInterval) ||
5630             nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
5631                         cur_params.power_mode) ||
5632             nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
5633                         cur_params.dot11MeshAwakeWindowDuration) ||
5634             nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
5635                         cur_params.plink_timeout))
5636                 goto nla_put_failure;
5637         nla_nest_end(msg, pinfoattr);
5638         genlmsg_end(msg, hdr);
5639         return genlmsg_reply(msg, info);
5640
5641  nla_put_failure:
5642         genlmsg_cancel(msg, hdr);
5643  out:
5644         nlmsg_free(msg);
5645         return -ENOBUFS;
5646 }
5647
5648 static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
5649         [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
5650         [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
5651         [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
5652         [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
5653         [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
5654         [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
5655         [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
5656         [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
5657         [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
5658         [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
5659         [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
5660         [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
5661         [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
5662         [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
5663         [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
5664         [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
5665         [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
5666         [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
5667         [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
5668         [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
5669         [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
5670         [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
5671         [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
5672         [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
5673         [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
5674         [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
5675         [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
5676         [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
5677 };
5678
5679 static const struct nla_policy
5680         nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
5681         [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
5682         [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
5683         [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
5684         [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
5685         [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
5686         [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
5687         [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
5688                                     .len = IEEE80211_MAX_DATA_LEN },
5689         [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
5690 };
5691
5692 static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
5693 {
5694         u8 val = nla_get_u8(nla);
5695         if (val < min || val > max)
5696                 return -EINVAL;
5697         *out = val;
5698         return 0;
5699 }
5700
5701 static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
5702 {
5703         u8 val = nla_get_u8(nla);
5704         if (val < min || val > max)
5705                 return -EINVAL;
5706         *out = val;
5707         return 0;
5708 }
5709
5710 static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
5711 {
5712         u16 val = nla_get_u16(nla);
5713         if (val < min || val > max)
5714                 return -EINVAL;
5715         *out = val;
5716         return 0;
5717 }
5718
5719 static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
5720 {
5721         u32 val = nla_get_u32(nla);
5722         if (val < min || val > max)
5723                 return -EINVAL;
5724         *out = val;
5725         return 0;
5726 }
5727
5728 static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
5729 {
5730         s32 val = nla_get_s32(nla);
5731         if (val < min || val > max)
5732                 return -EINVAL;
5733         *out = val;
5734         return 0;
5735 }
5736
5737 static int nl80211_check_power_mode(const struct nlattr *nla,
5738                                     enum nl80211_mesh_power_mode min,
5739                                     enum nl80211_mesh_power_mode max,
5740                                     enum nl80211_mesh_power_mode *out)
5741 {
5742         u32 val = nla_get_u32(nla);
5743         if (val < min || val > max)
5744                 return -EINVAL;
5745         *out = val;
5746         return 0;
5747 }
5748
5749 static int nl80211_parse_mesh_config(struct genl_info *info,
5750                                      struct mesh_config *cfg,
5751                                      u32 *mask_out)
5752 {
5753         struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
5754         u32 mask = 0;
5755         u16 ht_opmode;
5756
5757 #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
5758 do {                                                                        \
5759         if (tb[attr]) {                                                     \
5760                 if (fn(tb[attr], min, max, &cfg->param))                    \
5761                         return -EINVAL;                                     \
5762                 mask |= (1 << (attr - 1));                                  \
5763         }                                                                   \
5764 } while (0)
5765
5766         if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
5767                 return -EINVAL;
5768         if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
5769                              info->attrs[NL80211_ATTR_MESH_CONFIG],
5770                              nl80211_meshconf_params_policy))
5771                 return -EINVAL;
5772
5773         /* This makes sure that there aren't more than 32 mesh config
5774          * parameters (otherwise our bitfield scheme would not work.) */
5775         BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
5776
5777         /* Fill in the params struct */
5778         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
5779                                   mask, NL80211_MESHCONF_RETRY_TIMEOUT,
5780                                   nl80211_check_u16);
5781         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
5782                                   mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
5783                                   nl80211_check_u16);
5784         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
5785                                   mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
5786                                   nl80211_check_u16);
5787         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
5788                                   mask, NL80211_MESHCONF_MAX_PEER_LINKS,
5789                                   nl80211_check_u16);
5790         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
5791                                   mask, NL80211_MESHCONF_MAX_RETRIES,
5792                                   nl80211_check_u8);
5793         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
5794                                   mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
5795         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
5796                                   mask, NL80211_MESHCONF_ELEMENT_TTL,
5797                                   nl80211_check_u8);
5798         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
5799                                   mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
5800                                   nl80211_check_bool);
5801         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
5802                                   1, 255, mask,
5803                                   NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
5804                                   nl80211_check_u32);
5805         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
5806                                   mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
5807                                   nl80211_check_u8);
5808         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
5809                                   mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
5810                                   nl80211_check_u32);
5811         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
5812                                   mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
5813                                   nl80211_check_u16);
5814         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
5815                                   1, 65535, mask,
5816                                   NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
5817                                   nl80211_check_u32);
5818         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
5819                                   1, 65535, mask,
5820                                   NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
5821                                   nl80211_check_u16);
5822         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
5823                                   1, 65535, mask,
5824                                   NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
5825                                   nl80211_check_u16);
5826         FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
5827                                   dot11MeshHWMPnetDiameterTraversalTime,
5828                                   1, 65535, mask,
5829                                   NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
5830                                   nl80211_check_u16);
5831         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
5832                                   mask, NL80211_MESHCONF_HWMP_ROOTMODE,
5833                                   nl80211_check_u8);
5834         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
5835                                   mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
5836                                   nl80211_check_u16);
5837         FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
5838                                   dot11MeshGateAnnouncementProtocol, 0, 1,
5839                                   mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
5840                                   nl80211_check_bool);
5841         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
5842                                   mask, NL80211_MESHCONF_FORWARDING,
5843                                   nl80211_check_bool);
5844         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
5845                                   mask, NL80211_MESHCONF_RSSI_THRESHOLD,
5846                                   nl80211_check_s32);
5847         /*
5848          * Check HT operation mode based on
5849          * IEEE 802.11 2012 8.4.2.59 HT Operation element.
5850          */
5851         if (tb[NL80211_MESHCONF_HT_OPMODE]) {
5852                 ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
5853
5854                 if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
5855                                   IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
5856                                   IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5857                         return -EINVAL;
5858
5859                 if ((ht_opmode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT) &&
5860                     (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5861                         return -EINVAL;
5862
5863                 switch (ht_opmode & IEEE80211_HT_OP_MODE_PROTECTION) {
5864                 case IEEE80211_HT_OP_MODE_PROTECTION_NONE:
5865                 case IEEE80211_HT_OP_MODE_PROTECTION_20MHZ:
5866                         if (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)
5867                                 return -EINVAL;
5868                         break;
5869                 case IEEE80211_HT_OP_MODE_PROTECTION_NONMEMBER:
5870                 case IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED:
5871                         if (!(ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
5872                                 return -EINVAL;
5873                         break;
5874                 }
5875                 cfg->ht_opmode = ht_opmode;
5876         }
5877         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
5878                                   1, 65535, mask,
5879                                   NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
5880                                   nl80211_check_u32);
5881         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
5882                                   mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
5883                                   nl80211_check_u16);
5884         FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
5885                                   dot11MeshHWMPconfirmationInterval,
5886                                   1, 65535, mask,
5887                                   NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
5888                                   nl80211_check_u16);
5889         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
5890                                   NL80211_MESH_POWER_ACTIVE,
5891                                   NL80211_MESH_POWER_MAX,
5892                                   mask, NL80211_MESHCONF_POWER_MODE,
5893                                   nl80211_check_power_mode);
5894         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
5895                                   0, 65535, mask,
5896                                   NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
5897         FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
5898                                   mask, NL80211_MESHCONF_PLINK_TIMEOUT,
5899                                   nl80211_check_u32);
5900         if (mask_out)
5901                 *mask_out = mask;
5902
5903         return 0;
5904
5905 #undef FILL_IN_MESH_PARAM_IF_SET
5906 }
5907
5908 static int nl80211_parse_mesh_setup(struct genl_info *info,
5909                                      struct mesh_setup *setup)
5910 {
5911         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5912         struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
5913
5914         if (!info->attrs[NL80211_ATTR_MESH_SETUP])
5915                 return -EINVAL;
5916         if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
5917                              info->attrs[NL80211_ATTR_MESH_SETUP],
5918                              nl80211_mesh_setup_params_policy))
5919                 return -EINVAL;
5920
5921         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
5922                 setup->sync_method =
5923                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
5924                  IEEE80211_SYNC_METHOD_VENDOR :
5925                  IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
5926
5927         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
5928                 setup->path_sel_proto =
5929                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
5930                  IEEE80211_PATH_PROTOCOL_VENDOR :
5931                  IEEE80211_PATH_PROTOCOL_HWMP;
5932
5933         if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
5934                 setup->path_metric =
5935                 (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
5936                  IEEE80211_PATH_METRIC_VENDOR :
5937                  IEEE80211_PATH_METRIC_AIRTIME;
5938
5939         if (tb[NL80211_MESH_SETUP_IE]) {
5940                 struct nlattr *ieattr =
5941                         tb[NL80211_MESH_SETUP_IE];
5942                 if (!is_valid_ie_attr(ieattr))
5943                         return -EINVAL;
5944                 setup->ie = nla_data(ieattr);
5945                 setup->ie_len = nla_len(ieattr);
5946         }
5947         if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
5948             !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
5949                 return -EINVAL;
5950         setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
5951         setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
5952         setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
5953         if (setup->is_secure)
5954                 setup->user_mpm = true;
5955
5956         if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
5957                 if (!setup->user_mpm)
5958                         return -EINVAL;
5959                 setup->auth_id =
5960                         nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
5961         }
5962
5963         return 0;
5964 }
5965
5966 static int nl80211_update_mesh_config(struct sk_buff *skb,
5967                                       struct genl_info *info)
5968 {
5969         struct cfg80211_registered_device *rdev = info->user_ptr[0];
5970         struct net_device *dev = info->user_ptr[1];
5971         struct wireless_dev *wdev = dev->ieee80211_ptr;
5972         struct mesh_config cfg;
5973         u32 mask;
5974         int err;
5975
5976         if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
5977                 return -EOPNOTSUPP;
5978
5979         if (!rdev->ops->update_mesh_config)
5980                 return -EOPNOTSUPP;
5981
5982         err = nl80211_parse_mesh_config(info, &cfg, &mask);
5983         if (err)
5984                 return err;
5985
5986         wdev_lock(wdev);
5987         if (!wdev->mesh_id_len)
5988                 err = -ENOLINK;
5989
5990         if (!err)
5991                 err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
5992
5993         wdev_unlock(wdev);
5994
5995         return err;
5996 }
5997
5998 static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
5999                               struct sk_buff *msg)
6000 {
6001         struct nlattr *nl_reg_rules;
6002         unsigned int i;
6003
6004         if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
6005             (regdom->dfs_region &&
6006              nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
6007                 goto nla_put_failure;
6008
6009         nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
6010         if (!nl_reg_rules)
6011                 goto nla_put_failure;
6012
6013         for (i = 0; i < regdom->n_reg_rules; i++) {
6014                 struct nlattr *nl_reg_rule;
6015                 const struct ieee80211_reg_rule *reg_rule;
6016                 const struct ieee80211_freq_range *freq_range;
6017                 const struct ieee80211_power_rule *power_rule;
6018                 unsigned int max_bandwidth_khz;
6019
6020                 reg_rule = &regdom->reg_rules[i];
6021                 freq_range = &reg_rule->freq_range;
6022                 power_rule = &reg_rule->power_rule;
6023
6024                 nl_reg_rule = nla_nest_start(msg, i);
6025                 if (!nl_reg_rule)
6026                         goto nla_put_failure;
6027
6028                 max_bandwidth_khz = freq_range->max_bandwidth_khz;
6029                 if (!max_bandwidth_khz)
6030                         max_bandwidth_khz = reg_get_max_bandwidth(regdom,
6031                                                                   reg_rule);
6032
6033                 if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
6034                                 reg_rule->flags) ||
6035                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
6036                                 freq_range->start_freq_khz) ||
6037                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
6038                                 freq_range->end_freq_khz) ||
6039                     nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
6040                                 max_bandwidth_khz) ||
6041                     nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
6042                                 power_rule->max_antenna_gain) ||
6043                     nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
6044                                 power_rule->max_eirp) ||
6045                     nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
6046                                 reg_rule->dfs_cac_ms))
6047                         goto nla_put_failure;
6048
6049                 nla_nest_end(msg, nl_reg_rule);
6050         }
6051
6052         nla_nest_end(msg, nl_reg_rules);
6053         return 0;
6054
6055 nla_put_failure:
6056         return -EMSGSIZE;
6057 }
6058
6059 static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
6060 {
6061         const struct ieee80211_regdomain *regdom = NULL;
6062         struct cfg80211_registered_device *rdev;
6063         struct wiphy *wiphy = NULL;
6064         struct sk_buff *msg;
6065         void *hdr;
6066
6067         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
6068         if (!msg)
6069                 return -ENOBUFS;
6070
6071         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
6072                              NL80211_CMD_GET_REG);
6073         if (!hdr)
6074                 goto put_failure;
6075
6076         if (info->attrs[NL80211_ATTR_WIPHY]) {
6077                 bool self_managed;
6078
6079                 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
6080                 if (IS_ERR(rdev)) {
6081                         nlmsg_free(msg);
6082                         return PTR_ERR(rdev);
6083                 }
6084
6085                 wiphy = &rdev->wiphy;
6086                 self_managed = wiphy->regulatory_flags &
6087                                REGULATORY_WIPHY_SELF_MANAGED;
6088                 regdom = get_wiphy_regdom(wiphy);
6089
6090                 /* a self-managed-reg device must have a private regdom */
6091                 if (WARN_ON(!regdom && self_managed)) {
6092                         nlmsg_free(msg);
6093                         return -EINVAL;
6094                 }
6095
6096                 if (regdom &&
6097                     nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6098                         goto nla_put_failure;
6099         }
6100
6101         if (!wiphy && reg_last_request_cell_base() &&
6102             nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6103                         NL80211_USER_REG_HINT_CELL_BASE))
6104                 goto nla_put_failure;
6105
6106         rcu_read_lock();
6107
6108         if (!regdom)
6109                 regdom = rcu_dereference(cfg80211_regdomain);
6110
6111         if (nl80211_put_regdom(regdom, msg))
6112                 goto nla_put_failure_rcu;
6113
6114         rcu_read_unlock();
6115
6116         genlmsg_end(msg, hdr);
6117         return genlmsg_reply(msg, info);
6118
6119 nla_put_failure_rcu:
6120         rcu_read_unlock();
6121 nla_put_failure:
6122         genlmsg_cancel(msg, hdr);
6123 put_failure:
6124         nlmsg_free(msg);
6125         return -EMSGSIZE;
6126 }
6127
6128 static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
6129                                u32 seq, int flags, struct wiphy *wiphy,
6130                                const struct ieee80211_regdomain *regdom)
6131 {
6132         void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
6133                                    NL80211_CMD_GET_REG);
6134
6135         if (!hdr)
6136                 return -1;
6137
6138         genl_dump_check_consistent(cb, hdr, &nl80211_fam);
6139
6140         if (nl80211_put_regdom(regdom, msg))
6141                 goto nla_put_failure;
6142
6143         if (!wiphy && reg_last_request_cell_base() &&
6144             nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
6145                         NL80211_USER_REG_HINT_CELL_BASE))
6146                 goto nla_put_failure;
6147
6148         if (wiphy &&
6149             nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
6150                 goto nla_put_failure;
6151
6152         if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
6153             nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
6154                 goto nla_put_failure;
6155
6156         genlmsg_end(msg, hdr);
6157         return 0;
6158
6159 nla_put_failure:
6160         genlmsg_cancel(msg, hdr);
6161         return -EMSGSIZE;
6162 }
6163
6164 static int nl80211_get_reg_dump(struct sk_buff *skb,
6165                                 struct netlink_callback *cb)
6166 {
6167         const struct ieee80211_regdomain *regdom = NULL;
6168         struct cfg80211_registered_device *rdev;
6169         int err, reg_idx, start = cb->args[2];
6170
6171         rtnl_lock();
6172
6173         if (cfg80211_regdomain && start == 0) {
6174                 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6175                                           NLM_F_MULTI, NULL,
6176                                           rtnl_dereference(cfg80211_regdomain));
6177                 if (err < 0)
6178                         goto out_err;
6179         }
6180
6181         /* the global regdom is idx 0 */
6182         reg_idx = 1;
6183         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
6184                 regdom = get_wiphy_regdom(&rdev->wiphy);
6185                 if (!regdom)
6186                         continue;
6187
6188                 if (++reg_idx <= start)
6189                         continue;
6190
6191                 err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
6192                                           NLM_F_MULTI, &rdev->wiphy, regdom);
6193                 if (err < 0) {
6194                         reg_idx--;
6195                         break;
6196                 }
6197         }
6198
6199         cb->args[2] = reg_idx;
6200         err = skb->len;
6201 out_err:
6202         rtnl_unlock();
6203         return err;
6204 }
6205
6206 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
6207 static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
6208         [NL80211_ATTR_REG_RULE_FLAGS]           = { .type = NLA_U32 },
6209         [NL80211_ATTR_FREQ_RANGE_START]         = { .type = NLA_U32 },
6210         [NL80211_ATTR_FREQ_RANGE_END]           = { .type = NLA_U32 },
6211         [NL80211_ATTR_FREQ_RANGE_MAX_BW]        = { .type = NLA_U32 },
6212         [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]  = { .type = NLA_U32 },
6213         [NL80211_ATTR_POWER_RULE_MAX_EIRP]      = { .type = NLA_U32 },
6214         [NL80211_ATTR_DFS_CAC_TIME]             = { .type = NLA_U32 },
6215 };
6216
6217 static int parse_reg_rule(struct nlattr *tb[],
6218         struct ieee80211_reg_rule *reg_rule)
6219 {
6220         struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
6221         struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
6222
6223         if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
6224                 return -EINVAL;
6225         if (!tb[NL80211_ATTR_FREQ_RANGE_START])
6226                 return -EINVAL;
6227         if (!tb[NL80211_ATTR_FREQ_RANGE_END])
6228                 return -EINVAL;
6229         if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
6230                 return -EINVAL;
6231         if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
6232                 return -EINVAL;
6233
6234         reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
6235
6236         freq_range->start_freq_khz =
6237                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
6238         freq_range->end_freq_khz =
6239                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
6240         freq_range->max_bandwidth_khz =
6241                 nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
6242
6243         power_rule->max_eirp =
6244                 nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
6245
6246         if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
6247                 power_rule->max_antenna_gain =
6248                         nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
6249
6250         if (tb[NL80211_ATTR_DFS_CAC_TIME])
6251                 reg_rule->dfs_cac_ms =
6252                         nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
6253
6254         return 0;
6255 }
6256
6257 static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
6258 {
6259         struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
6260         struct nlattr *nl_reg_rule;
6261         char *alpha2;
6262         int rem_reg_rules, r;
6263         u32 num_rules = 0, rule_idx = 0, size_of_regd;
6264         enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
6265         struct ieee80211_regdomain *rd;
6266
6267         if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
6268                 return -EINVAL;
6269
6270         if (!info->attrs[NL80211_ATTR_REG_RULES])
6271                 return -EINVAL;
6272
6273         alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
6274
6275         if (info->attrs[NL80211_ATTR_DFS_REGION])
6276                 dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
6277
6278         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
6279                             rem_reg_rules) {
6280                 num_rules++;
6281                 if (num_rules > NL80211_MAX_SUPP_REG_RULES)
6282                         return -EINVAL;
6283         }
6284
6285         if (!reg_is_valid_request(alpha2))
6286                 return -EINVAL;
6287
6288         size_of_regd = sizeof(struct ieee80211_regdomain) +
6289                        num_rules * sizeof(struct ieee80211_reg_rule);
6290
6291         rd = kzalloc(size_of_regd, GFP_KERNEL);
6292         if (!rd)
6293                 return -ENOMEM;
6294
6295         rd->n_reg_rules = num_rules;
6296         rd->alpha2[0] = alpha2[0];
6297         rd->alpha2[1] = alpha2[1];
6298
6299         /*
6300          * Disable DFS master mode if the DFS region was
6301          * not supported or known on this kernel.
6302          */
6303         if (reg_supported_dfs_region(dfs_region))
6304                 rd->dfs_region = dfs_region;
6305
6306         nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
6307                             rem_reg_rules) {
6308                 r = nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
6309                               nla_data(nl_reg_rule), nla_len(nl_reg_rule),
6310                               reg_rule_policy);
6311                 if (r)
6312                         goto bad_reg;
6313                 r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
6314                 if (r)
6315                         goto bad_reg;
6316
6317                 rule_idx++;
6318
6319                 if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
6320                         r = -EINVAL;
6321                         goto bad_reg;
6322                 }
6323         }
6324
6325         /* set_regdom takes ownership of rd */
6326         return set_regdom(rd, REGD_SOURCE_CRDA);
6327  bad_reg:
6328         kfree(rd);
6329         return r;
6330 }
6331 #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
6332
6333 static int validate_scan_freqs(struct nlattr *freqs)
6334 {
6335         struct nlattr *attr1, *attr2;
6336         int n_channels = 0, tmp1, tmp2;
6337
6338         nla_for_each_nested(attr1, freqs, tmp1) {
6339                 n_channels++;
6340                 /*
6341                  * Some hardware has a limited channel list for
6342                  * scanning, and it is pretty much nonsensical
6343                  * to scan for a channel twice, so disallow that
6344                  * and don't require drivers to check that the
6345                  * channel list they get isn't longer than what
6346                  * they can scan, as long as they can scan all
6347                  * the channels they registered at once.
6348                  */
6349                 nla_for_each_nested(attr2, freqs, tmp2)
6350                         if (attr1 != attr2 &&
6351                             nla_get_u32(attr1) == nla_get_u32(attr2))
6352                                 return 0;
6353         }
6354
6355         return n_channels;
6356 }
6357
6358 static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
6359 {
6360         return b < NUM_NL80211_BANDS && wiphy->bands[b];
6361 }
6362
6363 static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
6364                             struct cfg80211_bss_selection *bss_select)
6365 {
6366         struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
6367         struct nlattr *nest;
6368         int err;
6369         bool found = false;
6370         int i;
6371
6372         /* only process one nested attribute */
6373         nest = nla_data(nla);
6374         if (!nla_ok(nest, nla_len(nest)))
6375                 return -EINVAL;
6376
6377         err = nla_parse(attr, NL80211_BSS_SELECT_ATTR_MAX, nla_data(nest),
6378                         nla_len(nest), nl80211_bss_select_policy);
6379         if (err)
6380                 return err;
6381
6382         /* only one attribute may be given */
6383         for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
6384                 if (attr[i]) {
6385                         if (found)
6386                                 return -EINVAL;
6387                         found = true;
6388                 }
6389         }
6390
6391         bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
6392
6393         if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
6394                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
6395
6396         if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
6397                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
6398                 bss_select->param.band_pref =
6399                         nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
6400                 if (!is_band_valid(wiphy, bss_select->param.band_pref))
6401                         return -EINVAL;
6402         }
6403
6404         if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
6405                 struct nl80211_bss_select_rssi_adjust *adj_param;
6406
6407                 adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
6408                 bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
6409                 bss_select->param.adjust.band = adj_param->band;
6410                 bss_select->param.adjust.delta = adj_param->delta;
6411                 if (!is_band_valid(wiphy, bss_select->param.adjust.band))
6412                         return -EINVAL;
6413         }
6414
6415         /* user-space did not provide behaviour attribute */
6416         if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
6417                 return -EINVAL;
6418
6419         if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
6420                 return -EINVAL;
6421
6422         return 0;
6423 }
6424
6425 static int nl80211_parse_random_mac(struct nlattr **attrs,
6426                                     u8 *mac_addr, u8 *mac_addr_mask)
6427 {
6428         int i;
6429
6430         if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
6431                 eth_zero_addr(mac_addr);
6432                 eth_zero_addr(mac_addr_mask);
6433                 mac_addr[0] = 0x2;
6434                 mac_addr_mask[0] = 0x3;
6435
6436                 return 0;
6437         }
6438
6439         /* need both or none */
6440         if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
6441                 return -EINVAL;
6442
6443         memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
6444         memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
6445
6446         /* don't allow or configure an mcast address */
6447         if (!is_multicast_ether_addr(mac_addr_mask) ||
6448             is_multicast_ether_addr(mac_addr))
6449                 return -EINVAL;
6450
6451         /*
6452          * allow users to pass a MAC address that has bits set outside
6453          * of the mask, but don't bother drivers with having to deal
6454          * with such bits
6455          */
6456         for (i = 0; i < ETH_ALEN; i++)
6457                 mac_addr[i] &= mac_addr_mask[i];
6458
6459         return 0;
6460 }
6461
6462 static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
6463 {
6464         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6465         struct wireless_dev *wdev = info->user_ptr[1];
6466         struct cfg80211_scan_request *request;
6467         struct nlattr *attr;
6468         struct wiphy *wiphy;
6469         int err, tmp, n_ssids = 0, n_channels, i;
6470         size_t ie_len;
6471
6472         if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
6473                 return -EINVAL;
6474
6475         wiphy = &rdev->wiphy;
6476
6477         if (wdev->iftype == NL80211_IFTYPE_NAN)
6478                 return -EOPNOTSUPP;
6479
6480         if (!rdev->ops->scan)
6481                 return -EOPNOTSUPP;
6482
6483         if (rdev->scan_req || rdev->scan_msg) {
6484                 err = -EBUSY;
6485                 goto unlock;
6486         }
6487
6488         if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6489                 n_channels = validate_scan_freqs(
6490                                 info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
6491                 if (!n_channels) {
6492                         err = -EINVAL;
6493                         goto unlock;
6494                 }
6495         } else {
6496                 n_channels = ieee80211_get_num_supported_channels(wiphy);
6497         }
6498
6499         if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
6500                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
6501                         n_ssids++;
6502
6503         if (n_ssids > wiphy->max_scan_ssids) {
6504                 err = -EINVAL;
6505                 goto unlock;
6506         }
6507
6508         if (info->attrs[NL80211_ATTR_IE])
6509                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6510         else
6511                 ie_len = 0;
6512
6513         if (ie_len > wiphy->max_scan_ie_len) {
6514                 err = -EINVAL;
6515                 goto unlock;
6516         }
6517
6518         request = kzalloc(sizeof(*request)
6519                         + sizeof(*request->ssids) * n_ssids
6520                         + sizeof(*request->channels) * n_channels
6521                         + ie_len, GFP_KERNEL);
6522         if (!request) {
6523                 err = -ENOMEM;
6524                 goto unlock;
6525         }
6526
6527         if (n_ssids)
6528                 request->ssids = (void *)&request->channels[n_channels];
6529         request->n_ssids = n_ssids;
6530         if (ie_len) {
6531                 if (n_ssids)
6532                         request->ie = (void *)(request->ssids + n_ssids);
6533                 else
6534                         request->ie = (void *)(request->channels + n_channels);
6535         }
6536
6537         i = 0;
6538         if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6539                 /* user specified, bail out if channel not found */
6540                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
6541                         struct ieee80211_channel *chan;
6542
6543                         chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6544
6545                         if (!chan) {
6546                                 err = -EINVAL;
6547                                 goto out_free;
6548                         }
6549
6550                         /* ignore disabled channels */
6551                         if (chan->flags & IEEE80211_CHAN_DISABLED)
6552                                 continue;
6553
6554                         request->channels[i] = chan;
6555                         i++;
6556                 }
6557         } else {
6558                 enum nl80211_band band;
6559
6560                 /* all channels */
6561                 for (band = 0; band < NUM_NL80211_BANDS; band++) {
6562                         int j;
6563
6564                         if (!wiphy->bands[band])
6565                                 continue;
6566                         for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
6567                                 struct ieee80211_channel *chan;
6568
6569                                 chan = &wiphy->bands[band]->channels[j];
6570
6571                                 if (chan->flags & IEEE80211_CHAN_DISABLED)
6572                                         continue;
6573
6574                                 request->channels[i] = chan;
6575                                 i++;
6576                         }
6577                 }
6578         }
6579
6580         if (!i) {
6581                 err = -EINVAL;
6582                 goto out_free;
6583         }
6584
6585         request->n_channels = i;
6586
6587         i = 0;
6588         if (n_ssids) {
6589                 nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
6590                         if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
6591                                 err = -EINVAL;
6592                                 goto out_free;
6593                         }
6594                         request->ssids[i].ssid_len = nla_len(attr);
6595                         memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
6596                         i++;
6597                 }
6598         }
6599
6600         if (info->attrs[NL80211_ATTR_IE]) {
6601                 request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
6602                 memcpy((void *)request->ie,
6603                        nla_data(info->attrs[NL80211_ATTR_IE]),
6604                        request->ie_len);
6605         }
6606
6607         for (i = 0; i < NUM_NL80211_BANDS; i++)
6608                 if (wiphy->bands[i])
6609                         request->rates[i] =
6610                                 (1 << wiphy->bands[i]->n_bitrates) - 1;
6611
6612         if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
6613                 nla_for_each_nested(attr,
6614                                     info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
6615                                     tmp) {
6616                         enum nl80211_band band = nla_type(attr);
6617
6618                         if (band < 0 || band >= NUM_NL80211_BANDS) {
6619                                 err = -EINVAL;
6620                                 goto out_free;
6621                         }
6622
6623                         if (!wiphy->bands[band])
6624                                 continue;
6625
6626                         err = ieee80211_get_ratemask(wiphy->bands[band],
6627                                                      nla_data(attr),
6628                                                      nla_len(attr),
6629                                                      &request->rates[band]);
6630                         if (err)
6631                                 goto out_free;
6632                 }
6633         }
6634
6635         if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
6636                 if (!wiphy_ext_feature_isset(wiphy,
6637                                         NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
6638                         err = -EOPNOTSUPP;
6639                         goto out_free;
6640                 }
6641
6642                 request->duration =
6643                         nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
6644                 request->duration_mandatory =
6645                         nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
6646         }
6647
6648         if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
6649                 request->flags = nla_get_u32(
6650                         info->attrs[NL80211_ATTR_SCAN_FLAGS]);
6651                 if ((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
6652                     !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) {
6653                         err = -EOPNOTSUPP;
6654                         goto out_free;
6655                 }
6656
6657                 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
6658                         if (!(wiphy->features &
6659                                         NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR)) {
6660                                 err = -EOPNOTSUPP;
6661                                 goto out_free;
6662                         }
6663
6664                         if (wdev->current_bss) {
6665                                 err = -EOPNOTSUPP;
6666                                 goto out_free;
6667                         }
6668
6669                         err = nl80211_parse_random_mac(info->attrs,
6670                                                        request->mac_addr,
6671                                                        request->mac_addr_mask);
6672                         if (err)
6673                                 goto out_free;
6674                 }
6675         }
6676
6677         request->no_cck =
6678                 nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
6679
6680         if (info->attrs[NL80211_ATTR_MAC])
6681                 memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
6682                        ETH_ALEN);
6683         else
6684                 eth_broadcast_addr(request->bssid);
6685
6686         request->wdev = wdev;
6687         request->wiphy = &rdev->wiphy;
6688         request->scan_start = jiffies;
6689
6690         rdev->scan_req = request;
6691         err = rdev_scan(rdev, request);
6692
6693         if (!err) {
6694                 nl80211_send_scan_start(rdev, wdev);
6695                 if (wdev->netdev)
6696                         dev_hold(wdev->netdev);
6697         } else {
6698  out_free:
6699                 rdev->scan_req = NULL;
6700                 kfree(request);
6701         }
6702
6703  unlock:
6704         return err;
6705 }
6706
6707 static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
6708 {
6709         struct cfg80211_registered_device *rdev = info->user_ptr[0];
6710         struct wireless_dev *wdev = info->user_ptr[1];
6711
6712         if (!rdev->ops->abort_scan)
6713                 return -EOPNOTSUPP;
6714
6715         if (rdev->scan_msg)
6716                 return 0;
6717
6718         if (!rdev->scan_req)
6719                 return -ENOENT;
6720
6721         rdev_abort_scan(rdev, wdev);
6722         return 0;
6723 }
6724
6725 static int
6726 nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
6727                                struct cfg80211_sched_scan_request *request,
6728                                struct nlattr **attrs)
6729 {
6730         int tmp, err, i = 0;
6731         struct nlattr *attr;
6732
6733         if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
6734                 u32 interval;
6735
6736                 /*
6737                  * If scan plans are not specified,
6738                  * %NL80211_ATTR_SCHED_SCAN_INTERVAL must be specified. In this
6739                  * case one scan plan will be set with the specified scan
6740                  * interval and infinite number of iterations.
6741                  */
6742                 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
6743                         return -EINVAL;
6744
6745                 interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
6746                 if (!interval)
6747                         return -EINVAL;
6748
6749                 request->scan_plans[0].interval =
6750                         DIV_ROUND_UP(interval, MSEC_PER_SEC);
6751                 if (!request->scan_plans[0].interval)
6752                         return -EINVAL;
6753
6754                 if (request->scan_plans[0].interval >
6755                     wiphy->max_sched_scan_plan_interval)
6756                         request->scan_plans[0].interval =
6757                                 wiphy->max_sched_scan_plan_interval;
6758
6759                 return 0;
6760         }
6761
6762         nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
6763                 struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
6764
6765                 if (WARN_ON(i >= n_plans))
6766                         return -EINVAL;
6767
6768                 err = nla_parse(plan, NL80211_SCHED_SCAN_PLAN_MAX,
6769                                 nla_data(attr), nla_len(attr),
6770                                 nl80211_plan_policy);
6771                 if (err)
6772                         return err;
6773
6774                 if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
6775                         return -EINVAL;
6776
6777                 request->scan_plans[i].interval =
6778                         nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
6779                 if (!request->scan_plans[i].interval ||
6780                     request->scan_plans[i].interval >
6781                     wiphy->max_sched_scan_plan_interval)
6782                         return -EINVAL;
6783
6784                 if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
6785                         request->scan_plans[i].iterations =
6786                                 nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
6787                         if (!request->scan_plans[i].iterations ||
6788                             (request->scan_plans[i].iterations >
6789                              wiphy->max_sched_scan_plan_iterations))
6790                                 return -EINVAL;
6791                 } else if (i < n_plans - 1) {
6792                         /*
6793                          * All scan plans but the last one must specify
6794                          * a finite number of iterations
6795                          */
6796                         return -EINVAL;
6797                 }
6798
6799                 i++;
6800         }
6801
6802         /*
6803          * The last scan plan must not specify the number of
6804          * iterations, it is supposed to run infinitely
6805          */
6806         if (request->scan_plans[n_plans - 1].iterations)
6807                 return  -EINVAL;
6808
6809         return 0;
6810 }
6811
6812 static struct cfg80211_sched_scan_request *
6813 nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
6814                          struct nlattr **attrs)
6815 {
6816         struct cfg80211_sched_scan_request *request;
6817         struct nlattr *attr;
6818         int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
6819         enum nl80211_band band;
6820         size_t ie_len;
6821         struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
6822         s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
6823
6824         if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
6825                 return ERR_PTR(-EINVAL);
6826
6827         if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6828                 n_channels = validate_scan_freqs(
6829                                 attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
6830                 if (!n_channels)
6831                         return ERR_PTR(-EINVAL);
6832         } else {
6833                 n_channels = ieee80211_get_num_supported_channels(wiphy);
6834         }
6835
6836         if (attrs[NL80211_ATTR_SCAN_SSIDS])
6837                 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
6838                                     tmp)
6839                         n_ssids++;
6840
6841         if (n_ssids > wiphy->max_sched_scan_ssids)
6842                 return ERR_PTR(-EINVAL);
6843
6844         /*
6845          * First, count the number of 'real' matchsets. Due to an issue with
6846          * the old implementation, matchsets containing only the RSSI attribute
6847          * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
6848          * RSSI for all matchsets, rather than their own matchset for reporting
6849          * all APs with a strong RSSI. This is needed to be compatible with
6850          * older userspace that treated a matchset with only the RSSI as the
6851          * global RSSI for all other matchsets - if there are other matchsets.
6852          */
6853         if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
6854                 nla_for_each_nested(attr,
6855                                     attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
6856                                     tmp) {
6857                         struct nlattr *rssi;
6858
6859                         err = nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
6860                                         nla_data(attr), nla_len(attr),
6861                                         nl80211_match_policy);
6862                         if (err)
6863                                 return ERR_PTR(err);
6864                         /* add other standalone attributes here */
6865                         if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID]) {
6866                                 n_match_sets++;
6867                                 continue;
6868                         }
6869                         rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
6870                         if (rssi)
6871                                 default_match_rssi = nla_get_s32(rssi);
6872                 }
6873         }
6874
6875         /* However, if there's no other matchset, add the RSSI one */
6876         if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
6877                 n_match_sets = 1;
6878
6879         if (n_match_sets > wiphy->max_match_sets)
6880                 return ERR_PTR(-EINVAL);
6881
6882         if (attrs[NL80211_ATTR_IE])
6883                 ie_len = nla_len(attrs[NL80211_ATTR_IE]);
6884         else
6885                 ie_len = 0;
6886
6887         if (ie_len > wiphy->max_sched_scan_ie_len)
6888                 return ERR_PTR(-EINVAL);
6889
6890         if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
6891                 /*
6892                  * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
6893                  * each scan plan already specifies its own interval
6894                  */
6895                 if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
6896                         return ERR_PTR(-EINVAL);
6897
6898                 nla_for_each_nested(attr,
6899                                     attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
6900                         n_plans++;
6901         } else {
6902                 /*
6903                  * The scan interval attribute is kept for backward
6904                  * compatibility. If no scan plans are specified and sched scan
6905                  * interval is specified, one scan plan will be set with this
6906                  * scan interval and infinite number of iterations.
6907                  */
6908                 if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
6909                         return ERR_PTR(-EINVAL);
6910
6911                 n_plans = 1;
6912         }
6913
6914         if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
6915                 return ERR_PTR(-EINVAL);
6916
6917         request = kzalloc(sizeof(*request)
6918                         + sizeof(*request->ssids) * n_ssids
6919                         + sizeof(*request->match_sets) * n_match_sets
6920                         + sizeof(*request->scan_plans) * n_plans
6921                         + sizeof(*request->channels) * n_channels
6922                         + ie_len, GFP_KERNEL);
6923         if (!request)
6924                 return ERR_PTR(-ENOMEM);
6925
6926         if (n_ssids)
6927                 request->ssids = (void *)&request->channels[n_channels];
6928         request->n_ssids = n_ssids;
6929         if (ie_len) {
6930                 if (n_ssids)
6931                         request->ie = (void *)(request->ssids + n_ssids);
6932                 else
6933                         request->ie = (void *)(request->channels + n_channels);
6934         }
6935
6936         if (n_match_sets) {
6937                 if (request->ie)
6938                         request->match_sets = (void *)(request->ie + ie_len);
6939                 else if (n_ssids)
6940                         request->match_sets =
6941                                 (void *)(request->ssids + n_ssids);
6942                 else
6943                         request->match_sets =
6944                                 (void *)(request->channels + n_channels);
6945         }
6946         request->n_match_sets = n_match_sets;
6947
6948         if (n_match_sets)
6949                 request->scan_plans = (void *)(request->match_sets +
6950                                                n_match_sets);
6951         else if (request->ie)
6952                 request->scan_plans = (void *)(request->ie + ie_len);
6953         else if (n_ssids)
6954                 request->scan_plans = (void *)(request->ssids + n_ssids);
6955         else
6956                 request->scan_plans = (void *)(request->channels + n_channels);
6957
6958         request->n_scan_plans = n_plans;
6959
6960         i = 0;
6961         if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
6962                 /* user specified, bail out if channel not found */
6963                 nla_for_each_nested(attr,
6964                                     attrs[NL80211_ATTR_SCAN_FREQUENCIES],
6965                                     tmp) {
6966                         struct ieee80211_channel *chan;
6967
6968                         chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
6969
6970                         if (!chan) {
6971                                 err = -EINVAL;
6972                                 goto out_free;
6973                         }
6974
6975                         /* ignore disabled channels */
6976                         if (chan->flags & IEEE80211_CHAN_DISABLED)
6977                                 continue;
6978
6979                         request->channels[i] = chan;
6980                         i++;
6981                 }
6982         } else {
6983                 /* all channels */
6984                 for (band = 0; band < NUM_NL80211_BANDS; band++) {
6985                         int j;
6986
6987                         if (!wiphy->bands[band])
6988                                 continue;
6989                         for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
6990                                 struct ieee80211_channel *chan;
6991
6992                                 chan = &wiphy->bands[band]->channels[j];
6993
6994                                 if (chan->flags & IEEE80211_CHAN_DISABLED)
6995                                         continue;
6996
6997                                 request->channels[i] = chan;
6998                                 i++;
6999                         }
7000                 }
7001         }
7002
7003         if (!i) {
7004                 err = -EINVAL;
7005                 goto out_free;
7006         }
7007
7008         request->n_channels = i;
7009
7010         i = 0;
7011         if (n_ssids) {
7012                 nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
7013                                     tmp) {
7014                         if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
7015                                 err = -EINVAL;
7016                                 goto out_free;
7017                         }
7018                         request->ssids[i].ssid_len = nla_len(attr);
7019                         memcpy(request->ssids[i].ssid, nla_data(attr),
7020                                nla_len(attr));
7021                         i++;
7022                 }
7023         }
7024
7025         i = 0;
7026         if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
7027                 nla_for_each_nested(attr,
7028                                     attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
7029                                     tmp) {
7030                         struct nlattr *ssid, *rssi;
7031
7032                         err = nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
7033                                         nla_data(attr), nla_len(attr),
7034                                         nl80211_match_policy);
7035                         if (err)
7036                                 goto out_free;
7037                         ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
7038                         if (ssid) {
7039                                 if (WARN_ON(i >= n_match_sets)) {
7040                                         /* this indicates a programming error,
7041                                          * the loop above should have verified
7042                                          * things properly
7043                                          */
7044                                         err = -EINVAL;
7045                                         goto out_free;
7046                                 }
7047
7048                                 if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
7049                                         err = -EINVAL;
7050                                         goto out_free;
7051                                 }
7052                                 memcpy(request->match_sets[i].ssid.ssid,
7053                                        nla_data(ssid), nla_len(ssid));
7054                                 request->match_sets[i].ssid.ssid_len =
7055                                         nla_len(ssid);
7056                                 /* special attribute - old implementation w/a */
7057                                 request->match_sets[i].rssi_thold =
7058                                         default_match_rssi;
7059                                 rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
7060                                 if (rssi)
7061                                         request->match_sets[i].rssi_thold =
7062                                                 nla_get_s32(rssi);
7063                         }
7064                         i++;
7065                 }
7066
7067                 /* there was no other matchset, so the RSSI one is alone */
7068                 if (i == 0 && n_match_sets)
7069                         request->match_sets[0].rssi_thold = default_match_rssi;
7070
7071                 request->min_rssi_thold = INT_MAX;
7072                 for (i = 0; i < n_match_sets; i++)
7073                         request->min_rssi_thold =
7074                                 min(request->match_sets[i].rssi_thold,
7075                                     request->min_rssi_thold);
7076         } else {
7077                 request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
7078         }
7079
7080         if (ie_len) {
7081                 request->ie_len = ie_len;
7082                 memcpy((void *)request->ie,
7083                        nla_data(attrs[NL80211_ATTR_IE]),
7084                        request->ie_len);
7085         }
7086
7087         if (attrs[NL80211_ATTR_SCAN_FLAGS]) {
7088                 request->flags = nla_get_u32(
7089                         attrs[NL80211_ATTR_SCAN_FLAGS]);
7090                 if ((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
7091                     !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) {
7092                         err = -EOPNOTSUPP;
7093                         goto out_free;
7094                 }
7095
7096                 if (request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
7097                         u32 flg = NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR;
7098
7099                         if (!wdev) /* must be net-detect */
7100                                 flg = NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
7101
7102                         if (!(wiphy->features & flg)) {
7103                                 err = -EOPNOTSUPP;
7104                                 goto out_free;
7105                         }
7106
7107                         if (wdev && wdev->current_bss) {
7108                                 err = -EOPNOTSUPP;
7109                                 goto out_free;
7110                         }
7111
7112                         err = nl80211_parse_random_mac(attrs, request->mac_addr,
7113                                                        request->mac_addr_mask);
7114                         if (err)
7115                                 goto out_free;
7116                 }
7117         }
7118
7119         if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
7120                 request->delay =
7121                         nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
7122
7123         err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
7124         if (err)
7125                 goto out_free;
7126
7127         request->scan_start = jiffies;
7128
7129         return request;
7130
7131 out_free:
7132         kfree(request);
7133         return ERR_PTR(err);
7134 }
7135
7136 static int nl80211_start_sched_scan(struct sk_buff *skb,
7137                                     struct genl_info *info)
7138 {
7139         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7140         struct net_device *dev = info->user_ptr[1];
7141         struct wireless_dev *wdev = dev->ieee80211_ptr;
7142         struct cfg80211_sched_scan_request *sched_scan_req;
7143         int err;
7144
7145         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
7146             !rdev->ops->sched_scan_start)
7147                 return -EOPNOTSUPP;
7148
7149         if (rdev->sched_scan_req)
7150                 return -EINPROGRESS;
7151
7152         sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
7153                                                   info->attrs);
7154
7155         err = PTR_ERR_OR_ZERO(sched_scan_req);
7156         if (err)
7157                 goto out_err;
7158
7159         err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
7160         if (err)
7161                 goto out_free;
7162
7163         sched_scan_req->dev = dev;
7164         sched_scan_req->wiphy = &rdev->wiphy;
7165
7166         if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
7167                 sched_scan_req->owner_nlportid = info->snd_portid;
7168
7169         rcu_assign_pointer(rdev->sched_scan_req, sched_scan_req);
7170
7171         nl80211_send_sched_scan(rdev, dev,
7172                                 NL80211_CMD_START_SCHED_SCAN);
7173         return 0;
7174
7175 out_free:
7176         kfree(sched_scan_req);
7177 out_err:
7178         return err;
7179 }
7180
7181 static int nl80211_stop_sched_scan(struct sk_buff *skb,
7182                                    struct genl_info *info)
7183 {
7184         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7185
7186         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
7187             !rdev->ops->sched_scan_stop)
7188                 return -EOPNOTSUPP;
7189
7190         return __cfg80211_stop_sched_scan(rdev, false);
7191 }
7192
7193 static int nl80211_start_radar_detection(struct sk_buff *skb,
7194                                          struct genl_info *info)
7195 {
7196         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7197         struct net_device *dev = info->user_ptr[1];
7198         struct wireless_dev *wdev = dev->ieee80211_ptr;
7199         struct cfg80211_chan_def chandef;
7200         enum nl80211_dfs_regions dfs_region;
7201         unsigned int cac_time_ms;
7202         int err;
7203
7204         dfs_region = reg_get_dfs_region(wdev->wiphy);
7205         if (dfs_region == NL80211_DFS_UNSET)
7206                 return -EINVAL;
7207
7208         err = nl80211_parse_chandef(rdev, info, &chandef);
7209         if (err)
7210                 return err;
7211
7212         if (netif_carrier_ok(dev))
7213                 return -EBUSY;
7214
7215         if (wdev->cac_started)
7216                 return -EBUSY;
7217
7218         err = cfg80211_chandef_dfs_required(wdev->wiphy, &chandef,
7219                                             wdev->iftype);
7220         if (err < 0)
7221                 return err;
7222
7223         if (err == 0)
7224                 return -EINVAL;
7225
7226         if (!cfg80211_chandef_dfs_usable(wdev->wiphy, &chandef))
7227                 return -EINVAL;
7228
7229         if (!rdev->ops->start_radar_detection)
7230                 return -EOPNOTSUPP;
7231
7232         cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
7233         if (WARN_ON(!cac_time_ms))
7234                 cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
7235
7236         err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
7237         if (!err) {
7238                 wdev->chandef = chandef;
7239                 wdev->cac_started = true;
7240                 wdev->cac_start_time = jiffies;
7241                 wdev->cac_time_ms = cac_time_ms;
7242         }
7243         return err;
7244 }
7245
7246 static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
7247 {
7248         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7249         struct net_device *dev = info->user_ptr[1];
7250         struct wireless_dev *wdev = dev->ieee80211_ptr;
7251         struct cfg80211_csa_settings params;
7252         /* csa_attrs is defined static to avoid waste of stack size - this
7253          * function is called under RTNL lock, so this should not be a problem.
7254          */
7255         static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
7256         int err;
7257         bool need_new_beacon = false;
7258         int len, i;
7259         u32 cs_count;
7260
7261         if (!rdev->ops->channel_switch ||
7262             !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
7263                 return -EOPNOTSUPP;
7264
7265         switch (dev->ieee80211_ptr->iftype) {
7266         case NL80211_IFTYPE_AP:
7267         case NL80211_IFTYPE_P2P_GO:
7268                 need_new_beacon = true;
7269
7270                 /* useless if AP is not running */
7271                 if (!wdev->beacon_interval)
7272                         return -ENOTCONN;
7273                 break;
7274         case NL80211_IFTYPE_ADHOC:
7275                 if (!wdev->ssid_len)
7276                         return -ENOTCONN;
7277                 break;
7278         case NL80211_IFTYPE_MESH_POINT:
7279                 if (!wdev->mesh_id_len)
7280                         return -ENOTCONN;
7281                 break;
7282         default:
7283                 return -EOPNOTSUPP;
7284         }
7285
7286         memset(&params, 0, sizeof(params));
7287
7288         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
7289             !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
7290                 return -EINVAL;
7291
7292         /* only important for AP, IBSS and mesh create IEs internally */
7293         if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
7294                 return -EINVAL;
7295
7296         /* Even though the attribute is u32, the specification says
7297          * u8, so let's make sure we don't overflow.
7298          */
7299         cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
7300         if (cs_count > 255)
7301                 return -EINVAL;
7302
7303         params.count = cs_count;
7304
7305         if (!need_new_beacon)
7306                 goto skip_beacons;
7307
7308         err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
7309         if (err)
7310                 return err;
7311
7312         err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
7313                                info->attrs[NL80211_ATTR_CSA_IES],
7314                                nl80211_policy);
7315         if (err)
7316                 return err;
7317
7318         err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
7319         if (err)
7320                 return err;
7321
7322         if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
7323                 return -EINVAL;
7324
7325         len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7326         if (!len || (len % sizeof(u16)))
7327                 return -EINVAL;
7328
7329         params.n_counter_offsets_beacon = len / sizeof(u16);
7330         if (rdev->wiphy.max_num_csa_counters &&
7331             (params.n_counter_offsets_beacon >
7332              rdev->wiphy.max_num_csa_counters))
7333                 return -EINVAL;
7334
7335         params.counter_offsets_beacon =
7336                 nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
7337
7338         /* sanity checks - counters should fit and be the same */
7339         for (i = 0; i < params.n_counter_offsets_beacon; i++) {
7340                 u16 offset = params.counter_offsets_beacon[i];
7341
7342                 if (offset >= params.beacon_csa.tail_len)
7343                         return -EINVAL;
7344
7345                 if (params.beacon_csa.tail[offset] != params.count)
7346                         return -EINVAL;
7347         }
7348
7349         if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
7350                 len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7351                 if (!len || (len % sizeof(u16)))
7352                         return -EINVAL;
7353
7354                 params.n_counter_offsets_presp = len / sizeof(u16);
7355                 if (rdev->wiphy.max_num_csa_counters &&
7356                     (params.n_counter_offsets_presp >
7357                      rdev->wiphy.max_num_csa_counters))
7358                         return -EINVAL;
7359
7360                 params.counter_offsets_presp =
7361                         nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
7362
7363                 /* sanity checks - counters should fit and be the same */
7364                 for (i = 0; i < params.n_counter_offsets_presp; i++) {
7365                         u16 offset = params.counter_offsets_presp[i];
7366
7367                         if (offset >= params.beacon_csa.probe_resp_len)
7368                                 return -EINVAL;
7369
7370                         if (params.beacon_csa.probe_resp[offset] !=
7371                             params.count)
7372                                 return -EINVAL;
7373                 }
7374         }
7375
7376 skip_beacons:
7377         err = nl80211_parse_chandef(rdev, info, &params.chandef);
7378         if (err)
7379                 return err;
7380
7381         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
7382                                            wdev->iftype))
7383                 return -EINVAL;
7384
7385         err = cfg80211_chandef_dfs_required(wdev->wiphy,
7386                                             &params.chandef,
7387                                             wdev->iftype);
7388         if (err < 0)
7389                 return err;
7390
7391         if (err > 0)
7392                 params.radar_required = true;
7393
7394         if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
7395                 params.block_tx = true;
7396
7397         wdev_lock(wdev);
7398         err = rdev_channel_switch(rdev, dev, &params);
7399         wdev_unlock(wdev);
7400
7401         return err;
7402 }
7403
7404 static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
7405                             u32 seq, int flags,
7406                             struct cfg80211_registered_device *rdev,
7407                             struct wireless_dev *wdev,
7408                             struct cfg80211_internal_bss *intbss)
7409 {
7410         struct cfg80211_bss *res = &intbss->pub;
7411         const struct cfg80211_bss_ies *ies;
7412         void *hdr;
7413         struct nlattr *bss;
7414
7415         ASSERT_WDEV_LOCK(wdev);
7416
7417         hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
7418                              NL80211_CMD_NEW_SCAN_RESULTS);
7419         if (!hdr)
7420                 return -1;
7421
7422         genl_dump_check_consistent(cb, hdr, &nl80211_fam);
7423
7424         if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
7425                 goto nla_put_failure;
7426         if (wdev->netdev &&
7427             nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
7428                 goto nla_put_failure;
7429         if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
7430                               NL80211_ATTR_PAD))
7431                 goto nla_put_failure;
7432
7433         bss = nla_nest_start(msg, NL80211_ATTR_BSS);
7434         if (!bss)
7435                 goto nla_put_failure;
7436         if ((!is_zero_ether_addr(res->bssid) &&
7437              nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
7438                 goto nla_put_failure;
7439
7440         rcu_read_lock();
7441         /* indicate whether we have probe response data or not */
7442         if (rcu_access_pointer(res->proberesp_ies) &&
7443             nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
7444                 goto fail_unlock_rcu;
7445
7446         /* this pointer prefers to be pointed to probe response data
7447          * but is always valid
7448          */
7449         ies = rcu_dereference(res->ies);
7450         if (ies) {
7451                 if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
7452                                       NL80211_BSS_PAD))
7453                         goto fail_unlock_rcu;
7454                 if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
7455                                         ies->len, ies->data))
7456                         goto fail_unlock_rcu;
7457         }
7458
7459         /* and this pointer is always (unless driver didn't know) beacon data */
7460         ies = rcu_dereference(res->beacon_ies);
7461         if (ies && ies->from_beacon) {
7462                 if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
7463                                       NL80211_BSS_PAD))
7464                         goto fail_unlock_rcu;
7465                 if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
7466                                         ies->len, ies->data))
7467                         goto fail_unlock_rcu;
7468         }
7469         rcu_read_unlock();
7470
7471         if (res->beacon_interval &&
7472             nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
7473                 goto nla_put_failure;
7474         if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
7475             nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
7476             nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
7477             nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
7478                         jiffies_to_msecs(jiffies - intbss->ts)))
7479                 goto nla_put_failure;
7480
7481         if (intbss->parent_tsf &&
7482             (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
7483                                intbss->parent_tsf, NL80211_BSS_PAD) ||
7484              nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
7485                      intbss->parent_bssid)))
7486                 goto nla_put_failure;
7487
7488         if (intbss->ts_boottime &&
7489             nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
7490                               intbss->ts_boottime, NL80211_BSS_PAD))
7491                 goto nla_put_failure;
7492
7493         switch (rdev->wiphy.signal_type) {
7494         case CFG80211_SIGNAL_TYPE_MBM:
7495                 if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
7496                         goto nla_put_failure;
7497                 break;
7498         case CFG80211_SIGNAL_TYPE_UNSPEC:
7499                 if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
7500                         goto nla_put_failure;
7501                 break;
7502         default:
7503                 break;
7504         }
7505
7506         switch (wdev->iftype) {
7507         case NL80211_IFTYPE_P2P_CLIENT:
7508         case NL80211_IFTYPE_STATION:
7509                 if (intbss == wdev->current_bss &&
7510                     nla_put_u32(msg, NL80211_BSS_STATUS,
7511                                 NL80211_BSS_STATUS_ASSOCIATED))
7512                         goto nla_put_failure;
7513                 break;
7514         case NL80211_IFTYPE_ADHOC:
7515                 if (intbss == wdev->current_bss &&
7516                     nla_put_u32(msg, NL80211_BSS_STATUS,
7517                                 NL80211_BSS_STATUS_IBSS_JOINED))
7518                         goto nla_put_failure;
7519                 break;
7520         default:
7521                 break;
7522         }
7523
7524         nla_nest_end(msg, bss);
7525
7526         genlmsg_end(msg, hdr);
7527         return 0;
7528
7529  fail_unlock_rcu:
7530         rcu_read_unlock();
7531  nla_put_failure:
7532         genlmsg_cancel(msg, hdr);
7533         return -EMSGSIZE;
7534 }
7535
7536 static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
7537 {
7538         struct cfg80211_registered_device *rdev;
7539         struct cfg80211_internal_bss *scan;
7540         struct wireless_dev *wdev;
7541         int start = cb->args[2], idx = 0;
7542         int err;
7543
7544         err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
7545         if (err)
7546                 return err;
7547
7548         wdev_lock(wdev);
7549         spin_lock_bh(&rdev->bss_lock);
7550         cfg80211_bss_expire(rdev);
7551
7552         cb->seq = rdev->bss_generation;
7553
7554         list_for_each_entry(scan, &rdev->bss_list, list) {
7555                 if (++idx <= start)
7556                         continue;
7557                 if (nl80211_send_bss(skb, cb,
7558                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
7559                                 rdev, wdev, scan) < 0) {
7560                         idx--;
7561                         break;
7562                 }
7563         }
7564
7565         spin_unlock_bh(&rdev->bss_lock);
7566         wdev_unlock(wdev);
7567
7568         cb->args[2] = idx;
7569         nl80211_finish_wdev_dump(rdev);
7570
7571         return skb->len;
7572 }
7573
7574 static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
7575                                int flags, struct net_device *dev,
7576                                bool allow_radio_stats,
7577                                struct survey_info *survey)
7578 {
7579         void *hdr;
7580         struct nlattr *infoattr;
7581
7582         /* skip radio stats if userspace didn't request them */
7583         if (!survey->channel && !allow_radio_stats)
7584                 return 0;
7585
7586         hdr = nl80211hdr_put(msg, portid, seq, flags,
7587                              NL80211_CMD_NEW_SURVEY_RESULTS);
7588         if (!hdr)
7589                 return -ENOMEM;
7590
7591         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
7592                 goto nla_put_failure;
7593
7594         infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
7595         if (!infoattr)
7596                 goto nla_put_failure;
7597
7598         if (survey->channel &&
7599             nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
7600                         survey->channel->center_freq))
7601                 goto nla_put_failure;
7602
7603         if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
7604             nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
7605                 goto nla_put_failure;
7606         if ((survey->filled & SURVEY_INFO_IN_USE) &&
7607             nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
7608                 goto nla_put_failure;
7609         if ((survey->filled & SURVEY_INFO_TIME) &&
7610             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
7611                         survey->time, NL80211_SURVEY_INFO_PAD))
7612                 goto nla_put_failure;
7613         if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
7614             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
7615                               survey->time_busy, NL80211_SURVEY_INFO_PAD))
7616                 goto nla_put_failure;
7617         if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
7618             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
7619                               survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
7620                 goto nla_put_failure;
7621         if ((survey->filled & SURVEY_INFO_TIME_RX) &&
7622             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
7623                               survey->time_rx, NL80211_SURVEY_INFO_PAD))
7624                 goto nla_put_failure;
7625         if ((survey->filled & SURVEY_INFO_TIME_TX) &&
7626             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
7627                               survey->time_tx, NL80211_SURVEY_INFO_PAD))
7628                 goto nla_put_failure;
7629         if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
7630             nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
7631                               survey->time_scan, NL80211_SURVEY_INFO_PAD))
7632                 goto nla_put_failure;
7633
7634         nla_nest_end(msg, infoattr);
7635
7636         genlmsg_end(msg, hdr);
7637         return 0;
7638
7639  nla_put_failure:
7640         genlmsg_cancel(msg, hdr);
7641         return -EMSGSIZE;
7642 }
7643
7644 static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
7645 {
7646         struct survey_info survey;
7647         struct cfg80211_registered_device *rdev;
7648         struct wireless_dev *wdev;
7649         int survey_idx = cb->args[2];
7650         int res;
7651         bool radio_stats;
7652
7653         res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
7654         if (res)
7655                 return res;
7656
7657         /* prepare_wdev_dump parsed the attributes */
7658         radio_stats = nl80211_fam.attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
7659
7660         if (!wdev->netdev) {
7661                 res = -EINVAL;
7662                 goto out_err;
7663         }
7664
7665         if (!rdev->ops->dump_survey) {
7666                 res = -EOPNOTSUPP;
7667                 goto out_err;
7668         }
7669
7670         while (1) {
7671                 res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
7672                 if (res == -ENOENT)
7673                         break;
7674                 if (res)
7675                         goto out_err;
7676
7677                 /* don't send disabled channels, but do send non-channel data */
7678                 if (survey.channel &&
7679                     survey.channel->flags & IEEE80211_CHAN_DISABLED) {
7680                         survey_idx++;
7681                         continue;
7682                 }
7683
7684                 if (nl80211_send_survey(skb,
7685                                 NETLINK_CB(cb->skb).portid,
7686                                 cb->nlh->nlmsg_seq, NLM_F_MULTI,
7687                                 wdev->netdev, radio_stats, &survey) < 0)
7688                         goto out;
7689                 survey_idx++;
7690         }
7691
7692  out:
7693         cb->args[2] = survey_idx;
7694         res = skb->len;
7695  out_err:
7696         nl80211_finish_wdev_dump(rdev);
7697         return res;
7698 }
7699
7700 static bool nl80211_valid_wpa_versions(u32 wpa_versions)
7701 {
7702         return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
7703                                   NL80211_WPA_VERSION_2));
7704 }
7705
7706 static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
7707 {
7708         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7709         struct net_device *dev = info->user_ptr[1];
7710         struct ieee80211_channel *chan;
7711         const u8 *bssid, *ssid, *ie = NULL, *sae_data = NULL;
7712         int err, ssid_len, ie_len = 0, sae_data_len = 0;
7713         enum nl80211_auth_type auth_type;
7714         struct key_parse key;
7715         bool local_state_change;
7716
7717         if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
7718                 return -EINVAL;
7719
7720         if (!info->attrs[NL80211_ATTR_MAC])
7721                 return -EINVAL;
7722
7723         if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
7724                 return -EINVAL;
7725
7726         if (!info->attrs[NL80211_ATTR_SSID])
7727                 return -EINVAL;
7728
7729         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
7730                 return -EINVAL;
7731
7732         err = nl80211_parse_key(info, &key);
7733         if (err)
7734                 return err;
7735
7736         if (key.idx >= 0) {
7737                 if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
7738                         return -EINVAL;
7739                 if (!key.p.key || !key.p.key_len)
7740                         return -EINVAL;
7741                 if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
7742                      key.p.key_len != WLAN_KEY_LEN_WEP40) &&
7743                     (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
7744                      key.p.key_len != WLAN_KEY_LEN_WEP104))
7745                         return -EINVAL;
7746                 if (key.idx > 3)
7747                         return -EINVAL;
7748         } else {
7749                 key.p.key_len = 0;
7750                 key.p.key = NULL;
7751         }
7752
7753         if (key.idx >= 0) {
7754                 int i;
7755                 bool ok = false;
7756
7757                 for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
7758                         if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
7759                                 ok = true;
7760                                 break;
7761                         }
7762                 }
7763                 if (!ok)
7764                         return -EINVAL;
7765         }
7766
7767         if (!rdev->ops->auth)
7768                 return -EOPNOTSUPP;
7769
7770         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
7771             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
7772                 return -EOPNOTSUPP;
7773
7774         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
7775         chan = nl80211_get_valid_chan(&rdev->wiphy,
7776                                       info->attrs[NL80211_ATTR_WIPHY_FREQ]);
7777         if (!chan)
7778                 return -EINVAL;
7779
7780         ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
7781         ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
7782
7783         if (info->attrs[NL80211_ATTR_IE]) {
7784                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
7785                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7786         }
7787
7788         auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
7789         if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
7790                 return -EINVAL;
7791
7792         if (auth_type == NL80211_AUTHTYPE_SAE &&
7793             !info->attrs[NL80211_ATTR_SAE_DATA])
7794                 return -EINVAL;
7795
7796         if (info->attrs[NL80211_ATTR_SAE_DATA]) {
7797                 if (auth_type != NL80211_AUTHTYPE_SAE)
7798                         return -EINVAL;
7799                 sae_data = nla_data(info->attrs[NL80211_ATTR_SAE_DATA]);
7800                 sae_data_len = nla_len(info->attrs[NL80211_ATTR_SAE_DATA]);
7801                 /* need to include at least Auth Transaction and Status Code */
7802                 if (sae_data_len < 4)
7803                         return -EINVAL;
7804         }
7805
7806         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
7807
7808         /*
7809          * Since we no longer track auth state, ignore
7810          * requests to only change local state.
7811          */
7812         if (local_state_change)
7813                 return 0;
7814
7815         wdev_lock(dev->ieee80211_ptr);
7816         err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
7817                                  ssid, ssid_len, ie, ie_len,
7818                                  key.p.key, key.p.key_len, key.idx,
7819                                  sae_data, sae_data_len);
7820         wdev_unlock(dev->ieee80211_ptr);
7821         return err;
7822 }
7823
7824 static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
7825                                    struct genl_info *info,
7826                                    struct cfg80211_crypto_settings *settings,
7827                                    int cipher_limit)
7828 {
7829         memset(settings, 0, sizeof(*settings));
7830
7831         settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
7832
7833         if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
7834                 u16 proto;
7835
7836                 proto = nla_get_u16(
7837                         info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
7838                 settings->control_port_ethertype = cpu_to_be16(proto);
7839                 if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
7840                     proto != ETH_P_PAE)
7841                         return -EINVAL;
7842                 if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
7843                         settings->control_port_no_encrypt = true;
7844         } else
7845                 settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
7846
7847         if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
7848                 void *data;
7849                 int len, i;
7850
7851                 data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
7852                 len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
7853                 settings->n_ciphers_pairwise = len / sizeof(u32);
7854
7855                 if (len % sizeof(u32))
7856                         return -EINVAL;
7857
7858                 if (settings->n_ciphers_pairwise > cipher_limit)
7859                         return -EINVAL;
7860
7861                 memcpy(settings->ciphers_pairwise, data, len);
7862
7863                 for (i = 0; i < settings->n_ciphers_pairwise; i++)
7864                         if (!cfg80211_supported_cipher_suite(
7865                                         &rdev->wiphy,
7866                                         settings->ciphers_pairwise[i]))
7867                                 return -EINVAL;
7868         }
7869
7870         if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
7871                 settings->cipher_group =
7872                         nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
7873                 if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
7874                                                      settings->cipher_group))
7875                         return -EINVAL;
7876         }
7877
7878         if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
7879                 settings->wpa_versions =
7880                         nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
7881                 if (!nl80211_valid_wpa_versions(settings->wpa_versions))
7882                         return -EINVAL;
7883         }
7884
7885         if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
7886                 void *data;
7887                 int len;
7888
7889                 data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
7890                 len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
7891                 settings->n_akm_suites = len / sizeof(u32);
7892
7893                 if (len % sizeof(u32))
7894                         return -EINVAL;
7895
7896                 if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
7897                         return -EINVAL;
7898
7899                 memcpy(settings->akm_suites, data, len);
7900         }
7901
7902         return 0;
7903 }
7904
7905 static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
7906 {
7907         struct cfg80211_registered_device *rdev = info->user_ptr[0];
7908         struct net_device *dev = info->user_ptr[1];
7909         struct ieee80211_channel *chan;
7910         struct cfg80211_assoc_request req = {};
7911         const u8 *bssid, *ssid;
7912         int err, ssid_len = 0;
7913
7914         if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
7915                 return -EINVAL;
7916
7917         if (!info->attrs[NL80211_ATTR_MAC] ||
7918             !info->attrs[NL80211_ATTR_SSID] ||
7919             !info->attrs[NL80211_ATTR_WIPHY_FREQ])
7920                 return -EINVAL;
7921
7922         if (!rdev->ops->assoc)
7923                 return -EOPNOTSUPP;
7924
7925         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
7926             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
7927                 return -EOPNOTSUPP;
7928
7929         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
7930
7931         chan = nl80211_get_valid_chan(&rdev->wiphy,
7932                                       info->attrs[NL80211_ATTR_WIPHY_FREQ]);
7933         if (!chan)
7934                 return -EINVAL;
7935
7936         ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
7937         ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
7938
7939         if (info->attrs[NL80211_ATTR_IE]) {
7940                 req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
7941                 req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
7942         }
7943
7944         if (info->attrs[NL80211_ATTR_USE_MFP]) {
7945                 enum nl80211_mfp mfp =
7946                         nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
7947                 if (mfp == NL80211_MFP_REQUIRED)
7948                         req.use_mfp = true;
7949                 else if (mfp != NL80211_MFP_NO)
7950                         return -EINVAL;
7951         }
7952
7953         if (info->attrs[NL80211_ATTR_PREV_BSSID])
7954                 req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
7955
7956         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
7957                 req.flags |= ASSOC_REQ_DISABLE_HT;
7958
7959         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
7960                 memcpy(&req.ht_capa_mask,
7961                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
7962                        sizeof(req.ht_capa_mask));
7963
7964         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
7965                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
7966                         return -EINVAL;
7967                 memcpy(&req.ht_capa,
7968                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
7969                        sizeof(req.ht_capa));
7970         }
7971
7972         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
7973                 req.flags |= ASSOC_REQ_DISABLE_VHT;
7974
7975         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
7976                 memcpy(&req.vht_capa_mask,
7977                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
7978                        sizeof(req.vht_capa_mask));
7979
7980         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
7981                 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
7982                         return -EINVAL;
7983                 memcpy(&req.vht_capa,
7984                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
7985                        sizeof(req.vht_capa));
7986         }
7987
7988         if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
7989                 if (!((rdev->wiphy.features &
7990                         NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
7991                        (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
7992                     !wiphy_ext_feature_isset(&rdev->wiphy,
7993                                              NL80211_EXT_FEATURE_RRM))
7994                         return -EINVAL;
7995                 req.flags |= ASSOC_REQ_USE_RRM;
7996         }
7997
7998         err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
7999         if (!err) {
8000                 wdev_lock(dev->ieee80211_ptr);
8001                 err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
8002                                           ssid, ssid_len, &req);
8003                 wdev_unlock(dev->ieee80211_ptr);
8004         }
8005
8006         return err;
8007 }
8008
8009 static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
8010 {
8011         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8012         struct net_device *dev = info->user_ptr[1];
8013         const u8 *ie = NULL, *bssid;
8014         int ie_len = 0, err;
8015         u16 reason_code;
8016         bool local_state_change;
8017
8018         if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8019                 return -EINVAL;
8020
8021         if (!info->attrs[NL80211_ATTR_MAC])
8022                 return -EINVAL;
8023
8024         if (!info->attrs[NL80211_ATTR_REASON_CODE])
8025                 return -EINVAL;
8026
8027         if (!rdev->ops->deauth)
8028                 return -EOPNOTSUPP;
8029
8030         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8031             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8032                 return -EOPNOTSUPP;
8033
8034         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8035
8036         reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8037         if (reason_code == 0) {
8038                 /* Reason Code 0 is reserved */
8039                 return -EINVAL;
8040         }
8041
8042         if (info->attrs[NL80211_ATTR_IE]) {
8043                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8044                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8045         }
8046
8047         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8048
8049         wdev_lock(dev->ieee80211_ptr);
8050         err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
8051                                    local_state_change);
8052         wdev_unlock(dev->ieee80211_ptr);
8053         return err;
8054 }
8055
8056 static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
8057 {
8058         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8059         struct net_device *dev = info->user_ptr[1];
8060         const u8 *ie = NULL, *bssid;
8061         int ie_len = 0, err;
8062         u16 reason_code;
8063         bool local_state_change;
8064
8065         if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8066                 return -EINVAL;
8067
8068         if (!info->attrs[NL80211_ATTR_MAC])
8069                 return -EINVAL;
8070
8071         if (!info->attrs[NL80211_ATTR_REASON_CODE])
8072                 return -EINVAL;
8073
8074         if (!rdev->ops->disassoc)
8075                 return -EOPNOTSUPP;
8076
8077         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8078             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8079                 return -EOPNOTSUPP;
8080
8081         bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8082
8083         reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8084         if (reason_code == 0) {
8085                 /* Reason Code 0 is reserved */
8086                 return -EINVAL;
8087         }
8088
8089         if (info->attrs[NL80211_ATTR_IE]) {
8090                 ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8091                 ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8092         }
8093
8094         local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
8095
8096         wdev_lock(dev->ieee80211_ptr);
8097         err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
8098                                      local_state_change);
8099         wdev_unlock(dev->ieee80211_ptr);
8100         return err;
8101 }
8102
8103 static bool
8104 nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
8105                          int mcast_rate[NUM_NL80211_BANDS],
8106                          int rateval)
8107 {
8108         struct wiphy *wiphy = &rdev->wiphy;
8109         bool found = false;
8110         int band, i;
8111
8112         for (band = 0; band < NUM_NL80211_BANDS; band++) {
8113                 struct ieee80211_supported_band *sband;
8114
8115                 sband = wiphy->bands[band];
8116                 if (!sband)
8117                         continue;
8118
8119                 for (i = 0; i < sband->n_bitrates; i++) {
8120                         if (sband->bitrates[i].bitrate == rateval) {
8121                                 mcast_rate[band] = i + 1;
8122                                 found = true;
8123                                 break;
8124                         }
8125                 }
8126         }
8127
8128         return found;
8129 }
8130
8131 static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
8132 {
8133         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8134         struct net_device *dev = info->user_ptr[1];
8135         struct cfg80211_ibss_params ibss;
8136         struct wiphy *wiphy;
8137         struct cfg80211_cached_keys *connkeys = NULL;
8138         int err;
8139
8140         memset(&ibss, 0, sizeof(ibss));
8141
8142         if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8143                 return -EINVAL;
8144
8145         if (!info->attrs[NL80211_ATTR_SSID] ||
8146             !nla_len(info->attrs[NL80211_ATTR_SSID]))
8147                 return -EINVAL;
8148
8149         ibss.beacon_interval = 100;
8150
8151         if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
8152                 ibss.beacon_interval =
8153                         nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
8154
8155         err = cfg80211_validate_beacon_int(rdev, ibss.beacon_interval);
8156         if (err)
8157                 return err;
8158
8159         if (!rdev->ops->join_ibss)
8160                 return -EOPNOTSUPP;
8161
8162         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8163                 return -EOPNOTSUPP;
8164
8165         wiphy = &rdev->wiphy;
8166
8167         if (info->attrs[NL80211_ATTR_MAC]) {
8168                 ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8169
8170                 if (!is_valid_ether_addr(ibss.bssid))
8171                         return -EINVAL;
8172         }
8173         ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8174         ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8175
8176         if (info->attrs[NL80211_ATTR_IE]) {
8177                 ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8178                 ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8179         }
8180
8181         err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
8182         if (err)
8183                 return err;
8184
8185         if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
8186                                      NL80211_IFTYPE_ADHOC))
8187                 return -EINVAL;
8188
8189         switch (ibss.chandef.width) {
8190         case NL80211_CHAN_WIDTH_5:
8191         case NL80211_CHAN_WIDTH_10:
8192         case NL80211_CHAN_WIDTH_20_NOHT:
8193                 break;
8194         case NL80211_CHAN_WIDTH_20:
8195         case NL80211_CHAN_WIDTH_40:
8196                 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8197                         return -EINVAL;
8198                 break;
8199         case NL80211_CHAN_WIDTH_80:
8200         case NL80211_CHAN_WIDTH_80P80:
8201         case NL80211_CHAN_WIDTH_160:
8202                 if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
8203                         return -EINVAL;
8204                 if (!wiphy_ext_feature_isset(&rdev->wiphy,
8205                                              NL80211_EXT_FEATURE_VHT_IBSS))
8206                         return -EINVAL;
8207                 break;
8208         default:
8209                 return -EINVAL;
8210         }
8211
8212         ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
8213         ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
8214
8215         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
8216                 u8 *rates =
8217                         nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8218                 int n_rates =
8219                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
8220                 struct ieee80211_supported_band *sband =
8221                         wiphy->bands[ibss.chandef.chan->band];
8222
8223                 err = ieee80211_get_ratemask(sband, rates, n_rates,
8224                                              &ibss.basic_rates);
8225                 if (err)
8226                         return err;
8227         }
8228
8229         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8230                 memcpy(&ibss.ht_capa_mask,
8231                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8232                        sizeof(ibss.ht_capa_mask));
8233
8234         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8235                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8236                         return -EINVAL;
8237                 memcpy(&ibss.ht_capa,
8238                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8239                        sizeof(ibss.ht_capa));
8240         }
8241
8242         if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
8243             !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
8244                         nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
8245                 return -EINVAL;
8246
8247         if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8248                 bool no_ht = false;
8249
8250                 connkeys = nl80211_parse_connkeys(rdev,
8251                                           info->attrs[NL80211_ATTR_KEYS],
8252                                           &no_ht);
8253                 if (IS_ERR(connkeys))
8254                         return PTR_ERR(connkeys);
8255
8256                 if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
8257                     no_ht) {
8258                         kzfree(connkeys);
8259                         return -EINVAL;
8260                 }
8261         }
8262
8263         ibss.control_port =
8264                 nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
8265
8266         ibss.userspace_handles_dfs =
8267                 nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
8268
8269         err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
8270         if (err)
8271                 kzfree(connkeys);
8272         return err;
8273 }
8274
8275 static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
8276 {
8277         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8278         struct net_device *dev = info->user_ptr[1];
8279
8280         if (!rdev->ops->leave_ibss)
8281                 return -EOPNOTSUPP;
8282
8283         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
8284                 return -EOPNOTSUPP;
8285
8286         return cfg80211_leave_ibss(rdev, dev, false);
8287 }
8288
8289 static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
8290 {
8291         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8292         struct net_device *dev = info->user_ptr[1];
8293         int mcast_rate[NUM_NL80211_BANDS];
8294         u32 nla_rate;
8295         int err;
8296
8297         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
8298             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
8299             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
8300                 return -EOPNOTSUPP;
8301
8302         if (!rdev->ops->set_mcast_rate)
8303                 return -EOPNOTSUPP;
8304
8305         memset(mcast_rate, 0, sizeof(mcast_rate));
8306
8307         if (!info->attrs[NL80211_ATTR_MCAST_RATE])
8308                 return -EINVAL;
8309
8310         nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
8311         if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
8312                 return -EINVAL;
8313
8314         err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
8315
8316         return err;
8317 }
8318
8319 static struct sk_buff *
8320 __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
8321                             struct wireless_dev *wdev, int approxlen,
8322                             u32 portid, u32 seq, enum nl80211_commands cmd,
8323                             enum nl80211_attrs attr,
8324                             const struct nl80211_vendor_cmd_info *info,
8325                             gfp_t gfp)
8326 {
8327         struct sk_buff *skb;
8328         void *hdr;
8329         struct nlattr *data;
8330
8331         skb = nlmsg_new(approxlen + 100, gfp);
8332         if (!skb)
8333                 return NULL;
8334
8335         hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
8336         if (!hdr) {
8337                 kfree_skb(skb);
8338                 return NULL;
8339         }
8340
8341         if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
8342                 goto nla_put_failure;
8343
8344         if (info) {
8345                 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
8346                                 info->vendor_id))
8347                         goto nla_put_failure;
8348                 if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
8349                                 info->subcmd))
8350                         goto nla_put_failure;
8351         }
8352
8353         if (wdev) {
8354                 if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
8355                                       wdev_id(wdev), NL80211_ATTR_PAD))
8356                         goto nla_put_failure;
8357                 if (wdev->netdev &&
8358                     nla_put_u32(skb, NL80211_ATTR_IFINDEX,
8359                                 wdev->netdev->ifindex))
8360                         goto nla_put_failure;
8361         }
8362
8363         data = nla_nest_start(skb, attr);
8364         if (!data)
8365                 goto nla_put_failure;
8366
8367         ((void **)skb->cb)[0] = rdev;
8368         ((void **)skb->cb)[1] = hdr;
8369         ((void **)skb->cb)[2] = data;
8370
8371         return skb;
8372
8373  nla_put_failure:
8374         kfree_skb(skb);
8375         return NULL;
8376 }
8377
8378 struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
8379                                            struct wireless_dev *wdev,
8380                                            enum nl80211_commands cmd,
8381                                            enum nl80211_attrs attr,
8382                                            int vendor_event_idx,
8383                                            int approxlen, gfp_t gfp)
8384 {
8385         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
8386         const struct nl80211_vendor_cmd_info *info;
8387
8388         switch (cmd) {
8389         case NL80211_CMD_TESTMODE:
8390                 if (WARN_ON(vendor_event_idx != -1))
8391                         return NULL;
8392                 info = NULL;
8393                 break;
8394         case NL80211_CMD_VENDOR:
8395                 if (WARN_ON(vendor_event_idx < 0 ||
8396                             vendor_event_idx >= wiphy->n_vendor_events))
8397                         return NULL;
8398                 info = &wiphy->vendor_events[vendor_event_idx];
8399                 break;
8400         default:
8401                 WARN_ON(1);
8402                 return NULL;
8403         }
8404
8405         return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
8406                                            cmd, attr, info, gfp);
8407 }
8408 EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
8409
8410 void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
8411 {
8412         struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
8413         void *hdr = ((void **)skb->cb)[1];
8414         struct nlattr *data = ((void **)skb->cb)[2];
8415         enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
8416
8417         /* clear CB data for netlink core to own from now on */
8418         memset(skb->cb, 0, sizeof(skb->cb));
8419
8420         nla_nest_end(skb, data);
8421         genlmsg_end(skb, hdr);
8422
8423         if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
8424                 mcgrp = NL80211_MCGRP_VENDOR;
8425
8426         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
8427                                 mcgrp, gfp);
8428 }
8429 EXPORT_SYMBOL(__cfg80211_send_event_skb);
8430
8431 #ifdef CONFIG_NL80211_TESTMODE
8432 static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
8433 {
8434         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8435         struct wireless_dev *wdev =
8436                 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
8437         int err;
8438
8439         if (!rdev->ops->testmode_cmd)
8440                 return -EOPNOTSUPP;
8441
8442         if (IS_ERR(wdev)) {
8443                 err = PTR_ERR(wdev);
8444                 if (err != -EINVAL)
8445                         return err;
8446                 wdev = NULL;
8447         } else if (wdev->wiphy != &rdev->wiphy) {
8448                 return -EINVAL;
8449         }
8450
8451         if (!info->attrs[NL80211_ATTR_TESTDATA])
8452                 return -EINVAL;
8453
8454         rdev->cur_cmd_info = info;
8455         err = rdev_testmode_cmd(rdev, wdev,
8456                                 nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
8457                                 nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
8458         rdev->cur_cmd_info = NULL;
8459
8460         return err;
8461 }
8462
8463 static int nl80211_testmode_dump(struct sk_buff *skb,
8464                                  struct netlink_callback *cb)
8465 {
8466         struct cfg80211_registered_device *rdev;
8467         int err;
8468         long phy_idx;
8469         void *data = NULL;
8470         int data_len = 0;
8471
8472         rtnl_lock();
8473
8474         if (cb->args[0]) {
8475                 /*
8476                  * 0 is a valid index, but not valid for args[0],
8477                  * so we need to offset by 1.
8478                  */
8479                 phy_idx = cb->args[0] - 1;
8480         } else {
8481                 err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
8482                                   nl80211_fam.attrbuf, nl80211_fam.maxattr,
8483                                   nl80211_policy);
8484                 if (err)
8485                         goto out_err;
8486
8487                 rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
8488                                                   nl80211_fam.attrbuf);
8489                 if (IS_ERR(rdev)) {
8490                         err = PTR_ERR(rdev);
8491                         goto out_err;
8492                 }
8493                 phy_idx = rdev->wiphy_idx;
8494                 rdev = NULL;
8495
8496                 if (nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA])
8497                         cb->args[1] =
8498                                 (long)nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA];
8499         }
8500
8501         if (cb->args[1]) {
8502                 data = nla_data((void *)cb->args[1]);
8503                 data_len = nla_len((void *)cb->args[1]);
8504         }
8505
8506         rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
8507         if (!rdev) {
8508                 err = -ENOENT;
8509                 goto out_err;
8510         }
8511
8512         if (!rdev->ops->testmode_dump) {
8513                 err = -EOPNOTSUPP;
8514                 goto out_err;
8515         }
8516
8517         while (1) {
8518                 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
8519                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
8520                                            NL80211_CMD_TESTMODE);
8521                 struct nlattr *tmdata;
8522
8523                 if (!hdr)
8524                         break;
8525
8526                 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
8527                         genlmsg_cancel(skb, hdr);
8528                         break;
8529                 }
8530
8531                 tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
8532                 if (!tmdata) {
8533                         genlmsg_cancel(skb, hdr);
8534                         break;
8535                 }
8536                 err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
8537                 nla_nest_end(skb, tmdata);
8538
8539                 if (err == -ENOBUFS || err == -ENOENT) {
8540                         genlmsg_cancel(skb, hdr);
8541                         break;
8542                 } else if (err) {
8543                         genlmsg_cancel(skb, hdr);
8544                         goto out_err;
8545                 }
8546
8547                 genlmsg_end(skb, hdr);
8548         }
8549
8550         err = skb->len;
8551         /* see above */
8552         cb->args[0] = phy_idx + 1;
8553  out_err:
8554         rtnl_unlock();
8555         return err;
8556 }
8557 #endif
8558
8559 static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
8560 {
8561         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8562         struct net_device *dev = info->user_ptr[1];
8563         struct cfg80211_connect_params connect;
8564         struct wiphy *wiphy;
8565         struct cfg80211_cached_keys *connkeys = NULL;
8566         int err;
8567
8568         memset(&connect, 0, sizeof(connect));
8569
8570         if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
8571                 return -EINVAL;
8572
8573         if (!info->attrs[NL80211_ATTR_SSID] ||
8574             !nla_len(info->attrs[NL80211_ATTR_SSID]))
8575                 return -EINVAL;
8576
8577         if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
8578                 connect.auth_type =
8579                         nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
8580                 if (!nl80211_valid_auth_type(rdev, connect.auth_type,
8581                                              NL80211_CMD_CONNECT))
8582                         return -EINVAL;
8583         } else
8584                 connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
8585
8586         connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
8587
8588         err = nl80211_crypto_settings(rdev, info, &connect.crypto,
8589                                       NL80211_MAX_NR_CIPHER_SUITES);
8590         if (err)
8591                 return err;
8592
8593         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8594             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8595                 return -EOPNOTSUPP;
8596
8597         wiphy = &rdev->wiphy;
8598
8599         connect.bg_scan_period = -1;
8600         if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
8601                 (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
8602                 connect.bg_scan_period =
8603                         nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
8604         }
8605
8606         if (info->attrs[NL80211_ATTR_MAC])
8607                 connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8608         else if (info->attrs[NL80211_ATTR_MAC_HINT])
8609                 connect.bssid_hint =
8610                         nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
8611         connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
8612         connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
8613
8614         if (info->attrs[NL80211_ATTR_IE]) {
8615                 connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
8616                 connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
8617         }
8618
8619         if (info->attrs[NL80211_ATTR_USE_MFP]) {
8620                 connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
8621                 if (connect.mfp != NL80211_MFP_REQUIRED &&
8622                     connect.mfp != NL80211_MFP_NO)
8623                         return -EINVAL;
8624         } else {
8625                 connect.mfp = NL80211_MFP_NO;
8626         }
8627
8628         if (info->attrs[NL80211_ATTR_PREV_BSSID])
8629                 connect.prev_bssid =
8630                         nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
8631
8632         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
8633                 connect.channel = nl80211_get_valid_chan(
8634                         wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
8635                 if (!connect.channel)
8636                         return -EINVAL;
8637         } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
8638                 connect.channel_hint = nl80211_get_valid_chan(
8639                         wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
8640                 if (!connect.channel_hint)
8641                         return -EINVAL;
8642         }
8643
8644         if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
8645                 connkeys = nl80211_parse_connkeys(rdev,
8646                                           info->attrs[NL80211_ATTR_KEYS], NULL);
8647                 if (IS_ERR(connkeys))
8648                         return PTR_ERR(connkeys);
8649         }
8650
8651         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
8652                 connect.flags |= ASSOC_REQ_DISABLE_HT;
8653
8654         if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
8655                 memcpy(&connect.ht_capa_mask,
8656                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
8657                        sizeof(connect.ht_capa_mask));
8658
8659         if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
8660                 if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
8661                         kzfree(connkeys);
8662                         return -EINVAL;
8663                 }
8664                 memcpy(&connect.ht_capa,
8665                        nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
8666                        sizeof(connect.ht_capa));
8667         }
8668
8669         if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
8670                 connect.flags |= ASSOC_REQ_DISABLE_VHT;
8671
8672         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
8673                 memcpy(&connect.vht_capa_mask,
8674                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
8675                        sizeof(connect.vht_capa_mask));
8676
8677         if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
8678                 if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
8679                         kzfree(connkeys);
8680                         return -EINVAL;
8681                 }
8682                 memcpy(&connect.vht_capa,
8683                        nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
8684                        sizeof(connect.vht_capa));
8685         }
8686
8687         if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
8688                 if (!((rdev->wiphy.features &
8689                         NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
8690                        (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
8691                     !wiphy_ext_feature_isset(&rdev->wiphy,
8692                                              NL80211_EXT_FEATURE_RRM)) {
8693                         kzfree(connkeys);
8694                         return -EINVAL;
8695                 }
8696                 connect.flags |= ASSOC_REQ_USE_RRM;
8697         }
8698
8699         connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
8700         if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
8701                 kzfree(connkeys);
8702                 return -EOPNOTSUPP;
8703         }
8704
8705         if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
8706                 /* bss selection makes no sense if bssid is set */
8707                 if (connect.bssid) {
8708                         kzfree(connkeys);
8709                         return -EINVAL;
8710                 }
8711
8712                 err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
8713                                        wiphy, &connect.bss_select);
8714                 if (err) {
8715                         kzfree(connkeys);
8716                         return err;
8717                 }
8718         }
8719
8720         wdev_lock(dev->ieee80211_ptr);
8721         err = cfg80211_connect(rdev, dev, &connect, connkeys,
8722                                connect.prev_bssid);
8723         wdev_unlock(dev->ieee80211_ptr);
8724         if (err)
8725                 kzfree(connkeys);
8726         return err;
8727 }
8728
8729 static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
8730 {
8731         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8732         struct net_device *dev = info->user_ptr[1];
8733         u16 reason;
8734         int ret;
8735
8736         if (!info->attrs[NL80211_ATTR_REASON_CODE])
8737                 reason = WLAN_REASON_DEAUTH_LEAVING;
8738         else
8739                 reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
8740
8741         if (reason == 0)
8742                 return -EINVAL;
8743
8744         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8745             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8746                 return -EOPNOTSUPP;
8747
8748         wdev_lock(dev->ieee80211_ptr);
8749         ret = cfg80211_disconnect(rdev, dev, reason, true);
8750         wdev_unlock(dev->ieee80211_ptr);
8751         return ret;
8752 }
8753
8754 static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
8755 {
8756         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8757         struct net *net;
8758         int err;
8759
8760         if (info->attrs[NL80211_ATTR_PID]) {
8761                 u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
8762
8763                 net = get_net_ns_by_pid(pid);
8764         } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
8765                 u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
8766
8767                 net = get_net_ns_by_fd(fd);
8768         } else {
8769                 return -EINVAL;
8770         }
8771
8772         if (IS_ERR(net))
8773                 return PTR_ERR(net);
8774
8775         err = 0;
8776
8777         /* check if anything to do */
8778         if (!net_eq(wiphy_net(&rdev->wiphy), net))
8779                 err = cfg80211_switch_netns(rdev, net);
8780
8781         put_net(net);
8782         return err;
8783 }
8784
8785 static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
8786 {
8787         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8788         int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
8789                         struct cfg80211_pmksa *pmksa) = NULL;
8790         struct net_device *dev = info->user_ptr[1];
8791         struct cfg80211_pmksa pmksa;
8792
8793         memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
8794
8795         if (!info->attrs[NL80211_ATTR_MAC])
8796                 return -EINVAL;
8797
8798         if (!info->attrs[NL80211_ATTR_PMKID])
8799                 return -EINVAL;
8800
8801         pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
8802         pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
8803
8804         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8805             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8806                 return -EOPNOTSUPP;
8807
8808         switch (info->genlhdr->cmd) {
8809         case NL80211_CMD_SET_PMKSA:
8810                 rdev_ops = rdev->ops->set_pmksa;
8811                 break;
8812         case NL80211_CMD_DEL_PMKSA:
8813                 rdev_ops = rdev->ops->del_pmksa;
8814                 break;
8815         default:
8816                 WARN_ON(1);
8817                 break;
8818         }
8819
8820         if (!rdev_ops)
8821                 return -EOPNOTSUPP;
8822
8823         return rdev_ops(&rdev->wiphy, dev, &pmksa);
8824 }
8825
8826 static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
8827 {
8828         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8829         struct net_device *dev = info->user_ptr[1];
8830
8831         if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
8832             dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
8833                 return -EOPNOTSUPP;
8834
8835         if (!rdev->ops->flush_pmksa)
8836                 return -EOPNOTSUPP;
8837
8838         return rdev_flush_pmksa(rdev, dev);
8839 }
8840
8841 static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
8842 {
8843         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8844         struct net_device *dev = info->user_ptr[1];
8845         u8 action_code, dialog_token;
8846         u32 peer_capability = 0;
8847         u16 status_code;
8848         u8 *peer;
8849         bool initiator;
8850
8851         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
8852             !rdev->ops->tdls_mgmt)
8853                 return -EOPNOTSUPP;
8854
8855         if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
8856             !info->attrs[NL80211_ATTR_STATUS_CODE] ||
8857             !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
8858             !info->attrs[NL80211_ATTR_IE] ||
8859             !info->attrs[NL80211_ATTR_MAC])
8860                 return -EINVAL;
8861
8862         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
8863         action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
8864         status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
8865         dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
8866         initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
8867         if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
8868                 peer_capability =
8869                         nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
8870
8871         return rdev_tdls_mgmt(rdev, dev, peer, action_code,
8872                               dialog_token, status_code, peer_capability,
8873                               initiator,
8874                               nla_data(info->attrs[NL80211_ATTR_IE]),
8875                               nla_len(info->attrs[NL80211_ATTR_IE]));
8876 }
8877
8878 static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
8879 {
8880         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8881         struct net_device *dev = info->user_ptr[1];
8882         enum nl80211_tdls_operation operation;
8883         u8 *peer;
8884
8885         if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
8886             !rdev->ops->tdls_oper)
8887                 return -EOPNOTSUPP;
8888
8889         if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
8890             !info->attrs[NL80211_ATTR_MAC])
8891                 return -EINVAL;
8892
8893         operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
8894         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
8895
8896         return rdev_tdls_oper(rdev, dev, peer, operation);
8897 }
8898
8899 static int nl80211_remain_on_channel(struct sk_buff *skb,
8900                                      struct genl_info *info)
8901 {
8902         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8903         struct wireless_dev *wdev = info->user_ptr[1];
8904         struct cfg80211_chan_def chandef;
8905         struct sk_buff *msg;
8906         void *hdr;
8907         u64 cookie;
8908         u32 duration;
8909         int err;
8910
8911         if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
8912             !info->attrs[NL80211_ATTR_DURATION])
8913                 return -EINVAL;
8914
8915         duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
8916
8917         if (!rdev->ops->remain_on_channel ||
8918             !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
8919                 return -EOPNOTSUPP;
8920
8921         /*
8922          * We should be on that channel for at least a minimum amount of
8923          * time (10ms) but no longer than the driver supports.
8924          */
8925         if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
8926             duration > rdev->wiphy.max_remain_on_channel_duration)
8927                 return -EINVAL;
8928
8929         err = nl80211_parse_chandef(rdev, info, &chandef);
8930         if (err)
8931                 return err;
8932
8933         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
8934         if (!msg)
8935                 return -ENOMEM;
8936
8937         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
8938                              NL80211_CMD_REMAIN_ON_CHANNEL);
8939         if (!hdr) {
8940                 err = -ENOBUFS;
8941                 goto free_msg;
8942         }
8943
8944         err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
8945                                      duration, &cookie);
8946
8947         if (err)
8948                 goto free_msg;
8949
8950         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
8951                               NL80211_ATTR_PAD))
8952                 goto nla_put_failure;
8953
8954         genlmsg_end(msg, hdr);
8955
8956         return genlmsg_reply(msg, info);
8957
8958  nla_put_failure:
8959         err = -ENOBUFS;
8960  free_msg:
8961         nlmsg_free(msg);
8962         return err;
8963 }
8964
8965 static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
8966                                             struct genl_info *info)
8967 {
8968         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8969         struct wireless_dev *wdev = info->user_ptr[1];
8970         u64 cookie;
8971
8972         if (!info->attrs[NL80211_ATTR_COOKIE])
8973                 return -EINVAL;
8974
8975         if (!rdev->ops->cancel_remain_on_channel)
8976                 return -EOPNOTSUPP;
8977
8978         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
8979
8980         return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
8981 }
8982
8983 static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
8984                                        struct genl_info *info)
8985 {
8986         struct cfg80211_bitrate_mask mask;
8987         struct cfg80211_registered_device *rdev = info->user_ptr[0];
8988         struct net_device *dev = info->user_ptr[1];
8989         int err;
8990
8991         if (!rdev->ops->set_bitrate_mask)
8992                 return -EOPNOTSUPP;
8993
8994         err = nl80211_parse_tx_bitrate_mask(info, &mask);
8995         if (err)
8996                 return err;
8997
8998         return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
8999 }
9000
9001 static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
9002 {
9003         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9004         struct wireless_dev *wdev = info->user_ptr[1];
9005         u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
9006
9007         if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
9008                 return -EINVAL;
9009
9010         if (info->attrs[NL80211_ATTR_FRAME_TYPE])
9011                 frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
9012
9013         switch (wdev->iftype) {
9014         case NL80211_IFTYPE_STATION:
9015         case NL80211_IFTYPE_ADHOC:
9016         case NL80211_IFTYPE_P2P_CLIENT:
9017         case NL80211_IFTYPE_AP:
9018         case NL80211_IFTYPE_AP_VLAN:
9019         case NL80211_IFTYPE_MESH_POINT:
9020         case NL80211_IFTYPE_P2P_GO:
9021         case NL80211_IFTYPE_P2P_DEVICE:
9022                 break;
9023         case NL80211_IFTYPE_NAN:
9024         default:
9025                 return -EOPNOTSUPP;
9026         }
9027
9028         /* not much point in registering if we can't reply */
9029         if (!rdev->ops->mgmt_tx)
9030                 return -EOPNOTSUPP;
9031
9032         return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
9033                         nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
9034                         nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
9035 }
9036
9037 static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
9038 {
9039         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9040         struct wireless_dev *wdev = info->user_ptr[1];
9041         struct cfg80211_chan_def chandef;
9042         int err;
9043         void *hdr = NULL;
9044         u64 cookie;
9045         struct sk_buff *msg = NULL;
9046         struct cfg80211_mgmt_tx_params params = {
9047                 .dont_wait_for_ack =
9048                         info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
9049         };
9050
9051         if (!info->attrs[NL80211_ATTR_FRAME])
9052                 return -EINVAL;
9053
9054         if (!rdev->ops->mgmt_tx)
9055                 return -EOPNOTSUPP;
9056
9057         switch (wdev->iftype) {
9058         case NL80211_IFTYPE_P2P_DEVICE:
9059                 if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
9060                         return -EINVAL;
9061         case NL80211_IFTYPE_STATION:
9062         case NL80211_IFTYPE_ADHOC:
9063         case NL80211_IFTYPE_P2P_CLIENT:
9064         case NL80211_IFTYPE_AP:
9065         case NL80211_IFTYPE_AP_VLAN:
9066         case NL80211_IFTYPE_MESH_POINT:
9067         case NL80211_IFTYPE_P2P_GO:
9068                 break;
9069         case NL80211_IFTYPE_NAN:
9070         default:
9071                 return -EOPNOTSUPP;
9072         }
9073
9074         if (info->attrs[NL80211_ATTR_DURATION]) {
9075                 if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9076                         return -EINVAL;
9077                 params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
9078
9079                 /*
9080                  * We should wait on the channel for at least a minimum amount
9081                  * of time (10ms) but no longer than the driver supports.
9082                  */
9083                 if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
9084                     params.wait > rdev->wiphy.max_remain_on_channel_duration)
9085                         return -EINVAL;
9086         }
9087
9088         params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
9089
9090         if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
9091                 return -EINVAL;
9092
9093         params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
9094
9095         /* get the channel if any has been specified, otherwise pass NULL to
9096          * the driver. The latter will use the current one
9097          */
9098         chandef.chan = NULL;
9099         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9100                 err = nl80211_parse_chandef(rdev, info, &chandef);
9101                 if (err)
9102                         return err;
9103         }
9104
9105         if (!chandef.chan && params.offchan)
9106                 return -EINVAL;
9107
9108         params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
9109         params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
9110
9111         if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
9112                 int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9113                 int i;
9114
9115                 if (len % sizeof(u16))
9116                         return -EINVAL;
9117
9118                 params.n_csa_offsets = len / sizeof(u16);
9119                 params.csa_offsets =
9120                         nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
9121
9122                 /* check that all the offsets fit the frame */
9123                 for (i = 0; i < params.n_csa_offsets; i++) {
9124                         if (params.csa_offsets[i] >= params.len)
9125                                 return -EINVAL;
9126                 }
9127         }
9128
9129         if (!params.dont_wait_for_ack) {
9130                 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9131                 if (!msg)
9132                         return -ENOMEM;
9133
9134                 hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9135                                      NL80211_CMD_FRAME);
9136                 if (!hdr) {
9137                         err = -ENOBUFS;
9138                         goto free_msg;
9139                 }
9140         }
9141
9142         params.chan = chandef.chan;
9143         err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
9144         if (err)
9145                 goto free_msg;
9146
9147         if (msg) {
9148                 if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
9149                                       NL80211_ATTR_PAD))
9150                         goto nla_put_failure;
9151
9152                 genlmsg_end(msg, hdr);
9153                 return genlmsg_reply(msg, info);
9154         }
9155
9156         return 0;
9157
9158  nla_put_failure:
9159         err = -ENOBUFS;
9160  free_msg:
9161         nlmsg_free(msg);
9162         return err;
9163 }
9164
9165 static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
9166 {
9167         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9168         struct wireless_dev *wdev = info->user_ptr[1];
9169         u64 cookie;
9170
9171         if (!info->attrs[NL80211_ATTR_COOKIE])
9172                 return -EINVAL;
9173
9174         if (!rdev->ops->mgmt_tx_cancel_wait)
9175                 return -EOPNOTSUPP;
9176
9177         switch (wdev->iftype) {
9178         case NL80211_IFTYPE_STATION:
9179         case NL80211_IFTYPE_ADHOC:
9180         case NL80211_IFTYPE_P2P_CLIENT:
9181         case NL80211_IFTYPE_AP:
9182         case NL80211_IFTYPE_AP_VLAN:
9183         case NL80211_IFTYPE_P2P_GO:
9184         case NL80211_IFTYPE_P2P_DEVICE:
9185                 break;
9186         case NL80211_IFTYPE_NAN:
9187         default:
9188                 return -EOPNOTSUPP;
9189         }
9190
9191         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
9192
9193         return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
9194 }
9195
9196 static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
9197 {
9198         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9199         struct wireless_dev *wdev;
9200         struct net_device *dev = info->user_ptr[1];
9201         u8 ps_state;
9202         bool state;
9203         int err;
9204
9205         if (!info->attrs[NL80211_ATTR_PS_STATE])
9206                 return -EINVAL;
9207
9208         ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
9209
9210         if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
9211                 return -EINVAL;
9212
9213         wdev = dev->ieee80211_ptr;
9214
9215         if (!rdev->ops->set_power_mgmt)
9216                 return -EOPNOTSUPP;
9217
9218         state = (ps_state == NL80211_PS_ENABLED) ? true : false;
9219
9220         if (state == wdev->ps)
9221                 return 0;
9222
9223         err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
9224         if (!err)
9225                 wdev->ps = state;
9226         return err;
9227 }
9228
9229 static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
9230 {
9231         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9232         enum nl80211_ps_state ps_state;
9233         struct wireless_dev *wdev;
9234         struct net_device *dev = info->user_ptr[1];
9235         struct sk_buff *msg;
9236         void *hdr;
9237         int err;
9238
9239         wdev = dev->ieee80211_ptr;
9240
9241         if (!rdev->ops->set_power_mgmt)
9242                 return -EOPNOTSUPP;
9243
9244         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
9245         if (!msg)
9246                 return -ENOMEM;
9247
9248         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9249                              NL80211_CMD_GET_POWER_SAVE);
9250         if (!hdr) {
9251                 err = -ENOBUFS;
9252                 goto free_msg;
9253         }
9254
9255         if (wdev->ps)
9256                 ps_state = NL80211_PS_ENABLED;
9257         else
9258                 ps_state = NL80211_PS_DISABLED;
9259
9260         if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
9261                 goto nla_put_failure;
9262
9263         genlmsg_end(msg, hdr);
9264         return genlmsg_reply(msg, info);
9265
9266  nla_put_failure:
9267         err = -ENOBUFS;
9268  free_msg:
9269         nlmsg_free(msg);
9270         return err;
9271 }
9272
9273 static const struct nla_policy
9274 nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
9275         [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
9276         [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
9277         [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
9278         [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
9279         [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
9280         [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
9281 };
9282
9283 static int nl80211_set_cqm_txe(struct genl_info *info,
9284                                u32 rate, u32 pkts, u32 intvl)
9285 {
9286         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9287         struct net_device *dev = info->user_ptr[1];
9288         struct wireless_dev *wdev = dev->ieee80211_ptr;
9289
9290         if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
9291                 return -EINVAL;
9292
9293         if (!rdev->ops->set_cqm_txe_config)
9294                 return -EOPNOTSUPP;
9295
9296         if (wdev->iftype != NL80211_IFTYPE_STATION &&
9297             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9298                 return -EOPNOTSUPP;
9299
9300         return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
9301 }
9302
9303 static int nl80211_set_cqm_rssi(struct genl_info *info,
9304                                 s32 threshold, u32 hysteresis)
9305 {
9306         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9307         struct net_device *dev = info->user_ptr[1];
9308         struct wireless_dev *wdev = dev->ieee80211_ptr;
9309
9310         if (threshold > 0)
9311                 return -EINVAL;
9312
9313         /* disabling - hysteresis should also be zero then */
9314         if (threshold == 0)
9315                 hysteresis = 0;
9316
9317         if (!rdev->ops->set_cqm_rssi_config)
9318                 return -EOPNOTSUPP;
9319
9320         if (wdev->iftype != NL80211_IFTYPE_STATION &&
9321             wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
9322                 return -EOPNOTSUPP;
9323
9324         return rdev_set_cqm_rssi_config(rdev, dev, threshold, hysteresis);
9325 }
9326
9327 static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
9328 {
9329         struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
9330         struct nlattr *cqm;
9331         int err;
9332
9333         cqm = info->attrs[NL80211_ATTR_CQM];
9334         if (!cqm)
9335                 return -EINVAL;
9336
9337         err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
9338                                nl80211_attr_cqm_policy);
9339         if (err)
9340                 return err;
9341
9342         if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
9343             attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
9344                 s32 threshold = nla_get_s32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
9345                 u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
9346
9347                 return nl80211_set_cqm_rssi(info, threshold, hysteresis);
9348         }
9349
9350         if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
9351             attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
9352             attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
9353                 u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
9354                 u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
9355                 u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
9356
9357                 return nl80211_set_cqm_txe(info, rate, pkts, intvl);
9358         }
9359
9360         return -EINVAL;
9361 }
9362
9363 static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
9364 {
9365         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9366         struct net_device *dev = info->user_ptr[1];
9367         struct ocb_setup setup = {};
9368         int err;
9369
9370         err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9371         if (err)
9372                 return err;
9373
9374         return cfg80211_join_ocb(rdev, dev, &setup);
9375 }
9376
9377 static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
9378 {
9379         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9380         struct net_device *dev = info->user_ptr[1];
9381
9382         return cfg80211_leave_ocb(rdev, dev);
9383 }
9384
9385 static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
9386 {
9387         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9388         struct net_device *dev = info->user_ptr[1];
9389         struct mesh_config cfg;
9390         struct mesh_setup setup;
9391         int err;
9392
9393         /* start with default */
9394         memcpy(&cfg, &default_mesh_config, sizeof(cfg));
9395         memcpy(&setup, &default_mesh_setup, sizeof(setup));
9396
9397         if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
9398                 /* and parse parameters if given */
9399                 err = nl80211_parse_mesh_config(info, &cfg, NULL);
9400                 if (err)
9401                         return err;
9402         }
9403
9404         if (!info->attrs[NL80211_ATTR_MESH_ID] ||
9405             !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
9406                 return -EINVAL;
9407
9408         setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
9409         setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
9410
9411         if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
9412             !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
9413                             nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
9414                         return -EINVAL;
9415
9416         if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
9417                 setup.beacon_interval =
9418                         nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
9419
9420                 err = cfg80211_validate_beacon_int(rdev, setup.beacon_interval);
9421                 if (err)
9422                         return err;
9423         }
9424
9425         if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
9426                 setup.dtim_period =
9427                         nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
9428                 if (setup.dtim_period < 1 || setup.dtim_period > 100)
9429                         return -EINVAL;
9430         }
9431
9432         if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
9433                 /* parse additional setup parameters if given */
9434                 err = nl80211_parse_mesh_setup(info, &setup);
9435                 if (err)
9436                         return err;
9437         }
9438
9439         if (setup.user_mpm)
9440                 cfg.auto_open_plinks = false;
9441
9442         if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
9443                 err = nl80211_parse_chandef(rdev, info, &setup.chandef);
9444                 if (err)
9445                         return err;
9446         } else {
9447                 /* cfg80211_join_mesh() will sort it out */
9448                 setup.chandef.chan = NULL;
9449         }
9450
9451         if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
9452                 u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9453                 int n_rates =
9454                         nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
9455                 struct ieee80211_supported_band *sband;
9456
9457                 if (!setup.chandef.chan)
9458                         return -EINVAL;
9459
9460                 sband = rdev->wiphy.bands[setup.chandef.chan->band];
9461
9462                 err = ieee80211_get_ratemask(sband, rates, n_rates,
9463                                              &setup.basic_rates);
9464                 if (err)
9465                         return err;
9466         }
9467
9468         if (info->attrs[NL80211_ATTR_TX_RATES]) {
9469                 err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
9470                 if (err)
9471                         return err;
9472
9473                 err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
9474                                               &setup.beacon_rate);
9475                 if (err)
9476                         return err;
9477         }
9478
9479         return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
9480 }
9481
9482 static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
9483 {
9484         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9485         struct net_device *dev = info->user_ptr[1];
9486
9487         return cfg80211_leave_mesh(rdev, dev);
9488 }
9489
9490 #ifdef CONFIG_PM
9491 static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
9492                                         struct cfg80211_registered_device *rdev)
9493 {
9494         struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
9495         struct nlattr *nl_pats, *nl_pat;
9496         int i, pat_len;
9497
9498         if (!wowlan->n_patterns)
9499                 return 0;
9500
9501         nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
9502         if (!nl_pats)
9503                 return -ENOBUFS;
9504
9505         for (i = 0; i < wowlan->n_patterns; i++) {
9506                 nl_pat = nla_nest_start(msg, i + 1);
9507                 if (!nl_pat)
9508                         return -ENOBUFS;
9509                 pat_len = wowlan->patterns[i].pattern_len;
9510                 if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
9511                             wowlan->patterns[i].mask) ||
9512                     nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
9513                             wowlan->patterns[i].pattern) ||
9514                     nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
9515                                 wowlan->patterns[i].pkt_offset))
9516                         return -ENOBUFS;
9517                 nla_nest_end(msg, nl_pat);
9518         }
9519         nla_nest_end(msg, nl_pats);
9520
9521         return 0;
9522 }
9523
9524 static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
9525                                    struct cfg80211_wowlan_tcp *tcp)
9526 {
9527         struct nlattr *nl_tcp;
9528
9529         if (!tcp)
9530                 return 0;
9531
9532         nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
9533         if (!nl_tcp)
9534                 return -ENOBUFS;
9535
9536         if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
9537             nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
9538             nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
9539             nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
9540             nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
9541             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
9542                     tcp->payload_len, tcp->payload) ||
9543             nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
9544                         tcp->data_interval) ||
9545             nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
9546                     tcp->wake_len, tcp->wake_data) ||
9547             nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
9548                     DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
9549                 return -ENOBUFS;
9550
9551         if (tcp->payload_seq.len &&
9552             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
9553                     sizeof(tcp->payload_seq), &tcp->payload_seq))
9554                 return -ENOBUFS;
9555
9556         if (tcp->payload_tok.len &&
9557             nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
9558                     sizeof(tcp->payload_tok) + tcp->tokens_size,
9559                     &tcp->payload_tok))
9560                 return -ENOBUFS;
9561
9562         nla_nest_end(msg, nl_tcp);
9563
9564         return 0;
9565 }
9566
9567 static int nl80211_send_wowlan_nd(struct sk_buff *msg,
9568                                   struct cfg80211_sched_scan_request *req)
9569 {
9570         struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
9571         int i;
9572
9573         if (!req)
9574                 return 0;
9575
9576         nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
9577         if (!nd)
9578                 return -ENOBUFS;
9579
9580         if (req->n_scan_plans == 1 &&
9581             nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
9582                         req->scan_plans[0].interval * 1000))
9583                 return -ENOBUFS;
9584
9585         if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
9586                 return -ENOBUFS;
9587
9588         freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
9589         if (!freqs)
9590                 return -ENOBUFS;
9591
9592         for (i = 0; i < req->n_channels; i++) {
9593                 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
9594                         return -ENOBUFS;
9595         }
9596
9597         nla_nest_end(msg, freqs);
9598
9599         if (req->n_match_sets) {
9600                 matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
9601                 if (!matches)
9602                         return -ENOBUFS;
9603
9604                 for (i = 0; i < req->n_match_sets; i++) {
9605                         match = nla_nest_start(msg, i);
9606                         if (!match)
9607                                 return -ENOBUFS;
9608
9609                         if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
9610                                     req->match_sets[i].ssid.ssid_len,
9611                                     req->match_sets[i].ssid.ssid))
9612                                 return -ENOBUFS;
9613                         nla_nest_end(msg, match);
9614                 }
9615                 nla_nest_end(msg, matches);
9616         }
9617
9618         scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
9619         if (!scan_plans)
9620                 return -ENOBUFS;
9621
9622         for (i = 0; i < req->n_scan_plans; i++) {
9623                 scan_plan = nla_nest_start(msg, i + 1);
9624                 if (!scan_plan)
9625                         return -ENOBUFS;
9626
9627                 if (!scan_plan ||
9628                     nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
9629                                 req->scan_plans[i].interval) ||
9630                     (req->scan_plans[i].iterations &&
9631                      nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
9632                                  req->scan_plans[i].iterations)))
9633                         return -ENOBUFS;
9634                 nla_nest_end(msg, scan_plan);
9635         }
9636         nla_nest_end(msg, scan_plans);
9637
9638         nla_nest_end(msg, nd);
9639
9640         return 0;
9641 }
9642
9643 static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
9644 {
9645         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9646         struct sk_buff *msg;
9647         void *hdr;
9648         u32 size = NLMSG_DEFAULT_SIZE;
9649
9650         if (!rdev->wiphy.wowlan)
9651                 return -EOPNOTSUPP;
9652
9653         if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
9654                 /* adjust size to have room for all the data */
9655                 size += rdev->wiphy.wowlan_config->tcp->tokens_size +
9656                         rdev->wiphy.wowlan_config->tcp->payload_len +
9657                         rdev->wiphy.wowlan_config->tcp->wake_len +
9658                         rdev->wiphy.wowlan_config->tcp->wake_len / 8;
9659         }
9660
9661         msg = nlmsg_new(size, GFP_KERNEL);
9662         if (!msg)
9663                 return -ENOMEM;
9664
9665         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
9666                              NL80211_CMD_GET_WOWLAN);
9667         if (!hdr)
9668                 goto nla_put_failure;
9669
9670         if (rdev->wiphy.wowlan_config) {
9671                 struct nlattr *nl_wowlan;
9672
9673                 nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
9674                 if (!nl_wowlan)
9675                         goto nla_put_failure;
9676
9677                 if ((rdev->wiphy.wowlan_config->any &&
9678                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
9679                     (rdev->wiphy.wowlan_config->disconnect &&
9680                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
9681                     (rdev->wiphy.wowlan_config->magic_pkt &&
9682                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
9683                     (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
9684                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
9685                     (rdev->wiphy.wowlan_config->eap_identity_req &&
9686                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
9687                     (rdev->wiphy.wowlan_config->four_way_handshake &&
9688                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
9689                     (rdev->wiphy.wowlan_config->rfkill_release &&
9690                      nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
9691                         goto nla_put_failure;
9692
9693                 if (nl80211_send_wowlan_patterns(msg, rdev))
9694                         goto nla_put_failure;
9695
9696                 if (nl80211_send_wowlan_tcp(msg,
9697                                             rdev->wiphy.wowlan_config->tcp))
9698                         goto nla_put_failure;
9699
9700                 if (nl80211_send_wowlan_nd(
9701                             msg,
9702                             rdev->wiphy.wowlan_config->nd_config))
9703                         goto nla_put_failure;
9704
9705                 nla_nest_end(msg, nl_wowlan);
9706         }
9707
9708         genlmsg_end(msg, hdr);
9709         return genlmsg_reply(msg, info);
9710
9711 nla_put_failure:
9712         nlmsg_free(msg);
9713         return -ENOBUFS;
9714 }
9715
9716 static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
9717                                     struct nlattr *attr,
9718                                     struct cfg80211_wowlan *trig)
9719 {
9720         struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
9721         struct cfg80211_wowlan_tcp *cfg;
9722         struct nl80211_wowlan_tcp_data_token *tok = NULL;
9723         struct nl80211_wowlan_tcp_data_seq *seq = NULL;
9724         u32 size;
9725         u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
9726         int err, port;
9727
9728         if (!rdev->wiphy.wowlan->tcp)
9729                 return -EINVAL;
9730
9731         err = nla_parse(tb, MAX_NL80211_WOWLAN_TCP,
9732                         nla_data(attr), nla_len(attr),
9733                         nl80211_wowlan_tcp_policy);
9734         if (err)
9735                 return err;
9736
9737         if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
9738             !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
9739             !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
9740             !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
9741             !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
9742             !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
9743             !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
9744             !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
9745                 return -EINVAL;
9746
9747         data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
9748         if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
9749                 return -EINVAL;
9750
9751         if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
9752                         rdev->wiphy.wowlan->tcp->data_interval_max ||
9753             nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
9754                 return -EINVAL;
9755
9756         wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
9757         if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
9758                 return -EINVAL;
9759
9760         wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
9761         if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
9762                 return -EINVAL;
9763
9764         if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
9765                 u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
9766
9767                 tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
9768                 tokens_size = tokln - sizeof(*tok);
9769
9770                 if (!tok->len || tokens_size % tok->len)
9771                         return -EINVAL;
9772                 if (!rdev->wiphy.wowlan->tcp->tok)
9773                         return -EINVAL;
9774                 if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
9775                         return -EINVAL;
9776                 if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
9777                         return -EINVAL;
9778                 if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
9779                         return -EINVAL;
9780                 if (tok->offset + tok->len > data_size)
9781                         return -EINVAL;
9782         }
9783
9784         if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
9785                 seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
9786                 if (!rdev->wiphy.wowlan->tcp->seq)
9787                         return -EINVAL;
9788                 if (seq->len == 0 || seq->len > 4)
9789                         return -EINVAL;
9790                 if (seq->len + seq->offset > data_size)
9791                         return -EINVAL;
9792         }
9793
9794         size = sizeof(*cfg);
9795         size += data_size;
9796         size += wake_size + wake_mask_size;
9797         size += tokens_size;
9798
9799         cfg = kzalloc(size, GFP_KERNEL);
9800         if (!cfg)
9801                 return -ENOMEM;
9802         cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
9803         cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
9804         memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
9805                ETH_ALEN);
9806         if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
9807                 port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
9808         else
9809                 port = 0;
9810 #ifdef CONFIG_INET
9811         /* allocate a socket and port for it and use it */
9812         err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
9813                             IPPROTO_TCP, &cfg->sock, 1);
9814         if (err) {
9815                 kfree(cfg);
9816                 return err;
9817         }
9818         if (inet_csk_get_port(cfg->sock->sk, port)) {
9819                 sock_release(cfg->sock);
9820                 kfree(cfg);
9821                 return -EADDRINUSE;
9822         }
9823         cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
9824 #else
9825         if (!port) {
9826                 kfree(cfg);
9827                 return -EINVAL;
9828         }
9829         cfg->src_port = port;
9830 #endif
9831
9832         cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
9833         cfg->payload_len = data_size;
9834         cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
9835         memcpy((void *)cfg->payload,
9836                nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
9837                data_size);
9838         if (seq)
9839                 cfg->payload_seq = *seq;
9840         cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
9841         cfg->wake_len = wake_size;
9842         cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
9843         memcpy((void *)cfg->wake_data,
9844                nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
9845                wake_size);
9846         cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
9847                          data_size + wake_size;
9848         memcpy((void *)cfg->wake_mask,
9849                nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
9850                wake_mask_size);
9851         if (tok) {
9852                 cfg->tokens_size = tokens_size;
9853                 memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
9854         }
9855
9856         trig->tcp = cfg;
9857
9858         return 0;
9859 }
9860
9861 static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
9862                                    const struct wiphy_wowlan_support *wowlan,
9863                                    struct nlattr *attr,
9864                                    struct cfg80211_wowlan *trig)
9865 {
9866         struct nlattr **tb;
9867         int err;
9868
9869         tb = kzalloc(NUM_NL80211_ATTR * sizeof(*tb), GFP_KERNEL);
9870         if (!tb)
9871                 return -ENOMEM;
9872
9873         if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
9874                 err = -EOPNOTSUPP;
9875                 goto out;
9876         }
9877
9878         err = nla_parse(tb, NL80211_ATTR_MAX,
9879                         nla_data(attr), nla_len(attr),
9880                         nl80211_policy);
9881         if (err)
9882                 goto out;
9883
9884         trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb);
9885         err = PTR_ERR_OR_ZERO(trig->nd_config);
9886         if (err)
9887                 trig->nd_config = NULL;
9888
9889 out:
9890         kfree(tb);
9891         return err;
9892 }
9893
9894 static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
9895 {
9896         struct cfg80211_registered_device *rdev = info->user_ptr[0];
9897         struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
9898         struct cfg80211_wowlan new_triggers = {};
9899         struct cfg80211_wowlan *ntrig;
9900         const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
9901         int err, i;
9902         bool prev_enabled = rdev->wiphy.wowlan_config;
9903         bool regular = false;
9904
9905         if (!wowlan)
9906                 return -EOPNOTSUPP;
9907
9908         if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
9909                 cfg80211_rdev_free_wowlan(rdev);
9910                 rdev->wiphy.wowlan_config = NULL;
9911                 goto set_wakeup;
9912         }
9913
9914         err = nla_parse(tb, MAX_NL80211_WOWLAN_TRIG,
9915                         nla_data(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
9916                         nla_len(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
9917                         nl80211_wowlan_policy);
9918         if (err)
9919                 return err;
9920
9921         if (tb[NL80211_WOWLAN_TRIG_ANY]) {
9922                 if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
9923                         return -EINVAL;
9924                 new_triggers.any = true;
9925         }
9926
9927         if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
9928                 if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
9929                         return -EINVAL;
9930                 new_triggers.disconnect = true;
9931                 regular = true;
9932         }
9933
9934         if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
9935                 if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
9936                         return -EINVAL;
9937                 new_triggers.magic_pkt = true;
9938                 regular = true;
9939         }
9940
9941         if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
9942                 return -EINVAL;
9943
9944         if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
9945                 if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
9946                         return -EINVAL;
9947                 new_triggers.gtk_rekey_failure = true;
9948                 regular = true;
9949         }
9950
9951         if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
9952                 if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
9953                         return -EINVAL;
9954                 new_triggers.eap_identity_req = true;
9955                 regular = true;
9956         }
9957
9958         if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
9959                 if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
9960                         return -EINVAL;
9961                 new_triggers.four_way_handshake = true;
9962                 regular = true;
9963         }
9964
9965         if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
9966                 if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
9967                         return -EINVAL;
9968                 new_triggers.rfkill_release = true;
9969                 regular = true;
9970         }
9971
9972         if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
9973                 struct nlattr *pat;
9974                 int n_patterns = 0;
9975                 int rem, pat_len, mask_len, pkt_offset;
9976                 struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
9977
9978                 regular = true;
9979
9980                 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
9981                                     rem)
9982                         n_patterns++;
9983                 if (n_patterns > wowlan->n_patterns)
9984                         return -EINVAL;
9985
9986                 new_triggers.patterns = kcalloc(n_patterns,
9987                                                 sizeof(new_triggers.patterns[0]),
9988                                                 GFP_KERNEL);
9989                 if (!new_triggers.patterns)
9990                         return -ENOMEM;
9991
9992                 new_triggers.n_patterns = n_patterns;
9993                 i = 0;
9994
9995                 nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
9996                                     rem) {
9997                         u8 *mask_pat;
9998
9999                         nla_parse(pat_tb, MAX_NL80211_PKTPAT, nla_data(pat),
10000                                   nla_len(pat), NULL);
10001                         err = -EINVAL;
10002                         if (!pat_tb[NL80211_PKTPAT_MASK] ||
10003                             !pat_tb[NL80211_PKTPAT_PATTERN])
10004                                 goto error;
10005                         pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10006                         mask_len = DIV_ROUND_UP(pat_len, 8);
10007                         if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10008                                 goto error;
10009                         if (pat_len > wowlan->pattern_max_len ||
10010                             pat_len < wowlan->pattern_min_len)
10011                                 goto error;
10012
10013                         if (!pat_tb[NL80211_PKTPAT_OFFSET])
10014                                 pkt_offset = 0;
10015                         else
10016                                 pkt_offset = nla_get_u32(
10017                                         pat_tb[NL80211_PKTPAT_OFFSET]);
10018                         if (pkt_offset > wowlan->max_pkt_offset)
10019                                 goto error;
10020                         new_triggers.patterns[i].pkt_offset = pkt_offset;
10021
10022                         mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10023                         if (!mask_pat) {
10024                                 err = -ENOMEM;
10025                                 goto error;
10026                         }
10027                         new_triggers.patterns[i].mask = mask_pat;
10028                         memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10029                                mask_len);
10030                         mask_pat += mask_len;
10031                         new_triggers.patterns[i].pattern = mask_pat;
10032                         new_triggers.patterns[i].pattern_len = pat_len;
10033                         memcpy(mask_pat,
10034                                nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10035                                pat_len);
10036                         i++;
10037                 }
10038         }
10039
10040         if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
10041                 regular = true;
10042                 err = nl80211_parse_wowlan_tcp(
10043                         rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
10044                         &new_triggers);
10045                 if (err)
10046                         goto error;
10047         }
10048
10049         if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
10050                 regular = true;
10051                 err = nl80211_parse_wowlan_nd(
10052                         rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
10053                         &new_triggers);
10054                 if (err)
10055                         goto error;
10056         }
10057
10058         /* The 'any' trigger means the device continues operating more or less
10059          * as in its normal operation mode and wakes up the host on most of the
10060          * normal interrupts (like packet RX, ...)
10061          * It therefore makes little sense to combine with the more constrained
10062          * wakeup trigger modes.
10063          */
10064         if (new_triggers.any && regular) {
10065                 err = -EINVAL;
10066                 goto error;
10067         }
10068
10069         ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
10070         if (!ntrig) {
10071                 err = -ENOMEM;
10072                 goto error;
10073         }
10074         cfg80211_rdev_free_wowlan(rdev);
10075         rdev->wiphy.wowlan_config = ntrig;
10076
10077  set_wakeup:
10078         if (rdev->ops->set_wakeup &&
10079             prev_enabled != !!rdev->wiphy.wowlan_config)
10080                 rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
10081
10082         return 0;
10083  error:
10084         for (i = 0; i < new_triggers.n_patterns; i++)
10085                 kfree(new_triggers.patterns[i].mask);
10086         kfree(new_triggers.patterns);
10087         if (new_triggers.tcp && new_triggers.tcp->sock)
10088                 sock_release(new_triggers.tcp->sock);
10089         kfree(new_triggers.tcp);
10090         kfree(new_triggers.nd_config);
10091         return err;
10092 }
10093 #endif
10094
10095 static int nl80211_send_coalesce_rules(struct sk_buff *msg,
10096                                        struct cfg80211_registered_device *rdev)
10097 {
10098         struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
10099         int i, j, pat_len;
10100         struct cfg80211_coalesce_rules *rule;
10101
10102         if (!rdev->coalesce->n_rules)
10103                 return 0;
10104
10105         nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
10106         if (!nl_rules)
10107                 return -ENOBUFS;
10108
10109         for (i = 0; i < rdev->coalesce->n_rules; i++) {
10110                 nl_rule = nla_nest_start(msg, i + 1);
10111                 if (!nl_rule)
10112                         return -ENOBUFS;
10113
10114                 rule = &rdev->coalesce->rules[i];
10115                 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
10116                                 rule->delay))
10117                         return -ENOBUFS;
10118
10119                 if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
10120                                 rule->condition))
10121                         return -ENOBUFS;
10122
10123                 nl_pats = nla_nest_start(msg,
10124                                 NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
10125                 if (!nl_pats)
10126                         return -ENOBUFS;
10127
10128                 for (j = 0; j < rule->n_patterns; j++) {
10129                         nl_pat = nla_nest_start(msg, j + 1);
10130                         if (!nl_pat)
10131                                 return -ENOBUFS;
10132                         pat_len = rule->patterns[j].pattern_len;
10133                         if (nla_put(msg, NL80211_PKTPAT_MASK,
10134                                     DIV_ROUND_UP(pat_len, 8),
10135                                     rule->patterns[j].mask) ||
10136                             nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
10137                                     rule->patterns[j].pattern) ||
10138                             nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
10139                                         rule->patterns[j].pkt_offset))
10140                                 return -ENOBUFS;
10141                         nla_nest_end(msg, nl_pat);
10142                 }
10143                 nla_nest_end(msg, nl_pats);
10144                 nla_nest_end(msg, nl_rule);
10145         }
10146         nla_nest_end(msg, nl_rules);
10147
10148         return 0;
10149 }
10150
10151 static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
10152 {
10153         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10154         struct sk_buff *msg;
10155         void *hdr;
10156
10157         if (!rdev->wiphy.coalesce)
10158                 return -EOPNOTSUPP;
10159
10160         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10161         if (!msg)
10162                 return -ENOMEM;
10163
10164         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10165                              NL80211_CMD_GET_COALESCE);
10166         if (!hdr)
10167                 goto nla_put_failure;
10168
10169         if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
10170                 goto nla_put_failure;
10171
10172         genlmsg_end(msg, hdr);
10173         return genlmsg_reply(msg, info);
10174
10175 nla_put_failure:
10176         nlmsg_free(msg);
10177         return -ENOBUFS;
10178 }
10179
10180 void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
10181 {
10182         struct cfg80211_coalesce *coalesce = rdev->coalesce;
10183         int i, j;
10184         struct cfg80211_coalesce_rules *rule;
10185
10186         if (!coalesce)
10187                 return;
10188
10189         for (i = 0; i < coalesce->n_rules; i++) {
10190                 rule = &coalesce->rules[i];
10191                 for (j = 0; j < rule->n_patterns; j++)
10192                         kfree(rule->patterns[j].mask);
10193                 kfree(rule->patterns);
10194         }
10195         kfree(coalesce->rules);
10196         kfree(coalesce);
10197         rdev->coalesce = NULL;
10198 }
10199
10200 static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
10201                                        struct nlattr *rule,
10202                                        struct cfg80211_coalesce_rules *new_rule)
10203 {
10204         int err, i;
10205         const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10206         struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
10207         int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
10208         struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
10209
10210         err = nla_parse(tb, NL80211_ATTR_COALESCE_RULE_MAX, nla_data(rule),
10211                         nla_len(rule), nl80211_coalesce_policy);
10212         if (err)
10213                 return err;
10214
10215         if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
10216                 new_rule->delay =
10217                         nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
10218         if (new_rule->delay > coalesce->max_delay)
10219                 return -EINVAL;
10220
10221         if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
10222                 new_rule->condition =
10223                         nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
10224         if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
10225             new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
10226                 return -EINVAL;
10227
10228         if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
10229                 return -EINVAL;
10230
10231         nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10232                             rem)
10233                 n_patterns++;
10234         if (n_patterns > coalesce->n_patterns)
10235                 return -EINVAL;
10236
10237         new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
10238                                      GFP_KERNEL);
10239         if (!new_rule->patterns)
10240                 return -ENOMEM;
10241
10242         new_rule->n_patterns = n_patterns;
10243         i = 0;
10244
10245         nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
10246                             rem) {
10247                 u8 *mask_pat;
10248
10249                 nla_parse(pat_tb, MAX_NL80211_PKTPAT, nla_data(pat),
10250                           nla_len(pat), NULL);
10251                 if (!pat_tb[NL80211_PKTPAT_MASK] ||
10252                     !pat_tb[NL80211_PKTPAT_PATTERN])
10253                         return -EINVAL;
10254                 pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
10255                 mask_len = DIV_ROUND_UP(pat_len, 8);
10256                 if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
10257                         return -EINVAL;
10258                 if (pat_len > coalesce->pattern_max_len ||
10259                     pat_len < coalesce->pattern_min_len)
10260                         return -EINVAL;
10261
10262                 if (!pat_tb[NL80211_PKTPAT_OFFSET])
10263                         pkt_offset = 0;
10264                 else
10265                         pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
10266                 if (pkt_offset > coalesce->max_pkt_offset)
10267                         return -EINVAL;
10268                 new_rule->patterns[i].pkt_offset = pkt_offset;
10269
10270                 mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
10271                 if (!mask_pat)
10272                         return -ENOMEM;
10273
10274                 new_rule->patterns[i].mask = mask_pat;
10275                 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
10276                        mask_len);
10277
10278                 mask_pat += mask_len;
10279                 new_rule->patterns[i].pattern = mask_pat;
10280                 new_rule->patterns[i].pattern_len = pat_len;
10281                 memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
10282                        pat_len);
10283                 i++;
10284         }
10285
10286         return 0;
10287 }
10288
10289 static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
10290 {
10291         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10292         const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
10293         struct cfg80211_coalesce new_coalesce = {};
10294         struct cfg80211_coalesce *n_coalesce;
10295         int err, rem_rule, n_rules = 0, i, j;
10296         struct nlattr *rule;
10297         struct cfg80211_coalesce_rules *tmp_rule;
10298
10299         if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
10300                 return -EOPNOTSUPP;
10301
10302         if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
10303                 cfg80211_rdev_free_coalesce(rdev);
10304                 rdev_set_coalesce(rdev, NULL);
10305                 return 0;
10306         }
10307
10308         nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10309                             rem_rule)
10310                 n_rules++;
10311         if (n_rules > coalesce->n_rules)
10312                 return -EINVAL;
10313
10314         new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
10315                                      GFP_KERNEL);
10316         if (!new_coalesce.rules)
10317                 return -ENOMEM;
10318
10319         new_coalesce.n_rules = n_rules;
10320         i = 0;
10321
10322         nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
10323                             rem_rule) {
10324                 err = nl80211_parse_coalesce_rule(rdev, rule,
10325                                                   &new_coalesce.rules[i]);
10326                 if (err)
10327                         goto error;
10328
10329                 i++;
10330         }
10331
10332         err = rdev_set_coalesce(rdev, &new_coalesce);
10333         if (err)
10334                 goto error;
10335
10336         n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
10337         if (!n_coalesce) {
10338                 err = -ENOMEM;
10339                 goto error;
10340         }
10341         cfg80211_rdev_free_coalesce(rdev);
10342         rdev->coalesce = n_coalesce;
10343
10344         return 0;
10345 error:
10346         for (i = 0; i < new_coalesce.n_rules; i++) {
10347                 tmp_rule = &new_coalesce.rules[i];
10348                 for (j = 0; j < tmp_rule->n_patterns; j++)
10349                         kfree(tmp_rule->patterns[j].mask);
10350                 kfree(tmp_rule->patterns);
10351         }
10352         kfree(new_coalesce.rules);
10353
10354         return err;
10355 }
10356
10357 static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
10358 {
10359         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10360         struct net_device *dev = info->user_ptr[1];
10361         struct wireless_dev *wdev = dev->ieee80211_ptr;
10362         struct nlattr *tb[NUM_NL80211_REKEY_DATA];
10363         struct cfg80211_gtk_rekey_data rekey_data;
10364         int err;
10365
10366         if (!info->attrs[NL80211_ATTR_REKEY_DATA])
10367                 return -EINVAL;
10368
10369         err = nla_parse(tb, MAX_NL80211_REKEY_DATA,
10370                         nla_data(info->attrs[NL80211_ATTR_REKEY_DATA]),
10371                         nla_len(info->attrs[NL80211_ATTR_REKEY_DATA]),
10372                         nl80211_rekey_policy);
10373         if (err)
10374                 return err;
10375
10376         if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
10377                 return -ERANGE;
10378         if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
10379                 return -ERANGE;
10380         if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
10381                 return -ERANGE;
10382
10383         rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
10384         rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
10385         rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
10386
10387         wdev_lock(wdev);
10388         if (!wdev->current_bss) {
10389                 err = -ENOTCONN;
10390                 goto out;
10391         }
10392
10393         if (!rdev->ops->set_rekey_data) {
10394                 err = -EOPNOTSUPP;
10395                 goto out;
10396         }
10397
10398         err = rdev_set_rekey_data(rdev, dev, &rekey_data);
10399  out:
10400         wdev_unlock(wdev);
10401         return err;
10402 }
10403
10404 static int nl80211_register_unexpected_frame(struct sk_buff *skb,
10405                                              struct genl_info *info)
10406 {
10407         struct net_device *dev = info->user_ptr[1];
10408         struct wireless_dev *wdev = dev->ieee80211_ptr;
10409
10410         if (wdev->iftype != NL80211_IFTYPE_AP &&
10411             wdev->iftype != NL80211_IFTYPE_P2P_GO)
10412                 return -EINVAL;
10413
10414         if (wdev->ap_unexpected_nlportid)
10415                 return -EBUSY;
10416
10417         wdev->ap_unexpected_nlportid = info->snd_portid;
10418         return 0;
10419 }
10420
10421 static int nl80211_probe_client(struct sk_buff *skb,
10422                                 struct genl_info *info)
10423 {
10424         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10425         struct net_device *dev = info->user_ptr[1];
10426         struct wireless_dev *wdev = dev->ieee80211_ptr;
10427         struct sk_buff *msg;
10428         void *hdr;
10429         const u8 *addr;
10430         u64 cookie;
10431         int err;
10432
10433         if (wdev->iftype != NL80211_IFTYPE_AP &&
10434             wdev->iftype != NL80211_IFTYPE_P2P_GO)
10435                 return -EOPNOTSUPP;
10436
10437         if (!info->attrs[NL80211_ATTR_MAC])
10438                 return -EINVAL;
10439
10440         if (!rdev->ops->probe_client)
10441                 return -EOPNOTSUPP;
10442
10443         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10444         if (!msg)
10445                 return -ENOMEM;
10446
10447         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10448                              NL80211_CMD_PROBE_CLIENT);
10449         if (!hdr) {
10450                 err = -ENOBUFS;
10451                 goto free_msg;
10452         }
10453
10454         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
10455
10456         err = rdev_probe_client(rdev, dev, addr, &cookie);
10457         if (err)
10458                 goto free_msg;
10459
10460         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
10461                               NL80211_ATTR_PAD))
10462                 goto nla_put_failure;
10463
10464         genlmsg_end(msg, hdr);
10465
10466         return genlmsg_reply(msg, info);
10467
10468  nla_put_failure:
10469         err = -ENOBUFS;
10470  free_msg:
10471         nlmsg_free(msg);
10472         return err;
10473 }
10474
10475 static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
10476 {
10477         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10478         struct cfg80211_beacon_registration *reg, *nreg;
10479         int rv;
10480
10481         if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
10482                 return -EOPNOTSUPP;
10483
10484         nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
10485         if (!nreg)
10486                 return -ENOMEM;
10487
10488         /* First, check if already registered. */
10489         spin_lock_bh(&rdev->beacon_registrations_lock);
10490         list_for_each_entry(reg, &rdev->beacon_registrations, list) {
10491                 if (reg->nlportid == info->snd_portid) {
10492                         rv = -EALREADY;
10493                         goto out_err;
10494                 }
10495         }
10496         /* Add it to the list */
10497         nreg->nlportid = info->snd_portid;
10498         list_add(&nreg->list, &rdev->beacon_registrations);
10499
10500         spin_unlock_bh(&rdev->beacon_registrations_lock);
10501
10502         return 0;
10503 out_err:
10504         spin_unlock_bh(&rdev->beacon_registrations_lock);
10505         kfree(nreg);
10506         return rv;
10507 }
10508
10509 static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
10510 {
10511         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10512         struct wireless_dev *wdev = info->user_ptr[1];
10513         int err;
10514
10515         if (!rdev->ops->start_p2p_device)
10516                 return -EOPNOTSUPP;
10517
10518         if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
10519                 return -EOPNOTSUPP;
10520
10521         if (wdev->p2p_started)
10522                 return 0;
10523
10524         if (rfkill_blocked(rdev->rfkill))
10525                 return -ERFKILL;
10526
10527         err = rdev_start_p2p_device(rdev, wdev);
10528         if (err)
10529                 return err;
10530
10531         wdev->p2p_started = true;
10532         rdev->opencount++;
10533
10534         return 0;
10535 }
10536
10537 static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
10538 {
10539         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10540         struct wireless_dev *wdev = info->user_ptr[1];
10541
10542         if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
10543                 return -EOPNOTSUPP;
10544
10545         if (!rdev->ops->stop_p2p_device)
10546                 return -EOPNOTSUPP;
10547
10548         cfg80211_stop_p2p_device(rdev, wdev);
10549
10550         return 0;
10551 }
10552
10553 static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
10554 {
10555         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10556         struct wireless_dev *wdev = info->user_ptr[1];
10557         struct cfg80211_nan_conf conf = {};
10558         int err;
10559
10560         if (wdev->iftype != NL80211_IFTYPE_NAN)
10561                 return -EOPNOTSUPP;
10562
10563         if (wdev->nan_started)
10564                 return -EEXIST;
10565
10566         if (rfkill_blocked(rdev->rfkill))
10567                 return -ERFKILL;
10568
10569         if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
10570                 return -EINVAL;
10571
10572         if (!info->attrs[NL80211_ATTR_NAN_DUAL])
10573                 return -EINVAL;
10574
10575         conf.master_pref =
10576                 nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
10577         if (!conf.master_pref)
10578                 return -EINVAL;
10579
10580         conf.dual = nla_get_u8(info->attrs[NL80211_ATTR_NAN_DUAL]);
10581
10582         err = rdev_start_nan(rdev, wdev, &conf);
10583         if (err)
10584                 return err;
10585
10586         wdev->nan_started = true;
10587         rdev->opencount++;
10588
10589         return 0;
10590 }
10591
10592 static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
10593 {
10594         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10595         struct wireless_dev *wdev = info->user_ptr[1];
10596
10597         if (wdev->iftype != NL80211_IFTYPE_NAN)
10598                 return -EOPNOTSUPP;
10599
10600         cfg80211_stop_nan(rdev, wdev);
10601
10602         return 0;
10603 }
10604
10605 static int validate_nan_filter(struct nlattr *filter_attr)
10606 {
10607         struct nlattr *attr;
10608         int len = 0, n_entries = 0, rem;
10609
10610         nla_for_each_nested(attr, filter_attr, rem) {
10611                 len += nla_len(attr);
10612                 n_entries++;
10613         }
10614
10615         if (len >= U8_MAX)
10616                 return -EINVAL;
10617
10618         return n_entries;
10619 }
10620
10621 static int handle_nan_filter(struct nlattr *attr_filter,
10622                              struct cfg80211_nan_func *func,
10623                              bool tx)
10624 {
10625         struct nlattr *attr;
10626         int n_entries, rem, i;
10627         struct cfg80211_nan_func_filter *filter;
10628
10629         n_entries = validate_nan_filter(attr_filter);
10630         if (n_entries < 0)
10631                 return n_entries;
10632
10633         BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
10634
10635         filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
10636         if (!filter)
10637                 return -ENOMEM;
10638
10639         i = 0;
10640         nla_for_each_nested(attr, attr_filter, rem) {
10641                 filter[i].filter = kmemdup(nla_data(attr), nla_len(attr),
10642                                            GFP_KERNEL);
10643                 filter[i].len = nla_len(attr);
10644                 i++;
10645         }
10646         if (tx) {
10647                 func->num_tx_filters = n_entries;
10648                 func->tx_filters = filter;
10649         } else {
10650                 func->num_rx_filters = n_entries;
10651                 func->rx_filters = filter;
10652         }
10653
10654         return 0;
10655 }
10656
10657 static int nl80211_nan_add_func(struct sk_buff *skb,
10658                                 struct genl_info *info)
10659 {
10660         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10661         struct wireless_dev *wdev = info->user_ptr[1];
10662         struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
10663         struct cfg80211_nan_func *func;
10664         struct sk_buff *msg = NULL;
10665         void *hdr = NULL;
10666         int err = 0;
10667
10668         if (wdev->iftype != NL80211_IFTYPE_NAN)
10669                 return -EOPNOTSUPP;
10670
10671         if (!wdev->nan_started)
10672                 return -ENOTCONN;
10673
10674         if (!info->attrs[NL80211_ATTR_NAN_FUNC])
10675                 return -EINVAL;
10676
10677         if (wdev->owner_nlportid &&
10678             wdev->owner_nlportid != info->snd_portid)
10679                 return -ENOTCONN;
10680
10681         err = nla_parse(tb, NL80211_NAN_FUNC_ATTR_MAX,
10682                         nla_data(info->attrs[NL80211_ATTR_NAN_FUNC]),
10683                         nla_len(info->attrs[NL80211_ATTR_NAN_FUNC]),
10684                         nl80211_nan_func_policy);
10685         if (err)
10686                 return err;
10687
10688         func = kzalloc(sizeof(*func), GFP_KERNEL);
10689         if (!func)
10690                 return -ENOMEM;
10691
10692         func->cookie = wdev->wiphy->cookie_counter++;
10693
10694         if (!tb[NL80211_NAN_FUNC_TYPE] ||
10695             nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
10696                 err = -EINVAL;
10697                 goto out;
10698         }
10699
10700
10701         func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
10702
10703         if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
10704                 err = -EINVAL;
10705                 goto out;
10706         }
10707
10708         memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
10709                sizeof(func->service_id));
10710
10711         func->close_range =
10712                 nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
10713
10714         if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
10715                 func->serv_spec_info_len =
10716                         nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
10717                 func->serv_spec_info =
10718                         kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
10719                                 func->serv_spec_info_len,
10720                                 GFP_KERNEL);
10721                 if (!func->serv_spec_info) {
10722                         err = -ENOMEM;
10723                         goto out;
10724                 }
10725         }
10726
10727         if (tb[NL80211_NAN_FUNC_TTL])
10728                 func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
10729
10730         switch (func->type) {
10731         case NL80211_NAN_FUNC_PUBLISH:
10732                 if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
10733                         err = -EINVAL;
10734                         goto out;
10735                 }
10736
10737                 func->publish_type =
10738                         nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
10739                 func->publish_bcast =
10740                         nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
10741
10742                 if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
10743                         func->publish_bcast) {
10744                         err = -EINVAL;
10745                         goto out;
10746                 }
10747                 break;
10748         case NL80211_NAN_FUNC_SUBSCRIBE:
10749                 func->subscribe_active =
10750                         nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
10751                 break;
10752         case NL80211_NAN_FUNC_FOLLOW_UP:
10753                 if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
10754                     !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]) {
10755                         err = -EINVAL;
10756                         goto out;
10757                 }
10758
10759                 func->followup_id =
10760                         nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
10761                 func->followup_reqid =
10762                         nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
10763                 memcpy(func->followup_dest.addr,
10764                        nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
10765                        sizeof(func->followup_dest.addr));
10766                 if (func->ttl) {
10767                         err = -EINVAL;
10768                         goto out;
10769                 }
10770                 break;
10771         default:
10772                 err = -EINVAL;
10773                 goto out;
10774         }
10775
10776         if (tb[NL80211_NAN_FUNC_SRF]) {
10777                 struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
10778
10779                 err = nla_parse(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
10780                                 nla_data(tb[NL80211_NAN_FUNC_SRF]),
10781                                 nla_len(tb[NL80211_NAN_FUNC_SRF]), NULL);
10782                 if (err)
10783                         goto out;
10784
10785                 func->srf_include =
10786                         nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
10787
10788                 if (srf_tb[NL80211_NAN_SRF_BF]) {
10789                         if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
10790                             !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
10791                                 err = -EINVAL;
10792                                 goto out;
10793                         }
10794
10795                         func->srf_bf_len =
10796                                 nla_len(srf_tb[NL80211_NAN_SRF_BF]);
10797                         func->srf_bf =
10798                                 kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
10799                                         func->srf_bf_len, GFP_KERNEL);
10800                         if (!func->srf_bf) {
10801                                 err = -ENOMEM;
10802                                 goto out;
10803                         }
10804
10805                         func->srf_bf_idx =
10806                                 nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
10807                 } else {
10808                         struct nlattr *attr, *mac_attr =
10809                                 srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
10810                         int n_entries, rem, i = 0;
10811
10812                         if (!mac_attr) {
10813                                 err = -EINVAL;
10814                                 goto out;
10815                         }
10816
10817                         n_entries = validate_acl_mac_addrs(mac_attr);
10818                         if (n_entries <= 0) {
10819                                 err = -EINVAL;
10820                                 goto out;
10821                         }
10822
10823                         func->srf_num_macs = n_entries;
10824                         func->srf_macs =
10825                                 kzalloc(sizeof(*func->srf_macs) * n_entries,
10826                                         GFP_KERNEL);
10827                         if (!func->srf_macs) {
10828                                 err = -ENOMEM;
10829                                 goto out;
10830                         }
10831
10832                         nla_for_each_nested(attr, mac_attr, rem)
10833                                 memcpy(func->srf_macs[i++].addr, nla_data(attr),
10834                                        sizeof(*func->srf_macs));
10835                 }
10836         }
10837
10838         if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
10839                 err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
10840                                         func, true);
10841                 if (err)
10842                         goto out;
10843         }
10844
10845         if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
10846                 err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
10847                                         func, false);
10848                 if (err)
10849                         goto out;
10850         }
10851
10852         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
10853         if (!msg) {
10854                 err = -ENOMEM;
10855                 goto out;
10856         }
10857
10858         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
10859                              NL80211_CMD_ADD_NAN_FUNCTION);
10860         /* This can't really happen - we just allocated 4KB */
10861         if (WARN_ON(!hdr)) {
10862                 err = -ENOMEM;
10863                 goto out;
10864         }
10865
10866         err = rdev_add_nan_func(rdev, wdev, func);
10867 out:
10868         if (err < 0) {
10869                 cfg80211_free_nan_func(func);
10870                 nlmsg_free(msg);
10871                 return err;
10872         }
10873
10874         /* propagate the instance id and cookie to userspace  */
10875         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
10876                               NL80211_ATTR_PAD))
10877                 goto nla_put_failure;
10878
10879         func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
10880         if (!func_attr)
10881                 goto nla_put_failure;
10882
10883         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
10884                        func->instance_id))
10885                 goto nla_put_failure;
10886
10887         nla_nest_end(msg, func_attr);
10888
10889         genlmsg_end(msg, hdr);
10890         return genlmsg_reply(msg, info);
10891
10892 nla_put_failure:
10893         nlmsg_free(msg);
10894         return -ENOBUFS;
10895 }
10896
10897 static int nl80211_nan_del_func(struct sk_buff *skb,
10898                                struct genl_info *info)
10899 {
10900         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10901         struct wireless_dev *wdev = info->user_ptr[1];
10902         u64 cookie;
10903
10904         if (wdev->iftype != NL80211_IFTYPE_NAN)
10905                 return -EOPNOTSUPP;
10906
10907         if (!wdev->nan_started)
10908                 return -ENOTCONN;
10909
10910         if (!info->attrs[NL80211_ATTR_COOKIE])
10911                 return -EINVAL;
10912
10913         if (wdev->owner_nlportid &&
10914             wdev->owner_nlportid != info->snd_portid)
10915                 return -ENOTCONN;
10916
10917         cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
10918
10919         rdev_del_nan_func(rdev, wdev, cookie);
10920
10921         return 0;
10922 }
10923
10924 static int nl80211_nan_change_config(struct sk_buff *skb,
10925                                      struct genl_info *info)
10926 {
10927         struct cfg80211_registered_device *rdev = info->user_ptr[0];
10928         struct wireless_dev *wdev = info->user_ptr[1];
10929         struct cfg80211_nan_conf conf = {};
10930         u32 changed = 0;
10931
10932         if (wdev->iftype != NL80211_IFTYPE_NAN)
10933                 return -EOPNOTSUPP;
10934
10935         if (!wdev->nan_started)
10936                 return -ENOTCONN;
10937
10938         if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
10939                 conf.master_pref =
10940                         nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
10941                 if (conf.master_pref <= 1 || conf.master_pref == 255)
10942                         return -EINVAL;
10943
10944                 changed |= CFG80211_NAN_CONF_CHANGED_PREF;
10945         }
10946
10947         if (info->attrs[NL80211_ATTR_NAN_DUAL]) {
10948                 conf.dual = nla_get_u8(info->attrs[NL80211_ATTR_NAN_DUAL]);
10949                 changed |= CFG80211_NAN_CONF_CHANGED_DUAL;
10950         }
10951
10952         if (!changed)
10953                 return -EINVAL;
10954
10955         return rdev_nan_change_conf(rdev, wdev, &conf, changed);
10956 }
10957
10958 void cfg80211_nan_match(struct wireless_dev *wdev,
10959                         struct cfg80211_nan_match_params *match, gfp_t gfp)
10960 {
10961         struct wiphy *wiphy = wdev->wiphy;
10962         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
10963         struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
10964         struct sk_buff *msg;
10965         void *hdr;
10966
10967         if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
10968                 return;
10969
10970         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
10971         if (!msg)
10972                 return;
10973
10974         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
10975         if (!hdr) {
10976                 nlmsg_free(msg);
10977                 return;
10978         }
10979
10980         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
10981             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
10982                                          wdev->netdev->ifindex)) ||
10983             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
10984                               NL80211_ATTR_PAD))
10985                 goto nla_put_failure;
10986
10987         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
10988                               NL80211_ATTR_PAD) ||
10989             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
10990                 goto nla_put_failure;
10991
10992         match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
10993         if (!match_attr)
10994                 goto nla_put_failure;
10995
10996         local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
10997         if (!local_func_attr)
10998                 goto nla_put_failure;
10999
11000         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
11001                 goto nla_put_failure;
11002
11003         nla_nest_end(msg, local_func_attr);
11004
11005         peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
11006         if (!peer_func_attr)
11007                 goto nla_put_failure;
11008
11009         if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
11010             nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
11011                 goto nla_put_failure;
11012
11013         if (match->info && match->info_len &&
11014             nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
11015                     match->info))
11016                 goto nla_put_failure;
11017
11018         nla_nest_end(msg, peer_func_attr);
11019         nla_nest_end(msg, match_attr);
11020         genlmsg_end(msg, hdr);
11021
11022         if (!wdev->owner_nlportid)
11023                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11024                                         msg, 0, NL80211_MCGRP_NAN, gfp);
11025         else
11026                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11027                                 wdev->owner_nlportid);
11028
11029         return;
11030
11031 nla_put_failure:
11032         nlmsg_free(msg);
11033 }
11034 EXPORT_SYMBOL(cfg80211_nan_match);
11035
11036 void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
11037                                   u8 inst_id,
11038                                   enum nl80211_nan_func_term_reason reason,
11039                                   u64 cookie, gfp_t gfp)
11040 {
11041         struct wiphy *wiphy = wdev->wiphy;
11042         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11043         struct sk_buff *msg;
11044         struct nlattr *func_attr;
11045         void *hdr;
11046
11047         if (WARN_ON(!inst_id))
11048                 return;
11049
11050         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
11051         if (!msg)
11052                 return;
11053
11054         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
11055         if (!hdr) {
11056                 nlmsg_free(msg);
11057                 return;
11058         }
11059
11060         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11061             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
11062                                          wdev->netdev->ifindex)) ||
11063             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
11064                               NL80211_ATTR_PAD))
11065                 goto nla_put_failure;
11066
11067         if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
11068                               NL80211_ATTR_PAD))
11069                 goto nla_put_failure;
11070
11071         func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
11072         if (!func_attr)
11073                 goto nla_put_failure;
11074
11075         if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
11076             nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
11077                 goto nla_put_failure;
11078
11079         nla_nest_end(msg, func_attr);
11080         genlmsg_end(msg, hdr);
11081
11082         if (!wdev->owner_nlportid)
11083                 genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
11084                                         msg, 0, NL80211_MCGRP_NAN, gfp);
11085         else
11086                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
11087                                 wdev->owner_nlportid);
11088
11089         return;
11090
11091 nla_put_failure:
11092         nlmsg_free(msg);
11093 }
11094 EXPORT_SYMBOL(cfg80211_nan_func_terminated);
11095
11096 static int nl80211_get_protocol_features(struct sk_buff *skb,
11097                                          struct genl_info *info)
11098 {
11099         void *hdr;
11100         struct sk_buff *msg;
11101
11102         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
11103         if (!msg)
11104                 return -ENOMEM;
11105
11106         hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
11107                              NL80211_CMD_GET_PROTOCOL_FEATURES);
11108         if (!hdr)
11109                 goto nla_put_failure;
11110
11111         if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
11112                         NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
11113                 goto nla_put_failure;
11114
11115         genlmsg_end(msg, hdr);
11116         return genlmsg_reply(msg, info);
11117
11118  nla_put_failure:
11119         kfree_skb(msg);
11120         return -ENOBUFS;
11121 }
11122
11123 static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
11124 {
11125         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11126         struct cfg80211_update_ft_ies_params ft_params;
11127         struct net_device *dev = info->user_ptr[1];
11128
11129         if (!rdev->ops->update_ft_ies)
11130                 return -EOPNOTSUPP;
11131
11132         if (!info->attrs[NL80211_ATTR_MDID] ||
11133             !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
11134                 return -EINVAL;
11135
11136         memset(&ft_params, 0, sizeof(ft_params));
11137         ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
11138         ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
11139         ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
11140
11141         return rdev_update_ft_ies(rdev, dev, &ft_params);
11142 }
11143
11144 static int nl80211_crit_protocol_start(struct sk_buff *skb,
11145                                        struct genl_info *info)
11146 {
11147         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11148         struct wireless_dev *wdev = info->user_ptr[1];
11149         enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
11150         u16 duration;
11151         int ret;
11152
11153         if (!rdev->ops->crit_proto_start)
11154                 return -EOPNOTSUPP;
11155
11156         if (WARN_ON(!rdev->ops->crit_proto_stop))
11157                 return -EINVAL;
11158
11159         if (rdev->crit_proto_nlportid)
11160                 return -EBUSY;
11161
11162         /* determine protocol if provided */
11163         if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
11164                 proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
11165
11166         if (proto >= NUM_NL80211_CRIT_PROTO)
11167                 return -EINVAL;
11168
11169         /* timeout must be provided */
11170         if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
11171                 return -EINVAL;
11172
11173         duration =
11174                 nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
11175
11176         if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
11177                 return -ERANGE;
11178
11179         ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
11180         if (!ret)
11181                 rdev->crit_proto_nlportid = info->snd_portid;
11182
11183         return ret;
11184 }
11185
11186 static int nl80211_crit_protocol_stop(struct sk_buff *skb,
11187                                       struct genl_info *info)
11188 {
11189         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11190         struct wireless_dev *wdev = info->user_ptr[1];
11191
11192         if (!rdev->ops->crit_proto_stop)
11193                 return -EOPNOTSUPP;
11194
11195         if (rdev->crit_proto_nlportid) {
11196                 rdev->crit_proto_nlportid = 0;
11197                 rdev_crit_proto_stop(rdev, wdev);
11198         }
11199         return 0;
11200 }
11201
11202 static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
11203 {
11204         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11205         struct wireless_dev *wdev =
11206                 __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
11207         int i, err;
11208         u32 vid, subcmd;
11209
11210         if (!rdev->wiphy.vendor_commands)
11211                 return -EOPNOTSUPP;
11212
11213         if (IS_ERR(wdev)) {
11214                 err = PTR_ERR(wdev);
11215                 if (err != -EINVAL)
11216                         return err;
11217                 wdev = NULL;
11218         } else if (wdev->wiphy != &rdev->wiphy) {
11219                 return -EINVAL;
11220         }
11221
11222         if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
11223             !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
11224                 return -EINVAL;
11225
11226         vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
11227         subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
11228         for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
11229                 const struct wiphy_vendor_command *vcmd;
11230                 void *data = NULL;
11231                 int len = 0;
11232
11233                 vcmd = &rdev->wiphy.vendor_commands[i];
11234
11235                 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11236                         continue;
11237
11238                 if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11239                                    WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11240                         if (!wdev)
11241                                 return -EINVAL;
11242                         if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11243                             !wdev->netdev)
11244                                 return -EINVAL;
11245
11246                         if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11247                                 if (wdev->netdev &&
11248                                     !netif_running(wdev->netdev))
11249                                         return -ENETDOWN;
11250                                 if (!wdev->netdev && !wdev->p2p_started)
11251                                         return -ENETDOWN;
11252                         }
11253
11254                         if (!vcmd->doit)
11255                                 return -EOPNOTSUPP;
11256                 } else {
11257                         wdev = NULL;
11258                 }
11259
11260                 if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
11261                         data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11262                         len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
11263                 }
11264
11265                 rdev->cur_cmd_info = info;
11266                 err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
11267                                                           data, len);
11268                 rdev->cur_cmd_info = NULL;
11269                 return err;
11270         }
11271
11272         return -EOPNOTSUPP;
11273 }
11274
11275 static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
11276                                        struct netlink_callback *cb,
11277                                        struct cfg80211_registered_device **rdev,
11278                                        struct wireless_dev **wdev)
11279 {
11280         u32 vid, subcmd;
11281         unsigned int i;
11282         int vcmd_idx = -1;
11283         int err;
11284         void *data = NULL;
11285         unsigned int data_len = 0;
11286
11287         rtnl_lock();
11288
11289         if (cb->args[0]) {
11290                 /* subtract the 1 again here */
11291                 struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
11292                 struct wireless_dev *tmp;
11293
11294                 if (!wiphy) {
11295                         err = -ENODEV;
11296                         goto out_unlock;
11297                 }
11298                 *rdev = wiphy_to_rdev(wiphy);
11299                 *wdev = NULL;
11300
11301                 if (cb->args[1]) {
11302                         list_for_each_entry(tmp, &wiphy->wdev_list, list) {
11303                                 if (tmp->identifier == cb->args[1] - 1) {
11304                                         *wdev = tmp;
11305                                         break;
11306                                 }
11307                         }
11308                 }
11309
11310                 /* keep rtnl locked in successful case */
11311                 return 0;
11312         }
11313
11314         err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
11315                           nl80211_fam.attrbuf, nl80211_fam.maxattr,
11316                           nl80211_policy);
11317         if (err)
11318                 goto out_unlock;
11319
11320         if (!nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_ID] ||
11321             !nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) {
11322                 err = -EINVAL;
11323                 goto out_unlock;
11324         }
11325
11326         *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk),
11327                                            nl80211_fam.attrbuf);
11328         if (IS_ERR(*wdev))
11329                 *wdev = NULL;
11330
11331         *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
11332                                            nl80211_fam.attrbuf);
11333         if (IS_ERR(*rdev)) {
11334                 err = PTR_ERR(*rdev);
11335                 goto out_unlock;
11336         }
11337
11338         vid = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_ID]);
11339         subcmd = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
11340
11341         for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
11342                 const struct wiphy_vendor_command *vcmd;
11343
11344                 vcmd = &(*rdev)->wiphy.vendor_commands[i];
11345
11346                 if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
11347                         continue;
11348
11349                 if (!vcmd->dumpit) {
11350                         err = -EOPNOTSUPP;
11351                         goto out_unlock;
11352                 }
11353
11354                 vcmd_idx = i;
11355                 break;
11356         }
11357
11358         if (vcmd_idx < 0) {
11359                 err = -EOPNOTSUPP;
11360                 goto out_unlock;
11361         }
11362
11363         if (nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]) {
11364                 data = nla_data(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]);
11365                 data_len = nla_len(nl80211_fam.attrbuf[NL80211_ATTR_VENDOR_DATA]);
11366         }
11367
11368         /* 0 is the first index - add 1 to parse only once */
11369         cb->args[0] = (*rdev)->wiphy_idx + 1;
11370         /* add 1 to know if it was NULL */
11371         cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
11372         cb->args[2] = vcmd_idx;
11373         cb->args[3] = (unsigned long)data;
11374         cb->args[4] = data_len;
11375
11376         /* keep rtnl locked in successful case */
11377         return 0;
11378  out_unlock:
11379         rtnl_unlock();
11380         return err;
11381 }
11382
11383 static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
11384                                    struct netlink_callback *cb)
11385 {
11386         struct cfg80211_registered_device *rdev;
11387         struct wireless_dev *wdev;
11388         unsigned int vcmd_idx;
11389         const struct wiphy_vendor_command *vcmd;
11390         void *data;
11391         int data_len;
11392         int err;
11393         struct nlattr *vendor_data;
11394
11395         err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
11396         if (err)
11397                 return err;
11398
11399         vcmd_idx = cb->args[2];
11400         data = (void *)cb->args[3];
11401         data_len = cb->args[4];
11402         vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
11403
11404         if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
11405                            WIPHY_VENDOR_CMD_NEED_NETDEV)) {
11406                 if (!wdev)
11407                         return -EINVAL;
11408                 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
11409                     !wdev->netdev)
11410                         return -EINVAL;
11411
11412                 if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
11413                         if (wdev->netdev &&
11414                             !netif_running(wdev->netdev))
11415                                 return -ENETDOWN;
11416                         if (!wdev->netdev && !wdev->p2p_started)
11417                                 return -ENETDOWN;
11418                 }
11419         }
11420
11421         while (1) {
11422                 void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
11423                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
11424                                            NL80211_CMD_VENDOR);
11425                 if (!hdr)
11426                         break;
11427
11428                 if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
11429                     (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
11430                                                wdev_id(wdev),
11431                                                NL80211_ATTR_PAD))) {
11432                         genlmsg_cancel(skb, hdr);
11433                         break;
11434                 }
11435
11436                 vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
11437                 if (!vendor_data) {
11438                         genlmsg_cancel(skb, hdr);
11439                         break;
11440                 }
11441
11442                 err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
11443                                    (unsigned long *)&cb->args[5]);
11444                 nla_nest_end(skb, vendor_data);
11445
11446                 if (err == -ENOBUFS || err == -ENOENT) {
11447                         genlmsg_cancel(skb, hdr);
11448                         break;
11449                 } else if (err) {
11450                         genlmsg_cancel(skb, hdr);
11451                         goto out;
11452                 }
11453
11454                 genlmsg_end(skb, hdr);
11455         }
11456
11457         err = skb->len;
11458  out:
11459         rtnl_unlock();
11460         return err;
11461 }
11462
11463 struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
11464                                            enum nl80211_commands cmd,
11465                                            enum nl80211_attrs attr,
11466                                            int approxlen)
11467 {
11468         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
11469
11470         if (WARN_ON(!rdev->cur_cmd_info))
11471                 return NULL;
11472
11473         return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
11474                                            rdev->cur_cmd_info->snd_portid,
11475                                            rdev->cur_cmd_info->snd_seq,
11476                                            cmd, attr, NULL, GFP_KERNEL);
11477 }
11478 EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
11479
11480 int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
11481 {
11482         struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
11483         void *hdr = ((void **)skb->cb)[1];
11484         struct nlattr *data = ((void **)skb->cb)[2];
11485
11486         /* clear CB data for netlink core to own from now on */
11487         memset(skb->cb, 0, sizeof(skb->cb));
11488
11489         if (WARN_ON(!rdev->cur_cmd_info)) {
11490                 kfree_skb(skb);
11491                 return -EINVAL;
11492         }
11493
11494         nla_nest_end(skb, data);
11495         genlmsg_end(skb, hdr);
11496         return genlmsg_reply(skb, rdev->cur_cmd_info);
11497 }
11498 EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
11499
11500 static int nl80211_set_qos_map(struct sk_buff *skb,
11501                                struct genl_info *info)
11502 {
11503         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11504         struct cfg80211_qos_map *qos_map = NULL;
11505         struct net_device *dev = info->user_ptr[1];
11506         u8 *pos, len, num_des, des_len, des;
11507         int ret;
11508
11509         if (!rdev->ops->set_qos_map)
11510                 return -EOPNOTSUPP;
11511
11512         if (info->attrs[NL80211_ATTR_QOS_MAP]) {
11513                 pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
11514                 len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
11515
11516                 if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
11517                     len > IEEE80211_QOS_MAP_LEN_MAX)
11518                         return -EINVAL;
11519
11520                 qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
11521                 if (!qos_map)
11522                         return -ENOMEM;
11523
11524                 num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
11525                 if (num_des) {
11526                         des_len = num_des *
11527                                 sizeof(struct cfg80211_dscp_exception);
11528                         memcpy(qos_map->dscp_exception, pos, des_len);
11529                         qos_map->num_des = num_des;
11530                         for (des = 0; des < num_des; des++) {
11531                                 if (qos_map->dscp_exception[des].up > 7) {
11532                                         kfree(qos_map);
11533                                         return -EINVAL;
11534                                 }
11535                         }
11536                         pos += des_len;
11537                 }
11538                 memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
11539         }
11540
11541         wdev_lock(dev->ieee80211_ptr);
11542         ret = nl80211_key_allowed(dev->ieee80211_ptr);
11543         if (!ret)
11544                 ret = rdev_set_qos_map(rdev, dev, qos_map);
11545         wdev_unlock(dev->ieee80211_ptr);
11546
11547         kfree(qos_map);
11548         return ret;
11549 }
11550
11551 static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
11552 {
11553         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11554         struct net_device *dev = info->user_ptr[1];
11555         struct wireless_dev *wdev = dev->ieee80211_ptr;
11556         const u8 *peer;
11557         u8 tsid, up;
11558         u16 admitted_time = 0;
11559         int err;
11560
11561         if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
11562                 return -EOPNOTSUPP;
11563
11564         if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
11565             !info->attrs[NL80211_ATTR_USER_PRIO])
11566                 return -EINVAL;
11567
11568         tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
11569         if (tsid >= IEEE80211_NUM_TIDS)
11570                 return -EINVAL;
11571
11572         up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
11573         if (up >= IEEE80211_NUM_UPS)
11574                 return -EINVAL;
11575
11576         /* WMM uses TIDs 0-7 even for TSPEC */
11577         if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
11578                 /* TODO: handle 802.11 TSPEC/admission control
11579                  * need more attributes for that (e.g. BA session requirement);
11580                  * change the WMM adminssion test above to allow both then
11581                  */
11582                 return -EINVAL;
11583         }
11584
11585         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
11586
11587         if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
11588                 admitted_time =
11589                         nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
11590                 if (!admitted_time)
11591                         return -EINVAL;
11592         }
11593
11594         wdev_lock(wdev);
11595         switch (wdev->iftype) {
11596         case NL80211_IFTYPE_STATION:
11597         case NL80211_IFTYPE_P2P_CLIENT:
11598                 if (wdev->current_bss)
11599                         break;
11600                 err = -ENOTCONN;
11601                 goto out;
11602         default:
11603                 err = -EOPNOTSUPP;
11604                 goto out;
11605         }
11606
11607         err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
11608
11609  out:
11610         wdev_unlock(wdev);
11611         return err;
11612 }
11613
11614 static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
11615 {
11616         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11617         struct net_device *dev = info->user_ptr[1];
11618         struct wireless_dev *wdev = dev->ieee80211_ptr;
11619         const u8 *peer;
11620         u8 tsid;
11621         int err;
11622
11623         if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
11624                 return -EINVAL;
11625
11626         tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
11627         peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
11628
11629         wdev_lock(wdev);
11630         err = rdev_del_tx_ts(rdev, dev, tsid, peer);
11631         wdev_unlock(wdev);
11632
11633         return err;
11634 }
11635
11636 static int nl80211_tdls_channel_switch(struct sk_buff *skb,
11637                                        struct genl_info *info)
11638 {
11639         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11640         struct net_device *dev = info->user_ptr[1];
11641         struct wireless_dev *wdev = dev->ieee80211_ptr;
11642         struct cfg80211_chan_def chandef = {};
11643         const u8 *addr;
11644         u8 oper_class;
11645         int err;
11646
11647         if (!rdev->ops->tdls_channel_switch ||
11648             !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
11649                 return -EOPNOTSUPP;
11650
11651         switch (dev->ieee80211_ptr->iftype) {
11652         case NL80211_IFTYPE_STATION:
11653         case NL80211_IFTYPE_P2P_CLIENT:
11654                 break;
11655         default:
11656                 return -EOPNOTSUPP;
11657         }
11658
11659         if (!info->attrs[NL80211_ATTR_MAC] ||
11660             !info->attrs[NL80211_ATTR_OPER_CLASS])
11661                 return -EINVAL;
11662
11663         err = nl80211_parse_chandef(rdev, info, &chandef);
11664         if (err)
11665                 return err;
11666
11667         /*
11668          * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
11669          * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
11670          * specification is not defined for them.
11671          */
11672         if (chandef.chan->band == NL80211_BAND_2GHZ &&
11673             chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
11674             chandef.width != NL80211_CHAN_WIDTH_20)
11675                 return -EINVAL;
11676
11677         /* we will be active on the TDLS link */
11678         if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
11679                                            wdev->iftype))
11680                 return -EINVAL;
11681
11682         /* don't allow switching to DFS channels */
11683         if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
11684                 return -EINVAL;
11685
11686         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
11687         oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
11688
11689         wdev_lock(wdev);
11690         err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
11691         wdev_unlock(wdev);
11692
11693         return err;
11694 }
11695
11696 static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
11697                                               struct genl_info *info)
11698 {
11699         struct cfg80211_registered_device *rdev = info->user_ptr[0];
11700         struct net_device *dev = info->user_ptr[1];
11701         struct wireless_dev *wdev = dev->ieee80211_ptr;
11702         const u8 *addr;
11703
11704         if (!rdev->ops->tdls_channel_switch ||
11705             !rdev->ops->tdls_cancel_channel_switch ||
11706             !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
11707                 return -EOPNOTSUPP;
11708
11709         switch (dev->ieee80211_ptr->iftype) {
11710         case NL80211_IFTYPE_STATION:
11711         case NL80211_IFTYPE_P2P_CLIENT:
11712                 break;
11713         default:
11714                 return -EOPNOTSUPP;
11715         }
11716
11717         if (!info->attrs[NL80211_ATTR_MAC])
11718                 return -EINVAL;
11719
11720         addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
11721
11722         wdev_lock(wdev);
11723         rdev_tdls_cancel_channel_switch(rdev, dev, addr);
11724         wdev_unlock(wdev);
11725
11726         return 0;
11727 }
11728
11729 #define NL80211_FLAG_NEED_WIPHY         0x01
11730 #define NL80211_FLAG_NEED_NETDEV        0x02
11731 #define NL80211_FLAG_NEED_RTNL          0x04
11732 #define NL80211_FLAG_CHECK_NETDEV_UP    0x08
11733 #define NL80211_FLAG_NEED_NETDEV_UP     (NL80211_FLAG_NEED_NETDEV |\
11734                                          NL80211_FLAG_CHECK_NETDEV_UP)
11735 #define NL80211_FLAG_NEED_WDEV          0x10
11736 /* If a netdev is associated, it must be UP, P2P must be started */
11737 #define NL80211_FLAG_NEED_WDEV_UP       (NL80211_FLAG_NEED_WDEV |\
11738                                          NL80211_FLAG_CHECK_NETDEV_UP)
11739 #define NL80211_FLAG_CLEAR_SKB          0x20
11740
11741 static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
11742                             struct genl_info *info)
11743 {
11744         struct cfg80211_registered_device *rdev;
11745         struct wireless_dev *wdev;
11746         struct net_device *dev;
11747         bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
11748
11749         if (rtnl)
11750                 rtnl_lock();
11751
11752         if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
11753                 rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
11754                 if (IS_ERR(rdev)) {
11755                         if (rtnl)
11756                                 rtnl_unlock();
11757                         return PTR_ERR(rdev);
11758                 }
11759                 info->user_ptr[0] = rdev;
11760         } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
11761                    ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
11762                 ASSERT_RTNL();
11763
11764                 wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
11765                                                   info->attrs);
11766                 if (IS_ERR(wdev)) {
11767                         if (rtnl)
11768                                 rtnl_unlock();
11769                         return PTR_ERR(wdev);
11770                 }
11771
11772                 dev = wdev->netdev;
11773                 rdev = wiphy_to_rdev(wdev->wiphy);
11774
11775                 if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
11776                         if (!dev) {
11777                                 if (rtnl)
11778                                         rtnl_unlock();
11779                                 return -EINVAL;
11780                         }
11781
11782                         info->user_ptr[1] = dev;
11783                 } else {
11784                         info->user_ptr[1] = wdev;
11785                 }
11786
11787                 if (dev) {
11788                         if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
11789                             !netif_running(dev)) {
11790                                 if (rtnl)
11791                                         rtnl_unlock();
11792                                 return -ENETDOWN;
11793                         }
11794
11795                         dev_hold(dev);
11796                 } else if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP) {
11797                         if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE &&
11798                             !wdev->p2p_started) {
11799                                 if (rtnl)
11800                                         rtnl_unlock();
11801                                 return -ENETDOWN;
11802                         }
11803                         if (wdev->iftype == NL80211_IFTYPE_NAN &&
11804                             !wdev->nan_started) {
11805                                 if (rtnl)
11806                                         rtnl_unlock();
11807                                 return -ENETDOWN;
11808                         }
11809                 }
11810
11811                 info->user_ptr[0] = rdev;
11812         }
11813
11814         return 0;
11815 }
11816
11817 static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
11818                               struct genl_info *info)
11819 {
11820         if (info->user_ptr[1]) {
11821                 if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
11822                         struct wireless_dev *wdev = info->user_ptr[1];
11823
11824                         if (wdev->netdev)
11825                                 dev_put(wdev->netdev);
11826                 } else {
11827                         dev_put(info->user_ptr[1]);
11828                 }
11829         }
11830
11831         if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
11832                 rtnl_unlock();
11833
11834         /* If needed, clear the netlink message payload from the SKB
11835          * as it might contain key data that shouldn't stick around on
11836          * the heap after the SKB is freed. The netlink message header
11837          * is still needed for further processing, so leave it intact.
11838          */
11839         if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
11840                 struct nlmsghdr *nlh = nlmsg_hdr(skb);
11841
11842                 memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
11843         }
11844 }
11845
11846 static const struct genl_ops nl80211_ops[] = {
11847         {
11848                 .cmd = NL80211_CMD_GET_WIPHY,
11849                 .doit = nl80211_get_wiphy,
11850                 .dumpit = nl80211_dump_wiphy,
11851                 .done = nl80211_dump_wiphy_done,
11852                 .policy = nl80211_policy,
11853                 /* can be retrieved by unprivileged users */
11854                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
11855                                   NL80211_FLAG_NEED_RTNL,
11856         },
11857         {
11858                 .cmd = NL80211_CMD_SET_WIPHY,
11859                 .doit = nl80211_set_wiphy,
11860                 .policy = nl80211_policy,
11861                 .flags = GENL_UNS_ADMIN_PERM,
11862                 .internal_flags = NL80211_FLAG_NEED_RTNL,
11863         },
11864         {
11865                 .cmd = NL80211_CMD_GET_INTERFACE,
11866                 .doit = nl80211_get_interface,
11867                 .dumpit = nl80211_dump_interface,
11868                 .policy = nl80211_policy,
11869                 /* can be retrieved by unprivileged users */
11870                 .internal_flags = NL80211_FLAG_NEED_WDEV |
11871                                   NL80211_FLAG_NEED_RTNL,
11872         },
11873         {
11874                 .cmd = NL80211_CMD_SET_INTERFACE,
11875                 .doit = nl80211_set_interface,
11876                 .policy = nl80211_policy,
11877                 .flags = GENL_UNS_ADMIN_PERM,
11878                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
11879                                   NL80211_FLAG_NEED_RTNL,
11880         },
11881         {
11882                 .cmd = NL80211_CMD_NEW_INTERFACE,
11883                 .doit = nl80211_new_interface,
11884                 .policy = nl80211_policy,
11885                 .flags = GENL_UNS_ADMIN_PERM,
11886                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
11887                                   NL80211_FLAG_NEED_RTNL,
11888         },
11889         {
11890                 .cmd = NL80211_CMD_DEL_INTERFACE,
11891                 .doit = nl80211_del_interface,
11892                 .policy = nl80211_policy,
11893                 .flags = GENL_UNS_ADMIN_PERM,
11894                 .internal_flags = NL80211_FLAG_NEED_WDEV |
11895                                   NL80211_FLAG_NEED_RTNL,
11896         },
11897         {
11898                 .cmd = NL80211_CMD_GET_KEY,
11899                 .doit = nl80211_get_key,
11900                 .policy = nl80211_policy,
11901                 .flags = GENL_UNS_ADMIN_PERM,
11902                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11903                                   NL80211_FLAG_NEED_RTNL,
11904         },
11905         {
11906                 .cmd = NL80211_CMD_SET_KEY,
11907                 .doit = nl80211_set_key,
11908                 .policy = nl80211_policy,
11909                 .flags = GENL_UNS_ADMIN_PERM,
11910                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11911                                   NL80211_FLAG_NEED_RTNL |
11912                                   NL80211_FLAG_CLEAR_SKB,
11913         },
11914         {
11915                 .cmd = NL80211_CMD_NEW_KEY,
11916                 .doit = nl80211_new_key,
11917                 .policy = nl80211_policy,
11918                 .flags = GENL_UNS_ADMIN_PERM,
11919                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11920                                   NL80211_FLAG_NEED_RTNL |
11921                                   NL80211_FLAG_CLEAR_SKB,
11922         },
11923         {
11924                 .cmd = NL80211_CMD_DEL_KEY,
11925                 .doit = nl80211_del_key,
11926                 .policy = nl80211_policy,
11927                 .flags = GENL_UNS_ADMIN_PERM,
11928                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11929                                   NL80211_FLAG_NEED_RTNL,
11930         },
11931         {
11932                 .cmd = NL80211_CMD_SET_BEACON,
11933                 .policy = nl80211_policy,
11934                 .flags = GENL_UNS_ADMIN_PERM,
11935                 .doit = nl80211_set_beacon,
11936                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11937                                   NL80211_FLAG_NEED_RTNL,
11938         },
11939         {
11940                 .cmd = NL80211_CMD_START_AP,
11941                 .policy = nl80211_policy,
11942                 .flags = GENL_UNS_ADMIN_PERM,
11943                 .doit = nl80211_start_ap,
11944                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11945                                   NL80211_FLAG_NEED_RTNL,
11946         },
11947         {
11948                 .cmd = NL80211_CMD_STOP_AP,
11949                 .policy = nl80211_policy,
11950                 .flags = GENL_UNS_ADMIN_PERM,
11951                 .doit = nl80211_stop_ap,
11952                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11953                                   NL80211_FLAG_NEED_RTNL,
11954         },
11955         {
11956                 .cmd = NL80211_CMD_GET_STATION,
11957                 .doit = nl80211_get_station,
11958                 .dumpit = nl80211_dump_station,
11959                 .policy = nl80211_policy,
11960                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
11961                                   NL80211_FLAG_NEED_RTNL,
11962         },
11963         {
11964                 .cmd = NL80211_CMD_SET_STATION,
11965                 .doit = nl80211_set_station,
11966                 .policy = nl80211_policy,
11967                 .flags = GENL_UNS_ADMIN_PERM,
11968                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11969                                   NL80211_FLAG_NEED_RTNL,
11970         },
11971         {
11972                 .cmd = NL80211_CMD_NEW_STATION,
11973                 .doit = nl80211_new_station,
11974                 .policy = nl80211_policy,
11975                 .flags = GENL_UNS_ADMIN_PERM,
11976                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11977                                   NL80211_FLAG_NEED_RTNL,
11978         },
11979         {
11980                 .cmd = NL80211_CMD_DEL_STATION,
11981                 .doit = nl80211_del_station,
11982                 .policy = nl80211_policy,
11983                 .flags = GENL_UNS_ADMIN_PERM,
11984                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11985                                   NL80211_FLAG_NEED_RTNL,
11986         },
11987         {
11988                 .cmd = NL80211_CMD_GET_MPATH,
11989                 .doit = nl80211_get_mpath,
11990                 .dumpit = nl80211_dump_mpath,
11991                 .policy = nl80211_policy,
11992                 .flags = GENL_UNS_ADMIN_PERM,
11993                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
11994                                   NL80211_FLAG_NEED_RTNL,
11995         },
11996         {
11997                 .cmd = NL80211_CMD_GET_MPP,
11998                 .doit = nl80211_get_mpp,
11999                 .dumpit = nl80211_dump_mpp,
12000                 .policy = nl80211_policy,
12001                 .flags = GENL_UNS_ADMIN_PERM,
12002                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12003                                   NL80211_FLAG_NEED_RTNL,
12004         },
12005         {
12006                 .cmd = NL80211_CMD_SET_MPATH,
12007                 .doit = nl80211_set_mpath,
12008                 .policy = nl80211_policy,
12009                 .flags = GENL_UNS_ADMIN_PERM,
12010                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12011                                   NL80211_FLAG_NEED_RTNL,
12012         },
12013         {
12014                 .cmd = NL80211_CMD_NEW_MPATH,
12015                 .doit = nl80211_new_mpath,
12016                 .policy = nl80211_policy,
12017                 .flags = GENL_UNS_ADMIN_PERM,
12018                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12019                                   NL80211_FLAG_NEED_RTNL,
12020         },
12021         {
12022                 .cmd = NL80211_CMD_DEL_MPATH,
12023                 .doit = nl80211_del_mpath,
12024                 .policy = nl80211_policy,
12025                 .flags = GENL_UNS_ADMIN_PERM,
12026                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12027                                   NL80211_FLAG_NEED_RTNL,
12028         },
12029         {
12030                 .cmd = NL80211_CMD_SET_BSS,
12031                 .doit = nl80211_set_bss,
12032                 .policy = nl80211_policy,
12033                 .flags = GENL_UNS_ADMIN_PERM,
12034                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12035                                   NL80211_FLAG_NEED_RTNL,
12036         },
12037         {
12038                 .cmd = NL80211_CMD_GET_REG,
12039                 .doit = nl80211_get_reg_do,
12040                 .dumpit = nl80211_get_reg_dump,
12041                 .policy = nl80211_policy,
12042                 .internal_flags = NL80211_FLAG_NEED_RTNL,
12043                 /* can be retrieved by unprivileged users */
12044         },
12045 #ifdef CONFIG_CFG80211_CRDA_SUPPORT
12046         {
12047                 .cmd = NL80211_CMD_SET_REG,
12048                 .doit = nl80211_set_reg,
12049                 .policy = nl80211_policy,
12050                 .flags = GENL_ADMIN_PERM,
12051                 .internal_flags = NL80211_FLAG_NEED_RTNL,
12052         },
12053 #endif
12054         {
12055                 .cmd = NL80211_CMD_REQ_SET_REG,
12056                 .doit = nl80211_req_set_reg,
12057                 .policy = nl80211_policy,
12058                 .flags = GENL_ADMIN_PERM,
12059         },
12060         {
12061                 .cmd = NL80211_CMD_GET_MESH_CONFIG,
12062                 .doit = nl80211_get_mesh_config,
12063                 .policy = nl80211_policy,
12064                 /* can be retrieved by unprivileged users */
12065                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12066                                   NL80211_FLAG_NEED_RTNL,
12067         },
12068         {
12069                 .cmd = NL80211_CMD_SET_MESH_CONFIG,
12070                 .doit = nl80211_update_mesh_config,
12071                 .policy = nl80211_policy,
12072                 .flags = GENL_UNS_ADMIN_PERM,
12073                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12074                                   NL80211_FLAG_NEED_RTNL,
12075         },
12076         {
12077                 .cmd = NL80211_CMD_TRIGGER_SCAN,
12078                 .doit = nl80211_trigger_scan,
12079                 .policy = nl80211_policy,
12080                 .flags = GENL_UNS_ADMIN_PERM,
12081                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12082                                   NL80211_FLAG_NEED_RTNL,
12083         },
12084         {
12085                 .cmd = NL80211_CMD_ABORT_SCAN,
12086                 .doit = nl80211_abort_scan,
12087                 .policy = nl80211_policy,
12088                 .flags = GENL_UNS_ADMIN_PERM,
12089                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12090                                   NL80211_FLAG_NEED_RTNL,
12091         },
12092         {
12093                 .cmd = NL80211_CMD_GET_SCAN,
12094                 .policy = nl80211_policy,
12095                 .dumpit = nl80211_dump_scan,
12096         },
12097         {
12098                 .cmd = NL80211_CMD_START_SCHED_SCAN,
12099                 .doit = nl80211_start_sched_scan,
12100                 .policy = nl80211_policy,
12101                 .flags = GENL_UNS_ADMIN_PERM,
12102                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12103                                   NL80211_FLAG_NEED_RTNL,
12104         },
12105         {
12106                 .cmd = NL80211_CMD_STOP_SCHED_SCAN,
12107                 .doit = nl80211_stop_sched_scan,
12108                 .policy = nl80211_policy,
12109                 .flags = GENL_UNS_ADMIN_PERM,
12110                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12111                                   NL80211_FLAG_NEED_RTNL,
12112         },
12113         {
12114                 .cmd = NL80211_CMD_AUTHENTICATE,
12115                 .doit = nl80211_authenticate,
12116                 .policy = nl80211_policy,
12117                 .flags = GENL_UNS_ADMIN_PERM,
12118                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12119                                   NL80211_FLAG_NEED_RTNL |
12120                                   NL80211_FLAG_CLEAR_SKB,
12121         },
12122         {
12123                 .cmd = NL80211_CMD_ASSOCIATE,
12124                 .doit = nl80211_associate,
12125                 .policy = nl80211_policy,
12126                 .flags = GENL_UNS_ADMIN_PERM,
12127                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12128                                   NL80211_FLAG_NEED_RTNL,
12129         },
12130         {
12131                 .cmd = NL80211_CMD_DEAUTHENTICATE,
12132                 .doit = nl80211_deauthenticate,
12133                 .policy = nl80211_policy,
12134                 .flags = GENL_UNS_ADMIN_PERM,
12135                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12136                                   NL80211_FLAG_NEED_RTNL,
12137         },
12138         {
12139                 .cmd = NL80211_CMD_DISASSOCIATE,
12140                 .doit = nl80211_disassociate,
12141                 .policy = nl80211_policy,
12142                 .flags = GENL_UNS_ADMIN_PERM,
12143                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12144                                   NL80211_FLAG_NEED_RTNL,
12145         },
12146         {
12147                 .cmd = NL80211_CMD_JOIN_IBSS,
12148                 .doit = nl80211_join_ibss,
12149                 .policy = nl80211_policy,
12150                 .flags = GENL_UNS_ADMIN_PERM,
12151                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12152                                   NL80211_FLAG_NEED_RTNL,
12153         },
12154         {
12155                 .cmd = NL80211_CMD_LEAVE_IBSS,
12156                 .doit = nl80211_leave_ibss,
12157                 .policy = nl80211_policy,
12158                 .flags = GENL_UNS_ADMIN_PERM,
12159                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12160                                   NL80211_FLAG_NEED_RTNL,
12161         },
12162 #ifdef CONFIG_NL80211_TESTMODE
12163         {
12164                 .cmd = NL80211_CMD_TESTMODE,
12165                 .doit = nl80211_testmode_do,
12166                 .dumpit = nl80211_testmode_dump,
12167                 .policy = nl80211_policy,
12168                 .flags = GENL_UNS_ADMIN_PERM,
12169                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12170                                   NL80211_FLAG_NEED_RTNL,
12171         },
12172 #endif
12173         {
12174                 .cmd = NL80211_CMD_CONNECT,
12175                 .doit = nl80211_connect,
12176                 .policy = nl80211_policy,
12177                 .flags = GENL_UNS_ADMIN_PERM,
12178                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12179                                   NL80211_FLAG_NEED_RTNL,
12180         },
12181         {
12182                 .cmd = NL80211_CMD_DISCONNECT,
12183                 .doit = nl80211_disconnect,
12184                 .policy = nl80211_policy,
12185                 .flags = GENL_UNS_ADMIN_PERM,
12186                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12187                                   NL80211_FLAG_NEED_RTNL,
12188         },
12189         {
12190                 .cmd = NL80211_CMD_SET_WIPHY_NETNS,
12191                 .doit = nl80211_wiphy_netns,
12192                 .policy = nl80211_policy,
12193                 .flags = GENL_UNS_ADMIN_PERM,
12194                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12195                                   NL80211_FLAG_NEED_RTNL,
12196         },
12197         {
12198                 .cmd = NL80211_CMD_GET_SURVEY,
12199                 .policy = nl80211_policy,
12200                 .dumpit = nl80211_dump_survey,
12201         },
12202         {
12203                 .cmd = NL80211_CMD_SET_PMKSA,
12204                 .doit = nl80211_setdel_pmksa,
12205                 .policy = nl80211_policy,
12206                 .flags = GENL_UNS_ADMIN_PERM,
12207                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12208                                   NL80211_FLAG_NEED_RTNL,
12209         },
12210         {
12211                 .cmd = NL80211_CMD_DEL_PMKSA,
12212                 .doit = nl80211_setdel_pmksa,
12213                 .policy = nl80211_policy,
12214                 .flags = GENL_UNS_ADMIN_PERM,
12215                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12216                                   NL80211_FLAG_NEED_RTNL,
12217         },
12218         {
12219                 .cmd = NL80211_CMD_FLUSH_PMKSA,
12220                 .doit = nl80211_flush_pmksa,
12221                 .policy = nl80211_policy,
12222                 .flags = GENL_UNS_ADMIN_PERM,
12223                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12224                                   NL80211_FLAG_NEED_RTNL,
12225         },
12226         {
12227                 .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
12228                 .doit = nl80211_remain_on_channel,
12229                 .policy = nl80211_policy,
12230                 .flags = GENL_UNS_ADMIN_PERM,
12231                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12232                                   NL80211_FLAG_NEED_RTNL,
12233         },
12234         {
12235                 .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
12236                 .doit = nl80211_cancel_remain_on_channel,
12237                 .policy = nl80211_policy,
12238                 .flags = GENL_UNS_ADMIN_PERM,
12239                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12240                                   NL80211_FLAG_NEED_RTNL,
12241         },
12242         {
12243                 .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
12244                 .doit = nl80211_set_tx_bitrate_mask,
12245                 .policy = nl80211_policy,
12246                 .flags = GENL_UNS_ADMIN_PERM,
12247                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12248                                   NL80211_FLAG_NEED_RTNL,
12249         },
12250         {
12251                 .cmd = NL80211_CMD_REGISTER_FRAME,
12252                 .doit = nl80211_register_mgmt,
12253                 .policy = nl80211_policy,
12254                 .flags = GENL_UNS_ADMIN_PERM,
12255                 .internal_flags = NL80211_FLAG_NEED_WDEV |
12256                                   NL80211_FLAG_NEED_RTNL,
12257         },
12258         {
12259                 .cmd = NL80211_CMD_FRAME,
12260                 .doit = nl80211_tx_mgmt,
12261                 .policy = nl80211_policy,
12262                 .flags = GENL_UNS_ADMIN_PERM,
12263                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12264                                   NL80211_FLAG_NEED_RTNL,
12265         },
12266         {
12267                 .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
12268                 .doit = nl80211_tx_mgmt_cancel_wait,
12269                 .policy = nl80211_policy,
12270                 .flags = GENL_UNS_ADMIN_PERM,
12271                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12272                                   NL80211_FLAG_NEED_RTNL,
12273         },
12274         {
12275                 .cmd = NL80211_CMD_SET_POWER_SAVE,
12276                 .doit = nl80211_set_power_save,
12277                 .policy = nl80211_policy,
12278                 .flags = GENL_UNS_ADMIN_PERM,
12279                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12280                                   NL80211_FLAG_NEED_RTNL,
12281         },
12282         {
12283                 .cmd = NL80211_CMD_GET_POWER_SAVE,
12284                 .doit = nl80211_get_power_save,
12285                 .policy = nl80211_policy,
12286                 /* can be retrieved by unprivileged users */
12287                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12288                                   NL80211_FLAG_NEED_RTNL,
12289         },
12290         {
12291                 .cmd = NL80211_CMD_SET_CQM,
12292                 .doit = nl80211_set_cqm,
12293                 .policy = nl80211_policy,
12294                 .flags = GENL_UNS_ADMIN_PERM,
12295                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12296                                   NL80211_FLAG_NEED_RTNL,
12297         },
12298         {
12299                 .cmd = NL80211_CMD_SET_CHANNEL,
12300                 .doit = nl80211_set_channel,
12301                 .policy = nl80211_policy,
12302                 .flags = GENL_UNS_ADMIN_PERM,
12303                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12304                                   NL80211_FLAG_NEED_RTNL,
12305         },
12306         {
12307                 .cmd = NL80211_CMD_SET_WDS_PEER,
12308                 .doit = nl80211_set_wds_peer,
12309                 .policy = nl80211_policy,
12310                 .flags = GENL_UNS_ADMIN_PERM,
12311                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12312                                   NL80211_FLAG_NEED_RTNL,
12313         },
12314         {
12315                 .cmd = NL80211_CMD_JOIN_MESH,
12316                 .doit = nl80211_join_mesh,
12317                 .policy = nl80211_policy,
12318                 .flags = GENL_UNS_ADMIN_PERM,
12319                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12320                                   NL80211_FLAG_NEED_RTNL,
12321         },
12322         {
12323                 .cmd = NL80211_CMD_LEAVE_MESH,
12324                 .doit = nl80211_leave_mesh,
12325                 .policy = nl80211_policy,
12326                 .flags = GENL_UNS_ADMIN_PERM,
12327                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12328                                   NL80211_FLAG_NEED_RTNL,
12329         },
12330         {
12331                 .cmd = NL80211_CMD_JOIN_OCB,
12332                 .doit = nl80211_join_ocb,
12333                 .policy = nl80211_policy,
12334                 .flags = GENL_UNS_ADMIN_PERM,
12335                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12336                                   NL80211_FLAG_NEED_RTNL,
12337         },
12338         {
12339                 .cmd = NL80211_CMD_LEAVE_OCB,
12340                 .doit = nl80211_leave_ocb,
12341                 .policy = nl80211_policy,
12342                 .flags = GENL_UNS_ADMIN_PERM,
12343                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12344                                   NL80211_FLAG_NEED_RTNL,
12345         },
12346 #ifdef CONFIG_PM
12347         {
12348                 .cmd = NL80211_CMD_GET_WOWLAN,
12349                 .doit = nl80211_get_wowlan,
12350                 .policy = nl80211_policy,
12351                 /* can be retrieved by unprivileged users */
12352                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12353                                   NL80211_FLAG_NEED_RTNL,
12354         },
12355         {
12356                 .cmd = NL80211_CMD_SET_WOWLAN,
12357                 .doit = nl80211_set_wowlan,
12358                 .policy = nl80211_policy,
12359                 .flags = GENL_UNS_ADMIN_PERM,
12360                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12361                                   NL80211_FLAG_NEED_RTNL,
12362         },
12363 #endif
12364         {
12365                 .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
12366                 .doit = nl80211_set_rekey_data,
12367                 .policy = nl80211_policy,
12368                 .flags = GENL_UNS_ADMIN_PERM,
12369                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12370                                   NL80211_FLAG_NEED_RTNL |
12371                                   NL80211_FLAG_CLEAR_SKB,
12372         },
12373         {
12374                 .cmd = NL80211_CMD_TDLS_MGMT,
12375                 .doit = nl80211_tdls_mgmt,
12376                 .policy = nl80211_policy,
12377                 .flags = GENL_UNS_ADMIN_PERM,
12378                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12379                                   NL80211_FLAG_NEED_RTNL,
12380         },
12381         {
12382                 .cmd = NL80211_CMD_TDLS_OPER,
12383                 .doit = nl80211_tdls_oper,
12384                 .policy = nl80211_policy,
12385                 .flags = GENL_UNS_ADMIN_PERM,
12386                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12387                                   NL80211_FLAG_NEED_RTNL,
12388         },
12389         {
12390                 .cmd = NL80211_CMD_UNEXPECTED_FRAME,
12391                 .doit = nl80211_register_unexpected_frame,
12392                 .policy = nl80211_policy,
12393                 .flags = GENL_UNS_ADMIN_PERM,
12394                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12395                                   NL80211_FLAG_NEED_RTNL,
12396         },
12397         {
12398                 .cmd = NL80211_CMD_PROBE_CLIENT,
12399                 .doit = nl80211_probe_client,
12400                 .policy = nl80211_policy,
12401                 .flags = GENL_UNS_ADMIN_PERM,
12402                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12403                                   NL80211_FLAG_NEED_RTNL,
12404         },
12405         {
12406                 .cmd = NL80211_CMD_REGISTER_BEACONS,
12407                 .doit = nl80211_register_beacons,
12408                 .policy = nl80211_policy,
12409                 .flags = GENL_UNS_ADMIN_PERM,
12410                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12411                                   NL80211_FLAG_NEED_RTNL,
12412         },
12413         {
12414                 .cmd = NL80211_CMD_SET_NOACK_MAP,
12415                 .doit = nl80211_set_noack_map,
12416                 .policy = nl80211_policy,
12417                 .flags = GENL_UNS_ADMIN_PERM,
12418                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12419                                   NL80211_FLAG_NEED_RTNL,
12420         },
12421         {
12422                 .cmd = NL80211_CMD_START_P2P_DEVICE,
12423                 .doit = nl80211_start_p2p_device,
12424                 .policy = nl80211_policy,
12425                 .flags = GENL_UNS_ADMIN_PERM,
12426                 .internal_flags = NL80211_FLAG_NEED_WDEV |
12427                                   NL80211_FLAG_NEED_RTNL,
12428         },
12429         {
12430                 .cmd = NL80211_CMD_STOP_P2P_DEVICE,
12431                 .doit = nl80211_stop_p2p_device,
12432                 .policy = nl80211_policy,
12433                 .flags = GENL_UNS_ADMIN_PERM,
12434                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12435                                   NL80211_FLAG_NEED_RTNL,
12436         },
12437         {
12438                 .cmd = NL80211_CMD_START_NAN,
12439                 .doit = nl80211_start_nan,
12440                 .policy = nl80211_policy,
12441                 .flags = GENL_ADMIN_PERM,
12442                 .internal_flags = NL80211_FLAG_NEED_WDEV |
12443                                   NL80211_FLAG_NEED_RTNL,
12444         },
12445         {
12446                 .cmd = NL80211_CMD_STOP_NAN,
12447                 .doit = nl80211_stop_nan,
12448                 .policy = nl80211_policy,
12449                 .flags = GENL_ADMIN_PERM,
12450                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12451                                   NL80211_FLAG_NEED_RTNL,
12452         },
12453         {
12454                 .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
12455                 .doit = nl80211_nan_add_func,
12456                 .policy = nl80211_policy,
12457                 .flags = GENL_ADMIN_PERM,
12458                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12459                                   NL80211_FLAG_NEED_RTNL,
12460         },
12461         {
12462                 .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
12463                 .doit = nl80211_nan_del_func,
12464                 .policy = nl80211_policy,
12465                 .flags = GENL_ADMIN_PERM,
12466                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12467                                   NL80211_FLAG_NEED_RTNL,
12468         },
12469         {
12470                 .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
12471                 .doit = nl80211_nan_change_config,
12472                 .policy = nl80211_policy,
12473                 .flags = GENL_ADMIN_PERM,
12474                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12475                                   NL80211_FLAG_NEED_RTNL,
12476         },
12477         {
12478                 .cmd = NL80211_CMD_SET_MCAST_RATE,
12479                 .doit = nl80211_set_mcast_rate,
12480                 .policy = nl80211_policy,
12481                 .flags = GENL_UNS_ADMIN_PERM,
12482                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12483                                   NL80211_FLAG_NEED_RTNL,
12484         },
12485         {
12486                 .cmd = NL80211_CMD_SET_MAC_ACL,
12487                 .doit = nl80211_set_mac_acl,
12488                 .policy = nl80211_policy,
12489                 .flags = GENL_UNS_ADMIN_PERM,
12490                 .internal_flags = NL80211_FLAG_NEED_NETDEV |
12491                                   NL80211_FLAG_NEED_RTNL,
12492         },
12493         {
12494                 .cmd = NL80211_CMD_RADAR_DETECT,
12495                 .doit = nl80211_start_radar_detection,
12496                 .policy = nl80211_policy,
12497                 .flags = GENL_UNS_ADMIN_PERM,
12498                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12499                                   NL80211_FLAG_NEED_RTNL,
12500         },
12501         {
12502                 .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
12503                 .doit = nl80211_get_protocol_features,
12504                 .policy = nl80211_policy,
12505         },
12506         {
12507                 .cmd = NL80211_CMD_UPDATE_FT_IES,
12508                 .doit = nl80211_update_ft_ies,
12509                 .policy = nl80211_policy,
12510                 .flags = GENL_UNS_ADMIN_PERM,
12511                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12512                                   NL80211_FLAG_NEED_RTNL,
12513         },
12514         {
12515                 .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
12516                 .doit = nl80211_crit_protocol_start,
12517                 .policy = nl80211_policy,
12518                 .flags = GENL_UNS_ADMIN_PERM,
12519                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12520                                   NL80211_FLAG_NEED_RTNL,
12521         },
12522         {
12523                 .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
12524                 .doit = nl80211_crit_protocol_stop,
12525                 .policy = nl80211_policy,
12526                 .flags = GENL_UNS_ADMIN_PERM,
12527                 .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
12528                                   NL80211_FLAG_NEED_RTNL,
12529         },
12530         {
12531                 .cmd = NL80211_CMD_GET_COALESCE,
12532                 .doit = nl80211_get_coalesce,
12533                 .policy = nl80211_policy,
12534                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12535                                   NL80211_FLAG_NEED_RTNL,
12536         },
12537         {
12538                 .cmd = NL80211_CMD_SET_COALESCE,
12539                 .doit = nl80211_set_coalesce,
12540                 .policy = nl80211_policy,
12541                 .flags = GENL_UNS_ADMIN_PERM,
12542                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12543                                   NL80211_FLAG_NEED_RTNL,
12544         },
12545         {
12546                 .cmd = NL80211_CMD_CHANNEL_SWITCH,
12547                 .doit = nl80211_channel_switch,
12548                 .policy = nl80211_policy,
12549                 .flags = GENL_UNS_ADMIN_PERM,
12550                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12551                                   NL80211_FLAG_NEED_RTNL,
12552         },
12553         {
12554                 .cmd = NL80211_CMD_VENDOR,
12555                 .doit = nl80211_vendor_cmd,
12556                 .dumpit = nl80211_vendor_cmd_dump,
12557                 .policy = nl80211_policy,
12558                 .flags = GENL_UNS_ADMIN_PERM,
12559                 .internal_flags = NL80211_FLAG_NEED_WIPHY |
12560                                   NL80211_FLAG_NEED_RTNL,
12561         },
12562         {
12563                 .cmd = NL80211_CMD_SET_QOS_MAP,
12564                 .doit = nl80211_set_qos_map,
12565                 .policy = nl80211_policy,
12566                 .flags = GENL_UNS_ADMIN_PERM,
12567                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12568                                   NL80211_FLAG_NEED_RTNL,
12569         },
12570         {
12571                 .cmd = NL80211_CMD_ADD_TX_TS,
12572                 .doit = nl80211_add_tx_ts,
12573                 .policy = nl80211_policy,
12574                 .flags = GENL_UNS_ADMIN_PERM,
12575                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12576                                   NL80211_FLAG_NEED_RTNL,
12577         },
12578         {
12579                 .cmd = NL80211_CMD_DEL_TX_TS,
12580                 .doit = nl80211_del_tx_ts,
12581                 .policy = nl80211_policy,
12582                 .flags = GENL_UNS_ADMIN_PERM,
12583                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12584                                   NL80211_FLAG_NEED_RTNL,
12585         },
12586         {
12587                 .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
12588                 .doit = nl80211_tdls_channel_switch,
12589                 .policy = nl80211_policy,
12590                 .flags = GENL_UNS_ADMIN_PERM,
12591                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12592                                   NL80211_FLAG_NEED_RTNL,
12593         },
12594         {
12595                 .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
12596                 .doit = nl80211_tdls_cancel_channel_switch,
12597                 .policy = nl80211_policy,
12598                 .flags = GENL_UNS_ADMIN_PERM,
12599                 .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
12600                                   NL80211_FLAG_NEED_RTNL,
12601         },
12602 };
12603
12604 /* notification functions */
12605
12606 void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
12607                           enum nl80211_commands cmd)
12608 {
12609         struct sk_buff *msg;
12610         struct nl80211_dump_wiphy_state state = {};
12611
12612         WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
12613                 cmd != NL80211_CMD_DEL_WIPHY);
12614
12615         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12616         if (!msg)
12617                 return;
12618
12619         if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
12620                 nlmsg_free(msg);
12621                 return;
12622         }
12623
12624         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12625                                 NL80211_MCGRP_CONFIG, GFP_KERNEL);
12626 }
12627
12628 void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
12629                                 struct wireless_dev *wdev,
12630                                 enum nl80211_commands cmd)
12631 {
12632         struct sk_buff *msg;
12633
12634         WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
12635                 cmd != NL80211_CMD_DEL_INTERFACE);
12636
12637         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12638         if (!msg)
12639                 return;
12640
12641         if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
12642                                cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
12643                 nlmsg_free(msg);
12644                 return;
12645         }
12646
12647         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12648                                 NL80211_MCGRP_CONFIG, GFP_KERNEL);
12649 }
12650
12651 static int nl80211_add_scan_req(struct sk_buff *msg,
12652                                 struct cfg80211_registered_device *rdev)
12653 {
12654         struct cfg80211_scan_request *req = rdev->scan_req;
12655         struct nlattr *nest;
12656         int i;
12657
12658         if (WARN_ON(!req))
12659                 return 0;
12660
12661         nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
12662         if (!nest)
12663                 goto nla_put_failure;
12664         for (i = 0; i < req->n_ssids; i++) {
12665                 if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
12666                         goto nla_put_failure;
12667         }
12668         nla_nest_end(msg, nest);
12669
12670         nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
12671         if (!nest)
12672                 goto nla_put_failure;
12673         for (i = 0; i < req->n_channels; i++) {
12674                 if (nla_put_u32(msg, i, req->channels[i]->center_freq))
12675                         goto nla_put_failure;
12676         }
12677         nla_nest_end(msg, nest);
12678
12679         if (req->ie &&
12680             nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
12681                 goto nla_put_failure;
12682
12683         if (req->flags &&
12684             nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
12685                 goto nla_put_failure;
12686
12687         if (req->info.scan_start_tsf &&
12688             (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
12689                                req->info.scan_start_tsf, NL80211_BSS_PAD) ||
12690              nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
12691                      req->info.tsf_bssid)))
12692                 goto nla_put_failure;
12693
12694         return 0;
12695  nla_put_failure:
12696         return -ENOBUFS;
12697 }
12698
12699 static int nl80211_send_scan_msg(struct sk_buff *msg,
12700                                  struct cfg80211_registered_device *rdev,
12701                                  struct wireless_dev *wdev,
12702                                  u32 portid, u32 seq, int flags,
12703                                  u32 cmd)
12704 {
12705         void *hdr;
12706
12707         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
12708         if (!hdr)
12709                 return -1;
12710
12711         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12712             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
12713                                          wdev->netdev->ifindex)) ||
12714             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
12715                               NL80211_ATTR_PAD))
12716                 goto nla_put_failure;
12717
12718         /* ignore errors and send incomplete event anyway */
12719         nl80211_add_scan_req(msg, rdev);
12720
12721         genlmsg_end(msg, hdr);
12722         return 0;
12723
12724  nla_put_failure:
12725         genlmsg_cancel(msg, hdr);
12726         return -EMSGSIZE;
12727 }
12728
12729 static int
12730 nl80211_send_sched_scan_msg(struct sk_buff *msg,
12731                             struct cfg80211_registered_device *rdev,
12732                             struct net_device *netdev,
12733                             u32 portid, u32 seq, int flags, u32 cmd)
12734 {
12735         void *hdr;
12736
12737         hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
12738         if (!hdr)
12739                 return -1;
12740
12741         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12742             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
12743                 goto nla_put_failure;
12744
12745         genlmsg_end(msg, hdr);
12746         return 0;
12747
12748  nla_put_failure:
12749         genlmsg_cancel(msg, hdr);
12750         return -EMSGSIZE;
12751 }
12752
12753 void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
12754                              struct wireless_dev *wdev)
12755 {
12756         struct sk_buff *msg;
12757
12758         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12759         if (!msg)
12760                 return;
12761
12762         if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
12763                                   NL80211_CMD_TRIGGER_SCAN) < 0) {
12764                 nlmsg_free(msg);
12765                 return;
12766         }
12767
12768         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12769                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
12770 }
12771
12772 struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
12773                                        struct wireless_dev *wdev, bool aborted)
12774 {
12775         struct sk_buff *msg;
12776
12777         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12778         if (!msg)
12779                 return NULL;
12780
12781         if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
12782                                   aborted ? NL80211_CMD_SCAN_ABORTED :
12783                                             NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
12784                 nlmsg_free(msg);
12785                 return NULL;
12786         }
12787
12788         return msg;
12789 }
12790
12791 void nl80211_send_scan_result(struct cfg80211_registered_device *rdev,
12792                               struct sk_buff *msg)
12793 {
12794         if (!msg)
12795                 return;
12796
12797         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12798                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
12799 }
12800
12801 void nl80211_send_sched_scan_results(struct cfg80211_registered_device *rdev,
12802                                      struct net_device *netdev)
12803 {
12804         struct sk_buff *msg;
12805
12806         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12807         if (!msg)
12808                 return;
12809
12810         if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0,
12811                                         NL80211_CMD_SCHED_SCAN_RESULTS) < 0) {
12812                 nlmsg_free(msg);
12813                 return;
12814         }
12815
12816         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12817                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
12818 }
12819
12820 void nl80211_send_sched_scan(struct cfg80211_registered_device *rdev,
12821                              struct net_device *netdev, u32 cmd)
12822 {
12823         struct sk_buff *msg;
12824
12825         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12826         if (!msg)
12827                 return;
12828
12829         if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0, cmd) < 0) {
12830                 nlmsg_free(msg);
12831                 return;
12832         }
12833
12834         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12835                                 NL80211_MCGRP_SCAN, GFP_KERNEL);
12836 }
12837
12838 static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
12839                                           struct regulatory_request *request)
12840 {
12841         /* Userspace can always count this one always being set */
12842         if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
12843                 goto nla_put_failure;
12844
12845         if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
12846                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12847                                NL80211_REGDOM_TYPE_WORLD))
12848                         goto nla_put_failure;
12849         } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
12850                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12851                                NL80211_REGDOM_TYPE_CUSTOM_WORLD))
12852                         goto nla_put_failure;
12853         } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
12854                    request->intersect) {
12855                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12856                                NL80211_REGDOM_TYPE_INTERSECTION))
12857                         goto nla_put_failure;
12858         } else {
12859                 if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
12860                                NL80211_REGDOM_TYPE_COUNTRY) ||
12861                     nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
12862                                    request->alpha2))
12863                         goto nla_put_failure;
12864         }
12865
12866         if (request->wiphy_idx != WIPHY_IDX_INVALID) {
12867                 struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
12868
12869                 if (wiphy &&
12870                     nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
12871                         goto nla_put_failure;
12872
12873                 if (wiphy &&
12874                     wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
12875                     nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
12876                         goto nla_put_failure;
12877         }
12878
12879         return true;
12880
12881 nla_put_failure:
12882         return false;
12883 }
12884
12885 /*
12886  * This can happen on global regulatory changes or device specific settings
12887  * based on custom regulatory domains.
12888  */
12889 void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
12890                                      struct regulatory_request *request)
12891 {
12892         struct sk_buff *msg;
12893         void *hdr;
12894
12895         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
12896         if (!msg)
12897                 return;
12898
12899         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
12900         if (!hdr) {
12901                 nlmsg_free(msg);
12902                 return;
12903         }
12904
12905         if (nl80211_reg_change_event_fill(msg, request) == false)
12906                 goto nla_put_failure;
12907
12908         genlmsg_end(msg, hdr);
12909
12910         rcu_read_lock();
12911         genlmsg_multicast_allns(&nl80211_fam, msg, 0,
12912                                 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
12913         rcu_read_unlock();
12914
12915         return;
12916
12917 nla_put_failure:
12918         genlmsg_cancel(msg, hdr);
12919         nlmsg_free(msg);
12920 }
12921
12922 static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
12923                                     struct net_device *netdev,
12924                                     const u8 *buf, size_t len,
12925                                     enum nl80211_commands cmd, gfp_t gfp,
12926                                     int uapsd_queues)
12927 {
12928         struct sk_buff *msg;
12929         void *hdr;
12930
12931         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
12932         if (!msg)
12933                 return;
12934
12935         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
12936         if (!hdr) {
12937                 nlmsg_free(msg);
12938                 return;
12939         }
12940
12941         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
12942             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
12943             nla_put(msg, NL80211_ATTR_FRAME, len, buf))
12944                 goto nla_put_failure;
12945
12946         if (uapsd_queues >= 0) {
12947                 struct nlattr *nla_wmm =
12948                         nla_nest_start(msg, NL80211_ATTR_STA_WME);
12949                 if (!nla_wmm)
12950                         goto nla_put_failure;
12951
12952                 if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
12953                                uapsd_queues))
12954                         goto nla_put_failure;
12955
12956                 nla_nest_end(msg, nla_wmm);
12957         }
12958
12959         genlmsg_end(msg, hdr);
12960
12961         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
12962                                 NL80211_MCGRP_MLME, gfp);
12963         return;
12964
12965  nla_put_failure:
12966         genlmsg_cancel(msg, hdr);
12967         nlmsg_free(msg);
12968 }
12969
12970 void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
12971                           struct net_device *netdev, const u8 *buf,
12972                           size_t len, gfp_t gfp)
12973 {
12974         nl80211_send_mlme_event(rdev, netdev, buf, len,
12975                                 NL80211_CMD_AUTHENTICATE, gfp, -1);
12976 }
12977
12978 void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
12979                            struct net_device *netdev, const u8 *buf,
12980                            size_t len, gfp_t gfp, int uapsd_queues)
12981 {
12982         nl80211_send_mlme_event(rdev, netdev, buf, len,
12983                                 NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
12984 }
12985
12986 void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
12987                          struct net_device *netdev, const u8 *buf,
12988                          size_t len, gfp_t gfp)
12989 {
12990         nl80211_send_mlme_event(rdev, netdev, buf, len,
12991                                 NL80211_CMD_DEAUTHENTICATE, gfp, -1);
12992 }
12993
12994 void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
12995                            struct net_device *netdev, const u8 *buf,
12996                            size_t len, gfp_t gfp)
12997 {
12998         nl80211_send_mlme_event(rdev, netdev, buf, len,
12999                                 NL80211_CMD_DISASSOCIATE, gfp, -1);
13000 }
13001
13002 void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
13003                                   size_t len)
13004 {
13005         struct wireless_dev *wdev = dev->ieee80211_ptr;
13006         struct wiphy *wiphy = wdev->wiphy;
13007         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13008         const struct ieee80211_mgmt *mgmt = (void *)buf;
13009         u32 cmd;
13010
13011         if (WARN_ON(len < 2))
13012                 return;
13013
13014         if (ieee80211_is_deauth(mgmt->frame_control))
13015                 cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
13016         else
13017                 cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
13018
13019         trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
13020         nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
13021 }
13022 EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
13023
13024 static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
13025                                       struct net_device *netdev, int cmd,
13026                                       const u8 *addr, gfp_t gfp)
13027 {
13028         struct sk_buff *msg;
13029         void *hdr;
13030
13031         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13032         if (!msg)
13033                 return;
13034
13035         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13036         if (!hdr) {
13037                 nlmsg_free(msg);
13038                 return;
13039         }
13040
13041         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13042             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13043             nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
13044             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
13045                 goto nla_put_failure;
13046
13047         genlmsg_end(msg, hdr);
13048
13049         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13050                                 NL80211_MCGRP_MLME, gfp);
13051         return;
13052
13053  nla_put_failure:
13054         genlmsg_cancel(msg, hdr);
13055         nlmsg_free(msg);
13056 }
13057
13058 void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
13059                                struct net_device *netdev, const u8 *addr,
13060                                gfp_t gfp)
13061 {
13062         nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
13063                                   addr, gfp);
13064 }
13065
13066 void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
13067                                 struct net_device *netdev, const u8 *addr,
13068                                 gfp_t gfp)
13069 {
13070         nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
13071                                   addr, gfp);
13072 }
13073
13074 void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
13075                                  struct net_device *netdev, const u8 *bssid,
13076                                  const u8 *req_ie, size_t req_ie_len,
13077                                  const u8 *resp_ie, size_t resp_ie_len,
13078                                  int status, gfp_t gfp)
13079 {
13080         struct sk_buff *msg;
13081         void *hdr;
13082
13083         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13084         if (!msg)
13085                 return;
13086
13087         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
13088         if (!hdr) {
13089                 nlmsg_free(msg);
13090                 return;
13091         }
13092
13093         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13094             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13095             (bssid && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) ||
13096             nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
13097                         status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
13098                         status) ||
13099             (status < 0 && nla_put_flag(msg, NL80211_ATTR_TIMED_OUT)) ||
13100             (req_ie &&
13101              nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
13102             (resp_ie &&
13103              nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
13104                 goto nla_put_failure;
13105
13106         genlmsg_end(msg, hdr);
13107
13108         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13109                                 NL80211_MCGRP_MLME, gfp);
13110         return;
13111
13112  nla_put_failure:
13113         genlmsg_cancel(msg, hdr);
13114         nlmsg_free(msg);
13115 }
13116
13117 void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
13118                          struct net_device *netdev, const u8 *bssid,
13119                          const u8 *req_ie, size_t req_ie_len,
13120                          const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
13121 {
13122         struct sk_buff *msg;
13123         void *hdr;
13124
13125         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13126         if (!msg)
13127                 return;
13128
13129         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
13130         if (!hdr) {
13131                 nlmsg_free(msg);
13132                 return;
13133         }
13134
13135         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13136             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13137             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
13138             (req_ie &&
13139              nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
13140             (resp_ie &&
13141              nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
13142                 goto nla_put_failure;
13143
13144         genlmsg_end(msg, hdr);
13145
13146         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13147                                 NL80211_MCGRP_MLME, gfp);
13148         return;
13149
13150  nla_put_failure:
13151         genlmsg_cancel(msg, hdr);
13152         nlmsg_free(msg);
13153 }
13154
13155 void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
13156                                struct net_device *netdev, u16 reason,
13157                                const u8 *ie, size_t ie_len, bool from_ap)
13158 {
13159         struct sk_buff *msg;
13160         void *hdr;
13161
13162         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
13163         if (!msg)
13164                 return;
13165
13166         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
13167         if (!hdr) {
13168                 nlmsg_free(msg);
13169                 return;
13170         }
13171
13172         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13173             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13174             (from_ap && reason &&
13175              nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
13176             (from_ap &&
13177              nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
13178             (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
13179                 goto nla_put_failure;
13180
13181         genlmsg_end(msg, hdr);
13182
13183         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13184                                 NL80211_MCGRP_MLME, GFP_KERNEL);
13185         return;
13186
13187  nla_put_failure:
13188         genlmsg_cancel(msg, hdr);
13189         nlmsg_free(msg);
13190 }
13191
13192 void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
13193                              struct net_device *netdev, const u8 *bssid,
13194                              gfp_t gfp)
13195 {
13196         struct sk_buff *msg;
13197         void *hdr;
13198
13199         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13200         if (!msg)
13201                 return;
13202
13203         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
13204         if (!hdr) {
13205                 nlmsg_free(msg);
13206                 return;
13207         }
13208
13209         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13210             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13211             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
13212                 goto nla_put_failure;
13213
13214         genlmsg_end(msg, hdr);
13215
13216         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13217                                 NL80211_MCGRP_MLME, gfp);
13218         return;
13219
13220  nla_put_failure:
13221         genlmsg_cancel(msg, hdr);
13222         nlmsg_free(msg);
13223 }
13224
13225 void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
13226                                         const u8* ie, u8 ie_len, gfp_t gfp)
13227 {
13228         struct wireless_dev *wdev = dev->ieee80211_ptr;
13229         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
13230         struct sk_buff *msg;
13231         void *hdr;
13232
13233         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
13234                 return;
13235
13236         trace_cfg80211_notify_new_peer_candidate(dev, addr);
13237
13238         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13239         if (!msg)
13240                 return;
13241
13242         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
13243         if (!hdr) {
13244                 nlmsg_free(msg);
13245                 return;
13246         }
13247
13248         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13249             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13250             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
13251             (ie_len && ie &&
13252              nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
13253                 goto nla_put_failure;
13254
13255         genlmsg_end(msg, hdr);
13256
13257         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13258                                 NL80211_MCGRP_MLME, gfp);
13259         return;
13260
13261  nla_put_failure:
13262         genlmsg_cancel(msg, hdr);
13263         nlmsg_free(msg);
13264 }
13265 EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
13266
13267 void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
13268                                  struct net_device *netdev, const u8 *addr,
13269                                  enum nl80211_key_type key_type, int key_id,
13270                                  const u8 *tsc, gfp_t gfp)
13271 {
13272         struct sk_buff *msg;
13273         void *hdr;
13274
13275         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13276         if (!msg)
13277                 return;
13278
13279         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
13280         if (!hdr) {
13281                 nlmsg_free(msg);
13282                 return;
13283         }
13284
13285         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13286             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13287             (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
13288             nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
13289             (key_id != -1 &&
13290              nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
13291             (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
13292                 goto nla_put_failure;
13293
13294         genlmsg_end(msg, hdr);
13295
13296         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13297                                 NL80211_MCGRP_MLME, gfp);
13298         return;
13299
13300  nla_put_failure:
13301         genlmsg_cancel(msg, hdr);
13302         nlmsg_free(msg);
13303 }
13304
13305 void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
13306                                     struct ieee80211_channel *channel_before,
13307                                     struct ieee80211_channel *channel_after)
13308 {
13309         struct sk_buff *msg;
13310         void *hdr;
13311         struct nlattr *nl_freq;
13312
13313         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
13314         if (!msg)
13315                 return;
13316
13317         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
13318         if (!hdr) {
13319                 nlmsg_free(msg);
13320                 return;
13321         }
13322
13323         /*
13324          * Since we are applying the beacon hint to a wiphy we know its
13325          * wiphy_idx is valid
13326          */
13327         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
13328                 goto nla_put_failure;
13329
13330         /* Before */
13331         nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
13332         if (!nl_freq)
13333                 goto nla_put_failure;
13334         if (nl80211_msg_put_channel(msg, channel_before, false))
13335                 goto nla_put_failure;
13336         nla_nest_end(msg, nl_freq);
13337
13338         /* After */
13339         nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
13340         if (!nl_freq)
13341                 goto nla_put_failure;
13342         if (nl80211_msg_put_channel(msg, channel_after, false))
13343                 goto nla_put_failure;
13344         nla_nest_end(msg, nl_freq);
13345
13346         genlmsg_end(msg, hdr);
13347
13348         rcu_read_lock();
13349         genlmsg_multicast_allns(&nl80211_fam, msg, 0,
13350                                 NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
13351         rcu_read_unlock();
13352
13353         return;
13354
13355 nla_put_failure:
13356         genlmsg_cancel(msg, hdr);
13357         nlmsg_free(msg);
13358 }
13359
13360 static void nl80211_send_remain_on_chan_event(
13361         int cmd, struct cfg80211_registered_device *rdev,
13362         struct wireless_dev *wdev, u64 cookie,
13363         struct ieee80211_channel *chan,
13364         unsigned int duration, gfp_t gfp)
13365 {
13366         struct sk_buff *msg;
13367         void *hdr;
13368
13369         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13370         if (!msg)
13371                 return;
13372
13373         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13374         if (!hdr) {
13375                 nlmsg_free(msg);
13376                 return;
13377         }
13378
13379         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13380             (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13381                                          wdev->netdev->ifindex)) ||
13382             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13383                               NL80211_ATTR_PAD) ||
13384             nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
13385             nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
13386                         NL80211_CHAN_NO_HT) ||
13387             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
13388                               NL80211_ATTR_PAD))
13389                 goto nla_put_failure;
13390
13391         if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
13392             nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
13393                 goto nla_put_failure;
13394
13395         genlmsg_end(msg, hdr);
13396
13397         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13398                                 NL80211_MCGRP_MLME, gfp);
13399         return;
13400
13401  nla_put_failure:
13402         genlmsg_cancel(msg, hdr);
13403         nlmsg_free(msg);
13404 }
13405
13406 void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
13407                                struct ieee80211_channel *chan,
13408                                unsigned int duration, gfp_t gfp)
13409 {
13410         struct wiphy *wiphy = wdev->wiphy;
13411         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13412
13413         trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
13414         nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
13415                                           rdev, wdev, cookie, chan,
13416                                           duration, gfp);
13417 }
13418 EXPORT_SYMBOL(cfg80211_ready_on_channel);
13419
13420 void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
13421                                         struct ieee80211_channel *chan,
13422                                         gfp_t gfp)
13423 {
13424         struct wiphy *wiphy = wdev->wiphy;
13425         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13426
13427         trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
13428         nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
13429                                           rdev, wdev, cookie, chan, 0, gfp);
13430 }
13431 EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
13432
13433 void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
13434                       struct station_info *sinfo, gfp_t gfp)
13435 {
13436         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
13437         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13438         struct sk_buff *msg;
13439
13440         trace_cfg80211_new_sta(dev, mac_addr, sinfo);
13441
13442         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13443         if (!msg)
13444                 return;
13445
13446         if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
13447                                  rdev, dev, mac_addr, sinfo) < 0) {
13448                 nlmsg_free(msg);
13449                 return;
13450         }
13451
13452         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13453                                 NL80211_MCGRP_MLME, gfp);
13454 }
13455 EXPORT_SYMBOL(cfg80211_new_sta);
13456
13457 void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
13458                             struct station_info *sinfo, gfp_t gfp)
13459 {
13460         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
13461         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13462         struct sk_buff *msg;
13463         struct station_info empty_sinfo = {};
13464
13465         if (!sinfo)
13466                 sinfo = &empty_sinfo;
13467
13468         trace_cfg80211_del_sta(dev, mac_addr);
13469
13470         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13471         if (!msg)
13472                 return;
13473
13474         if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
13475                                  rdev, dev, mac_addr, sinfo) < 0) {
13476                 nlmsg_free(msg);
13477                 return;
13478         }
13479
13480         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13481                                 NL80211_MCGRP_MLME, gfp);
13482 }
13483 EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
13484
13485 void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
13486                           enum nl80211_connect_failed_reason reason,
13487                           gfp_t gfp)
13488 {
13489         struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
13490         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13491         struct sk_buff *msg;
13492         void *hdr;
13493
13494         msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
13495         if (!msg)
13496                 return;
13497
13498         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
13499         if (!hdr) {
13500                 nlmsg_free(msg);
13501                 return;
13502         }
13503
13504         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13505             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
13506             nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
13507                 goto nla_put_failure;
13508
13509         genlmsg_end(msg, hdr);
13510
13511         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13512                                 NL80211_MCGRP_MLME, gfp);
13513         return;
13514
13515  nla_put_failure:
13516         genlmsg_cancel(msg, hdr);
13517         nlmsg_free(msg);
13518 }
13519 EXPORT_SYMBOL(cfg80211_conn_failed);
13520
13521 static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
13522                                        const u8 *addr, gfp_t gfp)
13523 {
13524         struct wireless_dev *wdev = dev->ieee80211_ptr;
13525         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
13526         struct sk_buff *msg;
13527         void *hdr;
13528         u32 nlportid = ACCESS_ONCE(wdev->ap_unexpected_nlportid);
13529
13530         if (!nlportid)
13531                 return false;
13532
13533         msg = nlmsg_new(100, gfp);
13534         if (!msg)
13535                 return true;
13536
13537         hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
13538         if (!hdr) {
13539                 nlmsg_free(msg);
13540                 return true;
13541         }
13542
13543         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13544             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
13545             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
13546                 goto nla_put_failure;
13547
13548         genlmsg_end(msg, hdr);
13549         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
13550         return true;
13551
13552  nla_put_failure:
13553         genlmsg_cancel(msg, hdr);
13554         nlmsg_free(msg);
13555         return true;
13556 }
13557
13558 bool cfg80211_rx_spurious_frame(struct net_device *dev,
13559                                 const u8 *addr, gfp_t gfp)
13560 {
13561         struct wireless_dev *wdev = dev->ieee80211_ptr;
13562         bool ret;
13563
13564         trace_cfg80211_rx_spurious_frame(dev, addr);
13565
13566         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
13567                     wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
13568                 trace_cfg80211_return_bool(false);
13569                 return false;
13570         }
13571         ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
13572                                          addr, gfp);
13573         trace_cfg80211_return_bool(ret);
13574         return ret;
13575 }
13576 EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
13577
13578 bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
13579                                         const u8 *addr, gfp_t gfp)
13580 {
13581         struct wireless_dev *wdev = dev->ieee80211_ptr;
13582         bool ret;
13583
13584         trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
13585
13586         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
13587                     wdev->iftype != NL80211_IFTYPE_P2P_GO &&
13588                     wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
13589                 trace_cfg80211_return_bool(false);
13590                 return false;
13591         }
13592         ret = __nl80211_unexpected_frame(dev,
13593                                          NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
13594                                          addr, gfp);
13595         trace_cfg80211_return_bool(ret);
13596         return ret;
13597 }
13598 EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
13599
13600 int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
13601                       struct wireless_dev *wdev, u32 nlportid,
13602                       int freq, int sig_dbm,
13603                       const u8 *buf, size_t len, u32 flags, gfp_t gfp)
13604 {
13605         struct net_device *netdev = wdev->netdev;
13606         struct sk_buff *msg;
13607         void *hdr;
13608
13609         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13610         if (!msg)
13611                 return -ENOMEM;
13612
13613         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
13614         if (!hdr) {
13615                 nlmsg_free(msg);
13616                 return -ENOMEM;
13617         }
13618
13619         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13620             (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13621                                         netdev->ifindex)) ||
13622             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13623                               NL80211_ATTR_PAD) ||
13624             nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
13625             (sig_dbm &&
13626              nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
13627             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
13628             (flags &&
13629              nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
13630                 goto nla_put_failure;
13631
13632         genlmsg_end(msg, hdr);
13633
13634         return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
13635
13636  nla_put_failure:
13637         genlmsg_cancel(msg, hdr);
13638         nlmsg_free(msg);
13639         return -ENOBUFS;
13640 }
13641
13642 void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
13643                              const u8 *buf, size_t len, bool ack, gfp_t gfp)
13644 {
13645         struct wiphy *wiphy = wdev->wiphy;
13646         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13647         struct net_device *netdev = wdev->netdev;
13648         struct sk_buff *msg;
13649         void *hdr;
13650
13651         trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
13652
13653         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13654         if (!msg)
13655                 return;
13656
13657         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
13658         if (!hdr) {
13659                 nlmsg_free(msg);
13660                 return;
13661         }
13662
13663         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13664             (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
13665                                    netdev->ifindex)) ||
13666             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
13667                               NL80211_ATTR_PAD) ||
13668             nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
13669             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
13670                               NL80211_ATTR_PAD) ||
13671             (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
13672                 goto nla_put_failure;
13673
13674         genlmsg_end(msg, hdr);
13675
13676         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13677                                 NL80211_MCGRP_MLME, gfp);
13678         return;
13679
13680  nla_put_failure:
13681         genlmsg_cancel(msg, hdr);
13682         nlmsg_free(msg);
13683 }
13684 EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
13685
13686 static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
13687                                             const char *mac, gfp_t gfp)
13688 {
13689         struct wireless_dev *wdev = dev->ieee80211_ptr;
13690         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
13691         struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13692         void **cb;
13693
13694         if (!msg)
13695                 return NULL;
13696
13697         cb = (void **)msg->cb;
13698
13699         cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
13700         if (!cb[0]) {
13701                 nlmsg_free(msg);
13702                 return NULL;
13703         }
13704
13705         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13706             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
13707                 goto nla_put_failure;
13708
13709         if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
13710                 goto nla_put_failure;
13711
13712         cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
13713         if (!cb[1])
13714                 goto nla_put_failure;
13715
13716         cb[2] = rdev;
13717
13718         return msg;
13719  nla_put_failure:
13720         nlmsg_free(msg);
13721         return NULL;
13722 }
13723
13724 static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
13725 {
13726         void **cb = (void **)msg->cb;
13727         struct cfg80211_registered_device *rdev = cb[2];
13728
13729         nla_nest_end(msg, cb[1]);
13730         genlmsg_end(msg, cb[0]);
13731
13732         memset(msg->cb, 0, sizeof(msg->cb));
13733
13734         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13735                                 NL80211_MCGRP_MLME, gfp);
13736 }
13737
13738 void cfg80211_cqm_rssi_notify(struct net_device *dev,
13739                               enum nl80211_cqm_rssi_threshold_event rssi_event,
13740                               gfp_t gfp)
13741 {
13742         struct sk_buff *msg;
13743
13744         trace_cfg80211_cqm_rssi_notify(dev, rssi_event);
13745
13746         if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
13747                     rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
13748                 return;
13749
13750         msg = cfg80211_prepare_cqm(dev, NULL, gfp);
13751         if (!msg)
13752                 return;
13753
13754         if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
13755                         rssi_event))
13756                 goto nla_put_failure;
13757
13758         cfg80211_send_cqm(msg, gfp);
13759
13760         return;
13761
13762  nla_put_failure:
13763         nlmsg_free(msg);
13764 }
13765 EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
13766
13767 void cfg80211_cqm_txe_notify(struct net_device *dev,
13768                              const u8 *peer, u32 num_packets,
13769                              u32 rate, u32 intvl, gfp_t gfp)
13770 {
13771         struct sk_buff *msg;
13772
13773         msg = cfg80211_prepare_cqm(dev, peer, gfp);
13774         if (!msg)
13775                 return;
13776
13777         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
13778                 goto nla_put_failure;
13779
13780         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
13781                 goto nla_put_failure;
13782
13783         if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
13784                 goto nla_put_failure;
13785
13786         cfg80211_send_cqm(msg, gfp);
13787         return;
13788
13789  nla_put_failure:
13790         nlmsg_free(msg);
13791 }
13792 EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
13793
13794 void cfg80211_cqm_pktloss_notify(struct net_device *dev,
13795                                  const u8 *peer, u32 num_packets, gfp_t gfp)
13796 {
13797         struct sk_buff *msg;
13798
13799         trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
13800
13801         msg = cfg80211_prepare_cqm(dev, peer, gfp);
13802         if (!msg)
13803                 return;
13804
13805         if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
13806                 goto nla_put_failure;
13807
13808         cfg80211_send_cqm(msg, gfp);
13809         return;
13810
13811  nla_put_failure:
13812         nlmsg_free(msg);
13813 }
13814 EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
13815
13816 void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
13817 {
13818         struct sk_buff *msg;
13819
13820         msg = cfg80211_prepare_cqm(dev, NULL, gfp);
13821         if (!msg)
13822                 return;
13823
13824         if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
13825                 goto nla_put_failure;
13826
13827         cfg80211_send_cqm(msg, gfp);
13828         return;
13829
13830  nla_put_failure:
13831         nlmsg_free(msg);
13832 }
13833 EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
13834
13835 static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
13836                                      struct net_device *netdev, const u8 *bssid,
13837                                      const u8 *replay_ctr, gfp_t gfp)
13838 {
13839         struct sk_buff *msg;
13840         struct nlattr *rekey_attr;
13841         void *hdr;
13842
13843         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13844         if (!msg)
13845                 return;
13846
13847         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
13848         if (!hdr) {
13849                 nlmsg_free(msg);
13850                 return;
13851         }
13852
13853         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13854             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
13855             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
13856                 goto nla_put_failure;
13857
13858         rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
13859         if (!rekey_attr)
13860                 goto nla_put_failure;
13861
13862         if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
13863                     NL80211_REPLAY_CTR_LEN, replay_ctr))
13864                 goto nla_put_failure;
13865
13866         nla_nest_end(msg, rekey_attr);
13867
13868         genlmsg_end(msg, hdr);
13869
13870         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13871                                 NL80211_MCGRP_MLME, gfp);
13872         return;
13873
13874  nla_put_failure:
13875         genlmsg_cancel(msg, hdr);
13876         nlmsg_free(msg);
13877 }
13878
13879 void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
13880                                const u8 *replay_ctr, gfp_t gfp)
13881 {
13882         struct wireless_dev *wdev = dev->ieee80211_ptr;
13883         struct wiphy *wiphy = wdev->wiphy;
13884         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13885
13886         trace_cfg80211_gtk_rekey_notify(dev, bssid);
13887         nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
13888 }
13889 EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
13890
13891 static void
13892 nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
13893                                struct net_device *netdev, int index,
13894                                const u8 *bssid, bool preauth, gfp_t gfp)
13895 {
13896         struct sk_buff *msg;
13897         struct nlattr *attr;
13898         void *hdr;
13899
13900         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13901         if (!msg)
13902                 return;
13903
13904         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
13905         if (!hdr) {
13906                 nlmsg_free(msg);
13907                 return;
13908         }
13909
13910         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
13911             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
13912                 goto nla_put_failure;
13913
13914         attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
13915         if (!attr)
13916                 goto nla_put_failure;
13917
13918         if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
13919             nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
13920             (preauth &&
13921              nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
13922                 goto nla_put_failure;
13923
13924         nla_nest_end(msg, attr);
13925
13926         genlmsg_end(msg, hdr);
13927
13928         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13929                                 NL80211_MCGRP_MLME, gfp);
13930         return;
13931
13932  nla_put_failure:
13933         genlmsg_cancel(msg, hdr);
13934         nlmsg_free(msg);
13935 }
13936
13937 void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
13938                                      const u8 *bssid, bool preauth, gfp_t gfp)
13939 {
13940         struct wireless_dev *wdev = dev->ieee80211_ptr;
13941         struct wiphy *wiphy = wdev->wiphy;
13942         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13943
13944         trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
13945         nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
13946 }
13947 EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
13948
13949 static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
13950                                      struct net_device *netdev,
13951                                      struct cfg80211_chan_def *chandef,
13952                                      gfp_t gfp,
13953                                      enum nl80211_commands notif,
13954                                      u8 count)
13955 {
13956         struct sk_buff *msg;
13957         void *hdr;
13958
13959         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
13960         if (!msg)
13961                 return;
13962
13963         hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
13964         if (!hdr) {
13965                 nlmsg_free(msg);
13966                 return;
13967         }
13968
13969         if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
13970                 goto nla_put_failure;
13971
13972         if (nl80211_send_chandef(msg, chandef))
13973                 goto nla_put_failure;
13974
13975         if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
13976             (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
13977                         goto nla_put_failure;
13978
13979         genlmsg_end(msg, hdr);
13980
13981         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
13982                                 NL80211_MCGRP_MLME, gfp);
13983         return;
13984
13985  nla_put_failure:
13986         genlmsg_cancel(msg, hdr);
13987         nlmsg_free(msg);
13988 }
13989
13990 void cfg80211_ch_switch_notify(struct net_device *dev,
13991                                struct cfg80211_chan_def *chandef)
13992 {
13993         struct wireless_dev *wdev = dev->ieee80211_ptr;
13994         struct wiphy *wiphy = wdev->wiphy;
13995         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
13996
13997         ASSERT_WDEV_LOCK(wdev);
13998
13999         trace_cfg80211_ch_switch_notify(dev, chandef);
14000
14001         wdev->chandef = *chandef;
14002         wdev->preset_chandef = *chandef;
14003         nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14004                                  NL80211_CMD_CH_SWITCH_NOTIFY, 0);
14005 }
14006 EXPORT_SYMBOL(cfg80211_ch_switch_notify);
14007
14008 void cfg80211_ch_switch_started_notify(struct net_device *dev,
14009                                        struct cfg80211_chan_def *chandef,
14010                                        u8 count)
14011 {
14012         struct wireless_dev *wdev = dev->ieee80211_ptr;
14013         struct wiphy *wiphy = wdev->wiphy;
14014         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14015
14016         trace_cfg80211_ch_switch_started_notify(dev, chandef);
14017
14018         nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
14019                                  NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
14020 }
14021 EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
14022
14023 void
14024 nl80211_radar_notify(struct cfg80211_registered_device *rdev,
14025                      const struct cfg80211_chan_def *chandef,
14026                      enum nl80211_radar_event event,
14027                      struct net_device *netdev, gfp_t gfp)
14028 {
14029         struct sk_buff *msg;
14030         void *hdr;
14031
14032         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14033         if (!msg)
14034                 return;
14035
14036         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
14037         if (!hdr) {
14038                 nlmsg_free(msg);
14039                 return;
14040         }
14041
14042         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
14043                 goto nla_put_failure;
14044
14045         /* NOP and radar events don't need a netdev parameter */
14046         if (netdev) {
14047                 struct wireless_dev *wdev = netdev->ieee80211_ptr;
14048
14049                 if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14050                     nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14051                                       NL80211_ATTR_PAD))
14052                         goto nla_put_failure;
14053         }
14054
14055         if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
14056                 goto nla_put_failure;
14057
14058         if (nl80211_send_chandef(msg, chandef))
14059                 goto nla_put_failure;
14060
14061         genlmsg_end(msg, hdr);
14062
14063         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14064                                 NL80211_MCGRP_MLME, gfp);
14065         return;
14066
14067  nla_put_failure:
14068         genlmsg_cancel(msg, hdr);
14069         nlmsg_free(msg);
14070 }
14071
14072 void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
14073                            u64 cookie, bool acked, gfp_t gfp)
14074 {
14075         struct wireless_dev *wdev = dev->ieee80211_ptr;
14076         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14077         struct sk_buff *msg;
14078         void *hdr;
14079
14080         trace_cfg80211_probe_status(dev, addr, cookie, acked);
14081
14082         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14083
14084         if (!msg)
14085                 return;
14086
14087         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
14088         if (!hdr) {
14089                 nlmsg_free(msg);
14090                 return;
14091         }
14092
14093         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14094             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14095             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
14096             nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
14097                               NL80211_ATTR_PAD) ||
14098             (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
14099                 goto nla_put_failure;
14100
14101         genlmsg_end(msg, hdr);
14102
14103         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14104                                 NL80211_MCGRP_MLME, gfp);
14105         return;
14106
14107  nla_put_failure:
14108         genlmsg_cancel(msg, hdr);
14109         nlmsg_free(msg);
14110 }
14111 EXPORT_SYMBOL(cfg80211_probe_status);
14112
14113 void cfg80211_report_obss_beacon(struct wiphy *wiphy,
14114                                  const u8 *frame, size_t len,
14115                                  int freq, int sig_dbm)
14116 {
14117         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14118         struct sk_buff *msg;
14119         void *hdr;
14120         struct cfg80211_beacon_registration *reg;
14121
14122         trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
14123
14124         spin_lock_bh(&rdev->beacon_registrations_lock);
14125         list_for_each_entry(reg, &rdev->beacon_registrations, list) {
14126                 msg = nlmsg_new(len + 100, GFP_ATOMIC);
14127                 if (!msg) {
14128                         spin_unlock_bh(&rdev->beacon_registrations_lock);
14129                         return;
14130                 }
14131
14132                 hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
14133                 if (!hdr)
14134                         goto nla_put_failure;
14135
14136                 if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14137                     (freq &&
14138                      nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
14139                     (sig_dbm &&
14140                      nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
14141                     nla_put(msg, NL80211_ATTR_FRAME, len, frame))
14142                         goto nla_put_failure;
14143
14144                 genlmsg_end(msg, hdr);
14145
14146                 genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
14147         }
14148         spin_unlock_bh(&rdev->beacon_registrations_lock);
14149         return;
14150
14151  nla_put_failure:
14152         spin_unlock_bh(&rdev->beacon_registrations_lock);
14153         if (hdr)
14154                 genlmsg_cancel(msg, hdr);
14155         nlmsg_free(msg);
14156 }
14157 EXPORT_SYMBOL(cfg80211_report_obss_beacon);
14158
14159 #ifdef CONFIG_PM
14160 static int cfg80211_net_detect_results(struct sk_buff *msg,
14161                                        struct cfg80211_wowlan_wakeup *wakeup)
14162 {
14163         struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
14164         struct nlattr *nl_results, *nl_match, *nl_freqs;
14165         int i, j;
14166
14167         nl_results = nla_nest_start(
14168                 msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
14169         if (!nl_results)
14170                 return -EMSGSIZE;
14171
14172         for (i = 0; i < nd->n_matches; i++) {
14173                 struct cfg80211_wowlan_nd_match *match = nd->matches[i];
14174
14175                 nl_match = nla_nest_start(msg, i);
14176                 if (!nl_match)
14177                         break;
14178
14179                 /* The SSID attribute is optional in nl80211, but for
14180                  * simplicity reasons it's always present in the
14181                  * cfg80211 structure.  If a driver can't pass the
14182                  * SSID, that needs to be changed.  A zero length SSID
14183                  * is still a valid SSID (wildcard), so it cannot be
14184                  * used for this purpose.
14185                  */
14186                 if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
14187                             match->ssid.ssid)) {
14188                         nla_nest_cancel(msg, nl_match);
14189                         goto out;
14190                 }
14191
14192                 if (match->n_channels) {
14193                         nl_freqs = nla_nest_start(
14194                                 msg, NL80211_ATTR_SCAN_FREQUENCIES);
14195                         if (!nl_freqs) {
14196                                 nla_nest_cancel(msg, nl_match);
14197                                 goto out;
14198                         }
14199
14200                         for (j = 0; j < match->n_channels; j++) {
14201                                 if (nla_put_u32(msg, j, match->channels[j])) {
14202                                         nla_nest_cancel(msg, nl_freqs);
14203                                         nla_nest_cancel(msg, nl_match);
14204                                         goto out;
14205                                 }
14206                         }
14207
14208                         nla_nest_end(msg, nl_freqs);
14209                 }
14210
14211                 nla_nest_end(msg, nl_match);
14212         }
14213
14214 out:
14215         nla_nest_end(msg, nl_results);
14216         return 0;
14217 }
14218
14219 void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
14220                                    struct cfg80211_wowlan_wakeup *wakeup,
14221                                    gfp_t gfp)
14222 {
14223         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14224         struct sk_buff *msg;
14225         void *hdr;
14226         int size = 200;
14227
14228         trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
14229
14230         if (wakeup)
14231                 size += wakeup->packet_present_len;
14232
14233         msg = nlmsg_new(size, gfp);
14234         if (!msg)
14235                 return;
14236
14237         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
14238         if (!hdr)
14239                 goto free_msg;
14240
14241         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14242             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14243                               NL80211_ATTR_PAD))
14244                 goto free_msg;
14245
14246         if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
14247                                         wdev->netdev->ifindex))
14248                 goto free_msg;
14249
14250         if (wakeup) {
14251                 struct nlattr *reasons;
14252
14253                 reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
14254                 if (!reasons)
14255                         goto free_msg;
14256
14257                 if (wakeup->disconnect &&
14258                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
14259                         goto free_msg;
14260                 if (wakeup->magic_pkt &&
14261                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
14262                         goto free_msg;
14263                 if (wakeup->gtk_rekey_failure &&
14264                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
14265                         goto free_msg;
14266                 if (wakeup->eap_identity_req &&
14267                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
14268                         goto free_msg;
14269                 if (wakeup->four_way_handshake &&
14270                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
14271                         goto free_msg;
14272                 if (wakeup->rfkill_release &&
14273                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
14274                         goto free_msg;
14275
14276                 if (wakeup->pattern_idx >= 0 &&
14277                     nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
14278                                 wakeup->pattern_idx))
14279                         goto free_msg;
14280
14281                 if (wakeup->tcp_match &&
14282                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
14283                         goto free_msg;
14284
14285                 if (wakeup->tcp_connlost &&
14286                     nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
14287                         goto free_msg;
14288
14289                 if (wakeup->tcp_nomoretokens &&
14290                     nla_put_flag(msg,
14291                                  NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
14292                         goto free_msg;
14293
14294                 if (wakeup->packet) {
14295                         u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
14296                         u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
14297
14298                         if (!wakeup->packet_80211) {
14299                                 pkt_attr =
14300                                         NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
14301                                 len_attr =
14302                                         NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
14303                         }
14304
14305                         if (wakeup->packet_len &&
14306                             nla_put_u32(msg, len_attr, wakeup->packet_len))
14307                                 goto free_msg;
14308
14309                         if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
14310                                     wakeup->packet))
14311                                 goto free_msg;
14312                 }
14313
14314                 if (wakeup->net_detect &&
14315                     cfg80211_net_detect_results(msg, wakeup))
14316                                 goto free_msg;
14317
14318                 nla_nest_end(msg, reasons);
14319         }
14320
14321         genlmsg_end(msg, hdr);
14322
14323         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14324                                 NL80211_MCGRP_MLME, gfp);
14325         return;
14326
14327  free_msg:
14328         nlmsg_free(msg);
14329 }
14330 EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
14331 #endif
14332
14333 void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
14334                                 enum nl80211_tdls_operation oper,
14335                                 u16 reason_code, gfp_t gfp)
14336 {
14337         struct wireless_dev *wdev = dev->ieee80211_ptr;
14338         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
14339         struct sk_buff *msg;
14340         void *hdr;
14341
14342         trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
14343                                          reason_code);
14344
14345         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14346         if (!msg)
14347                 return;
14348
14349         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
14350         if (!hdr) {
14351                 nlmsg_free(msg);
14352                 return;
14353         }
14354
14355         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14356             nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
14357             nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
14358             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
14359             (reason_code > 0 &&
14360              nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
14361                 goto nla_put_failure;
14362
14363         genlmsg_end(msg, hdr);
14364
14365         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14366                                 NL80211_MCGRP_MLME, gfp);
14367         return;
14368
14369  nla_put_failure:
14370         genlmsg_cancel(msg, hdr);
14371         nlmsg_free(msg);
14372 }
14373 EXPORT_SYMBOL(cfg80211_tdls_oper_request);
14374
14375 static int nl80211_netlink_notify(struct notifier_block * nb,
14376                                   unsigned long state,
14377                                   void *_notify)
14378 {
14379         struct netlink_notify *notify = _notify;
14380         struct cfg80211_registered_device *rdev;
14381         struct wireless_dev *wdev;
14382         struct cfg80211_beacon_registration *reg, *tmp;
14383
14384         if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
14385                 return NOTIFY_DONE;
14386
14387         rcu_read_lock();
14388
14389         list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
14390                 bool schedule_destroy_work = false;
14391                 bool schedule_scan_stop = false;
14392                 struct cfg80211_sched_scan_request *sched_scan_req =
14393                         rcu_dereference(rdev->sched_scan_req);
14394
14395                 if (sched_scan_req && notify->portid &&
14396                     sched_scan_req->owner_nlportid == notify->portid)
14397                         schedule_scan_stop = true;
14398
14399                 list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
14400                         cfg80211_mlme_unregister_socket(wdev, notify->portid);
14401
14402                         if (wdev->owner_nlportid == notify->portid)
14403                                 schedule_destroy_work = true;
14404                 }
14405
14406                 spin_lock_bh(&rdev->beacon_registrations_lock);
14407                 list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
14408                                          list) {
14409                         if (reg->nlportid == notify->portid) {
14410                                 list_del(&reg->list);
14411                                 kfree(reg);
14412                                 break;
14413                         }
14414                 }
14415                 spin_unlock_bh(&rdev->beacon_registrations_lock);
14416
14417                 if (schedule_destroy_work) {
14418                         struct cfg80211_iface_destroy *destroy;
14419
14420                         destroy = kzalloc(sizeof(*destroy), GFP_ATOMIC);
14421                         if (destroy) {
14422                                 destroy->nlportid = notify->portid;
14423                                 spin_lock(&rdev->destroy_list_lock);
14424                                 list_add(&destroy->list, &rdev->destroy_list);
14425                                 spin_unlock(&rdev->destroy_list_lock);
14426                                 schedule_work(&rdev->destroy_work);
14427                         }
14428                 } else if (schedule_scan_stop) {
14429                         sched_scan_req->owner_nlportid = 0;
14430
14431                         if (rdev->ops->sched_scan_stop &&
14432                             rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
14433                                 schedule_work(&rdev->sched_scan_stop_wk);
14434                 }
14435         }
14436
14437         rcu_read_unlock();
14438
14439         /*
14440          * It is possible that the user space process that is controlling the
14441          * indoor setting disappeared, so notify the regulatory core.
14442          */
14443         regulatory_netlink_notify(notify->portid);
14444         return NOTIFY_OK;
14445 }
14446
14447 static struct notifier_block nl80211_netlink_notifier = {
14448         .notifier_call = nl80211_netlink_notify,
14449 };
14450
14451 void cfg80211_ft_event(struct net_device *netdev,
14452                        struct cfg80211_ft_event_params *ft_event)
14453 {
14454         struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
14455         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14456         struct sk_buff *msg;
14457         void *hdr;
14458
14459         trace_cfg80211_ft_event(wiphy, netdev, ft_event);
14460
14461         if (!ft_event->target_ap)
14462                 return;
14463
14464         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14465         if (!msg)
14466                 return;
14467
14468         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
14469         if (!hdr)
14470                 goto out;
14471
14472         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14473             nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
14474             nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
14475                 goto out;
14476
14477         if (ft_event->ies &&
14478             nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
14479                 goto out;
14480         if (ft_event->ric_ies &&
14481             nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
14482                     ft_event->ric_ies))
14483                 goto out;
14484
14485         genlmsg_end(msg, hdr);
14486
14487         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
14488                                 NL80211_MCGRP_MLME, GFP_KERNEL);
14489         return;
14490  out:
14491         nlmsg_free(msg);
14492 }
14493 EXPORT_SYMBOL(cfg80211_ft_event);
14494
14495 void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
14496 {
14497         struct cfg80211_registered_device *rdev;
14498         struct sk_buff *msg;
14499         void *hdr;
14500         u32 nlportid;
14501
14502         rdev = wiphy_to_rdev(wdev->wiphy);
14503         if (!rdev->crit_proto_nlportid)
14504                 return;
14505
14506         nlportid = rdev->crit_proto_nlportid;
14507         rdev->crit_proto_nlportid = 0;
14508
14509         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
14510         if (!msg)
14511                 return;
14512
14513         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
14514         if (!hdr)
14515                 goto nla_put_failure;
14516
14517         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14518             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14519                               NL80211_ATTR_PAD))
14520                 goto nla_put_failure;
14521
14522         genlmsg_end(msg, hdr);
14523
14524         genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
14525         return;
14526
14527  nla_put_failure:
14528         if (hdr)
14529                 genlmsg_cancel(msg, hdr);
14530         nlmsg_free(msg);
14531 }
14532 EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
14533
14534 void nl80211_send_ap_stopped(struct wireless_dev *wdev)
14535 {
14536         struct wiphy *wiphy = wdev->wiphy;
14537         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
14538         struct sk_buff *msg;
14539         void *hdr;
14540
14541         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
14542         if (!msg)
14543                 return;
14544
14545         hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
14546         if (!hdr)
14547                 goto out;
14548
14549         if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
14550             nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
14551             nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
14552                               NL80211_ATTR_PAD))
14553                 goto out;
14554
14555         genlmsg_end(msg, hdr);
14556
14557         genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
14558                                 NL80211_MCGRP_MLME, GFP_KERNEL);
14559         return;
14560  out:
14561         nlmsg_free(msg);
14562 }
14563
14564 /* initialisation/exit functions */
14565
14566 int nl80211_init(void)
14567 {
14568         int err;
14569
14570         err = genl_register_family_with_ops_groups(&nl80211_fam, nl80211_ops,
14571                                                    nl80211_mcgrps);
14572         if (err)
14573                 return err;
14574
14575         err = netlink_register_notifier(&nl80211_netlink_notifier);
14576         if (err)
14577                 goto err_out;
14578
14579         return 0;
14580  err_out:
14581         genl_unregister_family(&nl80211_fam);
14582         return err;
14583 }
14584
14585 void nl80211_exit(void)
14586 {
14587         netlink_unregister_notifier(&nl80211_netlink_notifier);
14588         genl_unregister_family(&nl80211_fam);
14589 }