12be7d22fSVladimir Kondratiev /* 2849a564bSDedy Lansky * Copyright (c) 2012-2017 Qualcomm Atheros, Inc. 3bf0353a6SAhmad Masri * Copyright (c) 2018-2019, The Linux Foundation. All rights reserved. 42be7d22fSVladimir Kondratiev * 52be7d22fSVladimir Kondratiev * Permission to use, copy, modify, and/or distribute this software for any 62be7d22fSVladimir Kondratiev * purpose with or without fee is hereby granted, provided that the above 72be7d22fSVladimir Kondratiev * copyright notice and this permission notice appear in all copies. 82be7d22fSVladimir Kondratiev * 92be7d22fSVladimir Kondratiev * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 102be7d22fSVladimir Kondratiev * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 112be7d22fSVladimir Kondratiev * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 122be7d22fSVladimir Kondratiev * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 132be7d22fSVladimir Kondratiev * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 142be7d22fSVladimir Kondratiev * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 152be7d22fSVladimir Kondratiev * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 162be7d22fSVladimir Kondratiev */ 172be7d22fSVladimir Kondratiev 18a82553bbSVladimir Kondratiev #include <linux/etherdevice.h> 19949c2d00SJohannes Berg #include <linux/moduleparam.h> 200216a895SLior David #include <net/netlink.h> 214aebd3bdSLior David #include <net/cfg80211.h> 222be7d22fSVladimir Kondratiev #include "wil6210.h" 232be7d22fSVladimir Kondratiev #include "wmi.h" 247bfe9e22SLior David #include "fw.h" 252be7d22fSVladimir Kondratiev 26e6d68341SDedy Lansky #define WIL_MAX_ROC_DURATION_MS 5000 27e6d68341SDedy Lansky 28849a564bSDedy Lansky bool disable_ap_sme; 2978484c44SMaya Erez module_param(disable_ap_sme, bool, 0444); 30849a564bSDedy Lansky MODULE_PARM_DESC(disable_ap_sme, " let user space handle AP mode SME"); 31849a564bSDedy Lansky 32d1fbf075SMaya Erez #ifdef CONFIG_PM 33d1fbf075SMaya Erez static struct wiphy_wowlan_support wil_wowlan_support = { 34d1fbf075SMaya Erez .flags = WIPHY_WOWLAN_ANY | WIPHY_WOWLAN_DISCONNECT, 35d1fbf075SMaya Erez }; 36d1fbf075SMaya Erez #endif 37d1fbf075SMaya Erez 382be7d22fSVladimir Kondratiev #define CHAN60G(_channel, _flags) { \ 3957fbcce3SJohannes Berg .band = NL80211_BAND_60GHZ, \ 402be7d22fSVladimir Kondratiev .center_freq = 56160 + (2160 * (_channel)), \ 412be7d22fSVladimir Kondratiev .hw_value = (_channel), \ 422be7d22fSVladimir Kondratiev .flags = (_flags), \ 432be7d22fSVladimir Kondratiev .max_antenna_gain = 0, \ 442be7d22fSVladimir Kondratiev .max_power = 40, \ 452be7d22fSVladimir Kondratiev } 462be7d22fSVladimir Kondratiev 472be7d22fSVladimir Kondratiev static struct ieee80211_channel wil_60ghz_channels[] = { 482be7d22fSVladimir Kondratiev CHAN60G(1, 0), 492be7d22fSVladimir Kondratiev CHAN60G(2, 0), 502be7d22fSVladimir Kondratiev CHAN60G(3, 0), 5122b9610eSAlexei Avshalom Lazar CHAN60G(4, 0), 522be7d22fSVladimir Kondratiev }; 532be7d22fSVladimir Kondratiev 54e41ab937SDedy Lansky static void 55e41ab937SDedy Lansky wil_memdup_ie(u8 **pdst, size_t *pdst_len, const u8 *src, size_t src_len) 56e41ab937SDedy Lansky { 57e41ab937SDedy Lansky kfree(*pdst); 58e41ab937SDedy Lansky *pdst = NULL; 59e41ab937SDedy Lansky *pdst_len = 0; 60e41ab937SDedy Lansky if (src_len > 0) { 61e41ab937SDedy Lansky *pdst = kmemdup(src, src_len, GFP_KERNEL); 62e41ab937SDedy Lansky if (*pdst) 63e41ab937SDedy Lansky *pdst_len = src_len; 64e41ab937SDedy Lansky } 65e41ab937SDedy Lansky } 66e41ab937SDedy Lansky 6722b9610eSAlexei Avshalom Lazar static int wil_num_supported_channels(struct wil6210_priv *wil) 6822b9610eSAlexei Avshalom Lazar { 6922b9610eSAlexei Avshalom Lazar int num_channels = ARRAY_SIZE(wil_60ghz_channels); 7022b9610eSAlexei Avshalom Lazar 7122b9610eSAlexei Avshalom Lazar if (!test_bit(WMI_FW_CAPABILITY_CHANNEL_4, wil->fw_capabilities)) 7222b9610eSAlexei Avshalom Lazar num_channels--; 7322b9610eSAlexei Avshalom Lazar 7422b9610eSAlexei Avshalom Lazar return num_channels; 7522b9610eSAlexei Avshalom Lazar } 7622b9610eSAlexei Avshalom Lazar 7722b9610eSAlexei Avshalom Lazar void update_supported_bands(struct wil6210_priv *wil) 7822b9610eSAlexei Avshalom Lazar { 7922b9610eSAlexei Avshalom Lazar struct wiphy *wiphy = wil_to_wiphy(wil); 8022b9610eSAlexei Avshalom Lazar 8122b9610eSAlexei Avshalom Lazar wil_dbg_misc(wil, "update supported bands"); 8222b9610eSAlexei Avshalom Lazar 8322b9610eSAlexei Avshalom Lazar wiphy->bands[NL80211_BAND_60GHZ]->n_channels = 8422b9610eSAlexei Avshalom Lazar wil_num_supported_channels(wil); 8522b9610eSAlexei Avshalom Lazar } 8622b9610eSAlexei Avshalom Lazar 870216a895SLior David /* Vendor id to be used in vendor specific command and events 880216a895SLior David * to user space. 890216a895SLior David * NOTE: The authoritative place for definition of QCA_NL80211_VENDOR_ID, 900216a895SLior David * vendor subcmd definitions prefixed with QCA_NL80211_VENDOR_SUBCMD, and 910216a895SLior David * qca_wlan_vendor_attr is open source file src/common/qca-vendor.h in 920216a895SLior David * git://w1.fi/srv/git/hostap.git; the values here are just a copy of that 930216a895SLior David */ 940216a895SLior David 950216a895SLior David #define QCA_NL80211_VENDOR_ID 0x001374 960216a895SLior David 970216a895SLior David #define WIL_MAX_RF_SECTORS (128) 980216a895SLior David #define WIL_CID_ALL (0xff) 990216a895SLior David 1000216a895SLior David enum qca_wlan_vendor_attr_rf_sector { 1010216a895SLior David QCA_ATTR_MAC_ADDR = 6, 1020216a895SLior David QCA_ATTR_PAD = 13, 1030216a895SLior David QCA_ATTR_TSF = 29, 1040216a895SLior David QCA_ATTR_DMG_RF_SECTOR_INDEX = 30, 1050216a895SLior David QCA_ATTR_DMG_RF_SECTOR_TYPE = 31, 1060216a895SLior David QCA_ATTR_DMG_RF_MODULE_MASK = 32, 1070216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG = 33, 1080216a895SLior David QCA_ATTR_DMG_RF_SECTOR_MAX, 1090216a895SLior David }; 1100216a895SLior David 1110216a895SLior David enum qca_wlan_vendor_attr_dmg_rf_sector_type { 1120216a895SLior David QCA_ATTR_DMG_RF_SECTOR_TYPE_RX, 1130216a895SLior David QCA_ATTR_DMG_RF_SECTOR_TYPE_TX, 1140216a895SLior David QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX 1150216a895SLior David }; 1160216a895SLior David 1170216a895SLior David enum qca_wlan_vendor_attr_dmg_rf_sector_cfg { 1180216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_INVALID = 0, 1190216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX, 1200216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0, 1210216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1, 1220216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2, 1230216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI, 1240216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO, 1250216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16, 1260216a895SLior David 1270216a895SLior David /* keep last */ 1280216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_AFTER_LAST, 1290216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_MAX = 1300216a895SLior David QCA_ATTR_DMG_RF_SECTOR_CFG_AFTER_LAST - 1 1310216a895SLior David }; 1320216a895SLior David 1330216a895SLior David static const struct 1340216a895SLior David nla_policy wil_rf_sector_policy[QCA_ATTR_DMG_RF_SECTOR_MAX + 1] = { 1350216a895SLior David [QCA_ATTR_MAC_ADDR] = { .len = ETH_ALEN }, 1360216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_INDEX] = { .type = NLA_U16 }, 1370216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_TYPE] = { .type = NLA_U8 }, 1380216a895SLior David [QCA_ATTR_DMG_RF_MODULE_MASK] = { .type = NLA_U32 }, 1390216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG] = { .type = NLA_NESTED }, 1400216a895SLior David }; 1410216a895SLior David 1420216a895SLior David static const struct 1430216a895SLior David nla_policy wil_rf_sector_cfg_policy[QCA_ATTR_DMG_RF_SECTOR_CFG_MAX + 1] = { 1440216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX] = { .type = NLA_U8 }, 1450216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0] = { .type = NLA_U32 }, 1460216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1] = { .type = NLA_U32 }, 1470216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2] = { .type = NLA_U32 }, 1480216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI] = { .type = NLA_U32 }, 1490216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO] = { .type = NLA_U32 }, 1500216a895SLior David [QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16] = { .type = NLA_U32 }, 1510216a895SLior David }; 1520216a895SLior David 1530216a895SLior David enum qca_nl80211_vendor_subcmds { 1540216a895SLior David QCA_NL80211_VENDOR_SUBCMD_DMG_RF_GET_SECTOR_CFG = 139, 1550216a895SLior David QCA_NL80211_VENDOR_SUBCMD_DMG_RF_SET_SECTOR_CFG = 140, 1560216a895SLior David QCA_NL80211_VENDOR_SUBCMD_DMG_RF_GET_SELECTED_SECTOR = 141, 1570216a895SLior David QCA_NL80211_VENDOR_SUBCMD_DMG_RF_SET_SELECTED_SECTOR = 142, 1580216a895SLior David }; 1590216a895SLior David 1600216a895SLior David static int wil_rf_sector_get_cfg(struct wiphy *wiphy, 1610216a895SLior David struct wireless_dev *wdev, 1620216a895SLior David const void *data, int data_len); 1630216a895SLior David static int wil_rf_sector_set_cfg(struct wiphy *wiphy, 1640216a895SLior David struct wireless_dev *wdev, 1650216a895SLior David const void *data, int data_len); 1660216a895SLior David static int wil_rf_sector_get_selected(struct wiphy *wiphy, 1670216a895SLior David struct wireless_dev *wdev, 1680216a895SLior David const void *data, int data_len); 1690216a895SLior David static int wil_rf_sector_set_selected(struct wiphy *wiphy, 1700216a895SLior David struct wireless_dev *wdev, 1710216a895SLior David const void *data, int data_len); 1720216a895SLior David 1730216a895SLior David /* vendor specific commands */ 1740216a895SLior David static const struct wiphy_vendor_command wil_nl80211_vendor_commands[] = { 1750216a895SLior David { 1760216a895SLior David .info.vendor_id = QCA_NL80211_VENDOR_ID, 1770216a895SLior David .info.subcmd = QCA_NL80211_VENDOR_SUBCMD_DMG_RF_GET_SECTOR_CFG, 1780216a895SLior David .flags = WIPHY_VENDOR_CMD_NEED_WDEV | 1790216a895SLior David WIPHY_VENDOR_CMD_NEED_RUNNING, 1800216a895SLior David .doit = wil_rf_sector_get_cfg 1810216a895SLior David }, 1820216a895SLior David { 1830216a895SLior David .info.vendor_id = QCA_NL80211_VENDOR_ID, 1840216a895SLior David .info.subcmd = QCA_NL80211_VENDOR_SUBCMD_DMG_RF_SET_SECTOR_CFG, 1850216a895SLior David .flags = WIPHY_VENDOR_CMD_NEED_WDEV | 1860216a895SLior David WIPHY_VENDOR_CMD_NEED_RUNNING, 1870216a895SLior David .doit = wil_rf_sector_set_cfg 1880216a895SLior David }, 1890216a895SLior David { 1900216a895SLior David .info.vendor_id = QCA_NL80211_VENDOR_ID, 1910216a895SLior David .info.subcmd = 1920216a895SLior David QCA_NL80211_VENDOR_SUBCMD_DMG_RF_GET_SELECTED_SECTOR, 1930216a895SLior David .flags = WIPHY_VENDOR_CMD_NEED_WDEV | 1940216a895SLior David WIPHY_VENDOR_CMD_NEED_RUNNING, 1950216a895SLior David .doit = wil_rf_sector_get_selected 1960216a895SLior David }, 1970216a895SLior David { 1980216a895SLior David .info.vendor_id = QCA_NL80211_VENDOR_ID, 1990216a895SLior David .info.subcmd = 2000216a895SLior David QCA_NL80211_VENDOR_SUBCMD_DMG_RF_SET_SELECTED_SECTOR, 2010216a895SLior David .flags = WIPHY_VENDOR_CMD_NEED_WDEV | 2020216a895SLior David WIPHY_VENDOR_CMD_NEED_RUNNING, 2030216a895SLior David .doit = wil_rf_sector_set_selected 2040216a895SLior David }, 2050216a895SLior David }; 2060216a895SLior David 2072be7d22fSVladimir Kondratiev static struct ieee80211_supported_band wil_band_60ghz = { 2082be7d22fSVladimir Kondratiev .channels = wil_60ghz_channels, 2092be7d22fSVladimir Kondratiev .n_channels = ARRAY_SIZE(wil_60ghz_channels), 2102be7d22fSVladimir Kondratiev .ht_cap = { 2112be7d22fSVladimir Kondratiev .ht_supported = true, 2122be7d22fSVladimir Kondratiev .cap = 0, /* TODO */ 2132be7d22fSVladimir Kondratiev .ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K, /* TODO */ 2142be7d22fSVladimir Kondratiev .ampdu_density = IEEE80211_HT_MPDU_DENSITY_8, /* TODO */ 2152be7d22fSVladimir Kondratiev .mcs = { 2162be7d22fSVladimir Kondratiev /* MCS 1..12 - SC PHY */ 2172be7d22fSVladimir Kondratiev .rx_mask = {0xfe, 0x1f}, /* 1..12 */ 2182be7d22fSVladimir Kondratiev .tx_params = IEEE80211_HT_MCS_TX_DEFINED, /* TODO */ 2192be7d22fSVladimir Kondratiev }, 2202be7d22fSVladimir Kondratiev }, 2212be7d22fSVladimir Kondratiev }; 2222be7d22fSVladimir Kondratiev 2232be7d22fSVladimir Kondratiev static const struct ieee80211_txrx_stypes 2242be7d22fSVladimir Kondratiev wil_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2252be7d22fSVladimir Kondratiev [NL80211_IFTYPE_STATION] = { 2262be7d22fSVladimir Kondratiev .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2272be7d22fSVladimir Kondratiev BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2282be7d22fSVladimir Kondratiev .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2292be7d22fSVladimir Kondratiev BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2302be7d22fSVladimir Kondratiev }, 2312be7d22fSVladimir Kondratiev [NL80211_IFTYPE_AP] = { 2322be7d22fSVladimir Kondratiev .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 233849a564bSDedy Lansky BIT(IEEE80211_STYPE_PROBE_RESP >> 4) | 234849a564bSDedy Lansky BIT(IEEE80211_STYPE_ASSOC_RESP >> 4) | 235b9010f10SAhmad Masri BIT(IEEE80211_STYPE_DISASSOC >> 4) | 236b9010f10SAhmad Masri BIT(IEEE80211_STYPE_AUTH >> 4) | 237b9010f10SAhmad Masri BIT(IEEE80211_STYPE_REASSOC_RESP >> 4), 2382be7d22fSVladimir Kondratiev .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 239849a564bSDedy Lansky BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | 240849a564bSDedy Lansky BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | 241849a564bSDedy Lansky BIT(IEEE80211_STYPE_DISASSOC >> 4) | 242849a564bSDedy Lansky BIT(IEEE80211_STYPE_AUTH >> 4) | 243849a564bSDedy Lansky BIT(IEEE80211_STYPE_DEAUTH >> 4) | 244849a564bSDedy Lansky BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) 2452be7d22fSVladimir Kondratiev }, 2462be7d22fSVladimir Kondratiev [NL80211_IFTYPE_P2P_CLIENT] = { 2472be7d22fSVladimir Kondratiev .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2482be7d22fSVladimir Kondratiev BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2492be7d22fSVladimir Kondratiev .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2502be7d22fSVladimir Kondratiev BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2512be7d22fSVladimir Kondratiev }, 2522be7d22fSVladimir Kondratiev [NL80211_IFTYPE_P2P_GO] = { 2532be7d22fSVladimir Kondratiev .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2542be7d22fSVladimir Kondratiev BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2552be7d22fSVladimir Kondratiev .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2562be7d22fSVladimir Kondratiev BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2572be7d22fSVladimir Kondratiev }, 2584332cac1SLior David [NL80211_IFTYPE_P2P_DEVICE] = { 2594332cac1SLior David .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2604332cac1SLior David BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2614332cac1SLior David .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2624332cac1SLior David BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2634332cac1SLior David }, 2642be7d22fSVladimir Kondratiev }; 2652be7d22fSVladimir Kondratiev 2662be7d22fSVladimir Kondratiev static const u32 wil_cipher_suites[] = { 2672be7d22fSVladimir Kondratiev WLAN_CIPHER_SUITE_GCMP, 2682be7d22fSVladimir Kondratiev }; 2692be7d22fSVladimir Kondratiev 27058527421SVladimir Kondratiev static const char * const key_usage_str[] = { 27158527421SVladimir Kondratiev [WMI_KEY_USE_PAIRWISE] = "PTK", 27258527421SVladimir Kondratiev [WMI_KEY_USE_RX_GROUP] = "RX_GTK", 27358527421SVladimir Kondratiev [WMI_KEY_USE_TX_GROUP] = "TX_GTK", 27458527421SVladimir Kondratiev }; 27558527421SVladimir Kondratiev 2762be7d22fSVladimir Kondratiev int wil_iftype_nl2wmi(enum nl80211_iftype type) 2772be7d22fSVladimir Kondratiev { 2782be7d22fSVladimir Kondratiev static const struct { 2792be7d22fSVladimir Kondratiev enum nl80211_iftype nl; 2802be7d22fSVladimir Kondratiev enum wmi_network_type wmi; 2812be7d22fSVladimir Kondratiev } __nl2wmi[] = { 2822be7d22fSVladimir Kondratiev {NL80211_IFTYPE_ADHOC, WMI_NETTYPE_ADHOC}, 2832be7d22fSVladimir Kondratiev {NL80211_IFTYPE_STATION, WMI_NETTYPE_INFRA}, 2842be7d22fSVladimir Kondratiev {NL80211_IFTYPE_AP, WMI_NETTYPE_AP}, 2852be7d22fSVladimir Kondratiev {NL80211_IFTYPE_P2P_CLIENT, WMI_NETTYPE_P2P}, 2862be7d22fSVladimir Kondratiev {NL80211_IFTYPE_P2P_GO, WMI_NETTYPE_P2P}, 2872be7d22fSVladimir Kondratiev {NL80211_IFTYPE_MONITOR, WMI_NETTYPE_ADHOC}, /* FIXME */ 2882be7d22fSVladimir Kondratiev }; 2892be7d22fSVladimir Kondratiev uint i; 2902be7d22fSVladimir Kondratiev 2912be7d22fSVladimir Kondratiev for (i = 0; i < ARRAY_SIZE(__nl2wmi); i++) { 2922be7d22fSVladimir Kondratiev if (__nl2wmi[i].nl == type) 2932be7d22fSVladimir Kondratiev return __nl2wmi[i].wmi; 2942be7d22fSVladimir Kondratiev } 2952be7d22fSVladimir Kondratiev 2962be7d22fSVladimir Kondratiev return -EOPNOTSUPP; 2972be7d22fSVladimir Kondratiev } 2982be7d22fSVladimir Kondratiev 299e00243faSLior David int wil_cid_fill_sinfo(struct wil6210_vif *vif, int cid, 300ef28afdbSVladimir Kondratiev struct station_info *sinfo) 3012be7d22fSVladimir Kondratiev { 302e00243faSLior David struct wil6210_priv *wil = vif_to_wil(vif); 3032be7d22fSVladimir Kondratiev struct wmi_notify_req_cmd cmd = { 3043df2cd36SVladimir Kondratiev .cid = cid, 3052be7d22fSVladimir Kondratiev .interval_usec = 0, 3062be7d22fSVladimir Kondratiev }; 307ef28afdbSVladimir Kondratiev struct { 308b874ddecSLior David struct wmi_cmd_hdr wmi; 309ef28afdbSVladimir Kondratiev struct wmi_notify_req_done_event evt; 310ef28afdbSVladimir Kondratiev } __packed reply; 311c8b78b5fSVladimir Kondratiev struct wil_net_stats *stats = &wil->sta[cid].stats; 312ef28afdbSVladimir Kondratiev int rc; 3132be7d22fSVladimir Kondratiev 314807b0860SAlexei Avshalom Lazar memset(&reply, 0, sizeof(reply)); 315807b0860SAlexei Avshalom Lazar 316e00243faSLior David rc = wmi_call(wil, WMI_NOTIFY_REQ_CMDID, vif->mid, &cmd, sizeof(cmd), 317ef28afdbSVladimir Kondratiev WMI_NOTIFY_REQ_DONE_EVENTID, &reply, sizeof(reply), 20); 3182be7d22fSVladimir Kondratiev if (rc) 3192be7d22fSVladimir Kondratiev return rc; 3202be7d22fSVladimir Kondratiev 321e00243faSLior David wil_dbg_wmi(wil, "Link status for CID %d MID %d: {\n" 322c8b78b5fSVladimir Kondratiev " MCS %d TSF 0x%016llx\n" 32330868f5dSDedy Lansky " BF status 0x%08x RSSI %d SQI %d%%\n" 324c8b78b5fSVladimir Kondratiev " Tx Tpt %d goodput %d Rx goodput %d\n" 325c8b78b5fSVladimir Kondratiev " Sectors(rx:tx) my %d:%d peer %d:%d\n""}\n", 326e00243faSLior David cid, vif->mid, le16_to_cpu(reply.evt.bf_mcs), 327c8b78b5fSVladimir Kondratiev le64_to_cpu(reply.evt.tsf), reply.evt.status, 32830868f5dSDedy Lansky reply.evt.rssi, 329b8b33a3aSVladimir Kondratiev reply.evt.sqi, 330c8b78b5fSVladimir Kondratiev le32_to_cpu(reply.evt.tx_tpt), 331c8b78b5fSVladimir Kondratiev le32_to_cpu(reply.evt.tx_goodput), 332c8b78b5fSVladimir Kondratiev le32_to_cpu(reply.evt.rx_goodput), 333c8b78b5fSVladimir Kondratiev le16_to_cpu(reply.evt.my_rx_sector), 334c8b78b5fSVladimir Kondratiev le16_to_cpu(reply.evt.my_tx_sector), 335c8b78b5fSVladimir Kondratiev le16_to_cpu(reply.evt.other_rx_sector), 336c8b78b5fSVladimir Kondratiev le16_to_cpu(reply.evt.other_tx_sector)); 337c8b78b5fSVladimir Kondratiev 3382be7d22fSVladimir Kondratiev sinfo->generation = wil->sinfo_gen; 3392be7d22fSVladimir Kondratiev 34022d0d2faSOmer Efrat sinfo->filled = BIT_ULL(NL80211_STA_INFO_RX_BYTES) | 34122d0d2faSOmer Efrat BIT_ULL(NL80211_STA_INFO_TX_BYTES) | 34222d0d2faSOmer Efrat BIT_ULL(NL80211_STA_INFO_RX_PACKETS) | 34322d0d2faSOmer Efrat BIT_ULL(NL80211_STA_INFO_TX_PACKETS) | 34422d0d2faSOmer Efrat BIT_ULL(NL80211_STA_INFO_RX_BITRATE) | 34522d0d2faSOmer Efrat BIT_ULL(NL80211_STA_INFO_TX_BITRATE) | 34622d0d2faSOmer Efrat BIT_ULL(NL80211_STA_INFO_RX_DROP_MISC) | 34722d0d2faSOmer Efrat BIT_ULL(NL80211_STA_INFO_TX_FAILED); 348c8b78b5fSVladimir Kondratiev 3490c1eca4eSJohannes Berg sinfo->txrate.flags = RATE_INFO_FLAGS_60G; 350ef28afdbSVladimir Kondratiev sinfo->txrate.mcs = le16_to_cpu(reply.evt.bf_mcs); 351c8b78b5fSVladimir Kondratiev sinfo->rxrate.mcs = stats->last_mcs_rx; 352c8b78b5fSVladimir Kondratiev sinfo->rx_bytes = stats->rx_bytes; 353c8b78b5fSVladimir Kondratiev sinfo->rx_packets = stats->rx_packets; 354c8b78b5fSVladimir Kondratiev sinfo->rx_dropped_misc = stats->rx_dropped; 355c8b78b5fSVladimir Kondratiev sinfo->tx_bytes = stats->tx_bytes; 356c8b78b5fSVladimir Kondratiev sinfo->tx_packets = stats->tx_packets; 357c8b78b5fSVladimir Kondratiev sinfo->tx_failed = stats->tx_errors; 3582be7d22fSVladimir Kondratiev 3595bd60982SLior David if (test_bit(wil_vif_fwconnected, vif->status)) { 36022d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL); 36130868f5dSDedy Lansky if (test_bit(WMI_FW_CAPABILITY_RSSI_REPORTING, 36230868f5dSDedy Lansky wil->fw_capabilities)) 36330868f5dSDedy Lansky sinfo->signal = reply.evt.rssi; 36430868f5dSDedy Lansky else 365b8b33a3aSVladimir Kondratiev sinfo->signal = reply.evt.sqi; 3662be7d22fSVladimir Kondratiev } 3672be7d22fSVladimir Kondratiev 368ef28afdbSVladimir Kondratiev return rc; 369ef28afdbSVladimir Kondratiev } 370ef28afdbSVladimir Kondratiev 371ef28afdbSVladimir Kondratiev static int wil_cfg80211_get_station(struct wiphy *wiphy, 372ef28afdbSVladimir Kondratiev struct net_device *ndev, 3733b3a0162SJohannes Berg const u8 *mac, struct station_info *sinfo) 374ef28afdbSVladimir Kondratiev { 375e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 376ef28afdbSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 377ef28afdbSVladimir Kondratiev int rc; 378ef28afdbSVladimir Kondratiev 379e00243faSLior David int cid = wil_find_cid(wil, vif->mid, mac); 380ef28afdbSVladimir Kondratiev 381e00243faSLior David wil_dbg_misc(wil, "get_station: %pM CID %d MID %d\n", mac, cid, 382e00243faSLior David vif->mid); 383c478ac9dSAlexei Avshalom Lazar if (!wil_cid_valid(wil, cid)) 384c478ac9dSAlexei Avshalom Lazar return -ENOENT; 385ef28afdbSVladimir Kondratiev 386e00243faSLior David rc = wil_cid_fill_sinfo(vif, cid, sinfo); 387ef28afdbSVladimir Kondratiev 388ef28afdbSVladimir Kondratiev return rc; 389ef28afdbSVladimir Kondratiev } 390ef28afdbSVladimir Kondratiev 391ef28afdbSVladimir Kondratiev /* 392e00243faSLior David * Find @idx-th active STA for specific MID for station dump. 393ef28afdbSVladimir Kondratiev */ 394e00243faSLior David static int wil_find_cid_by_idx(struct wil6210_priv *wil, u8 mid, int idx) 395ef28afdbSVladimir Kondratiev { 396ef28afdbSVladimir Kondratiev int i; 397ef28afdbSVladimir Kondratiev 398ddf7afddSAhmad Masri for (i = 0; i < wil->max_assoc_sta; i++) { 399ef28afdbSVladimir Kondratiev if (wil->sta[i].status == wil_sta_unused) 400ef28afdbSVladimir Kondratiev continue; 401e00243faSLior David if (wil->sta[i].mid != mid) 402e00243faSLior David continue; 403ef28afdbSVladimir Kondratiev if (idx == 0) 404ef28afdbSVladimir Kondratiev return i; 405ef28afdbSVladimir Kondratiev idx--; 406ef28afdbSVladimir Kondratiev } 407ef28afdbSVladimir Kondratiev 408ef28afdbSVladimir Kondratiev return -ENOENT; 409ef28afdbSVladimir Kondratiev } 410ef28afdbSVladimir Kondratiev 411ef28afdbSVladimir Kondratiev static int wil_cfg80211_dump_station(struct wiphy *wiphy, 412ef28afdbSVladimir Kondratiev struct net_device *dev, int idx, 413ef28afdbSVladimir Kondratiev u8 *mac, struct station_info *sinfo) 414ef28afdbSVladimir Kondratiev { 415e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 416ef28afdbSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 417ef28afdbSVladimir Kondratiev int rc; 418e00243faSLior David int cid = wil_find_cid_by_idx(wil, vif->mid, idx); 419ef28afdbSVladimir Kondratiev 420c478ac9dSAlexei Avshalom Lazar if (!wil_cid_valid(wil, cid)) 421ef28afdbSVladimir Kondratiev return -ENOENT; 422ef28afdbSVladimir Kondratiev 423a82553bbSVladimir Kondratiev ether_addr_copy(mac, wil->sta[cid].addr); 424e00243faSLior David wil_dbg_misc(wil, "dump_station: %pM CID %d MID %d\n", mac, cid, 425e00243faSLior David vif->mid); 426ef28afdbSVladimir Kondratiev 427e00243faSLior David rc = wil_cid_fill_sinfo(vif, cid, sinfo); 428ef28afdbSVladimir Kondratiev 429ef28afdbSVladimir Kondratiev return rc; 4302be7d22fSVladimir Kondratiev } 4312be7d22fSVladimir Kondratiev 43269fecf59SLior David static int wil_cfg80211_start_p2p_device(struct wiphy *wiphy, 43369fecf59SLior David struct wireless_dev *wdev) 43469fecf59SLior David { 43569fecf59SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 43669fecf59SLior David 43769fecf59SLior David wil_dbg_misc(wil, "start_p2p_device: entered\n"); 438e00243faSLior David wil->p2p_dev_started = 1; 43969fecf59SLior David return 0; 44069fecf59SLior David } 44169fecf59SLior David 44269fecf59SLior David static void wil_cfg80211_stop_p2p_device(struct wiphy *wiphy, 44369fecf59SLior David struct wireless_dev *wdev) 44469fecf59SLior David { 44569fecf59SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 44669fecf59SLior David 447e00243faSLior David if (!wil->p2p_dev_started) 44869fecf59SLior David return; 44969fecf59SLior David 45069fecf59SLior David wil_dbg_misc(wil, "stop_p2p_device: entered\n"); 45169fecf59SLior David mutex_lock(&wil->mutex); 452404bbb3cSLior David mutex_lock(&wil->vif_mutex); 45369fecf59SLior David wil_p2p_stop_radio_operations(wil); 454e00243faSLior David wil->p2p_dev_started = 0; 455404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 45669fecf59SLior David mutex_unlock(&wil->mutex); 45769fecf59SLior David } 45869fecf59SLior David 4594aebd3bdSLior David static int wil_cfg80211_validate_add_iface(struct wil6210_priv *wil, 4604aebd3bdSLior David enum nl80211_iftype new_type) 4614aebd3bdSLior David { 4624aebd3bdSLior David int i; 4634aebd3bdSLior David struct wireless_dev *wdev; 4644aebd3bdSLior David struct iface_combination_params params = { 4654aebd3bdSLior David .num_different_channels = 1, 4664aebd3bdSLior David }; 4674aebd3bdSLior David 468e4a29bddSAhmad Masri for (i = 0; i < GET_MAX_VIFS(wil); i++) { 4694aebd3bdSLior David if (wil->vifs[i]) { 4704aebd3bdSLior David wdev = vif_to_wdev(wil->vifs[i]); 4714aebd3bdSLior David params.iftype_num[wdev->iftype]++; 4724aebd3bdSLior David } 4734aebd3bdSLior David } 4744aebd3bdSLior David params.iftype_num[new_type]++; 4754aebd3bdSLior David return cfg80211_check_combinations(wil->wiphy, ¶ms); 4764aebd3bdSLior David } 4774aebd3bdSLior David 4784aebd3bdSLior David static int wil_cfg80211_validate_change_iface(struct wil6210_priv *wil, 4794aebd3bdSLior David struct wil6210_vif *vif, 4804aebd3bdSLior David enum nl80211_iftype new_type) 4814aebd3bdSLior David { 4824aebd3bdSLior David int i, ret = 0; 4834aebd3bdSLior David struct wireless_dev *wdev; 4844aebd3bdSLior David struct iface_combination_params params = { 4854aebd3bdSLior David .num_different_channels = 1, 4864aebd3bdSLior David }; 4874aebd3bdSLior David bool check_combos = false; 4884aebd3bdSLior David 489e4a29bddSAhmad Masri for (i = 0; i < GET_MAX_VIFS(wil); i++) { 4904aebd3bdSLior David struct wil6210_vif *vif_pos = wil->vifs[i]; 4914aebd3bdSLior David 4924aebd3bdSLior David if (vif_pos && vif != vif_pos) { 4934aebd3bdSLior David wdev = vif_to_wdev(vif_pos); 4944aebd3bdSLior David params.iftype_num[wdev->iftype]++; 4954aebd3bdSLior David check_combos = true; 4964aebd3bdSLior David } 4974aebd3bdSLior David } 4984aebd3bdSLior David 4994aebd3bdSLior David if (check_combos) { 5004aebd3bdSLior David params.iftype_num[new_type]++; 5014aebd3bdSLior David ret = cfg80211_check_combinations(wil->wiphy, ¶ms); 5024aebd3bdSLior David } 5034aebd3bdSLior David return ret; 5044aebd3bdSLior David } 5054aebd3bdSLior David 5064332cac1SLior David static struct wireless_dev * 5074332cac1SLior David wil_cfg80211_add_iface(struct wiphy *wiphy, const char *name, 5084332cac1SLior David unsigned char name_assign_type, 5094332cac1SLior David enum nl80211_iftype type, 510818a986eSJohannes Berg struct vif_params *params) 5114332cac1SLior David { 5124332cac1SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 5134aebd3bdSLior David struct net_device *ndev_main = wil->main_ndev, *ndev; 5149f38f286SLior David struct wil6210_vif *vif; 5154aebd3bdSLior David struct wireless_dev *p2p_wdev, *wdev; 5164aebd3bdSLior David int rc; 5174332cac1SLior David 5184aebd3bdSLior David wil_dbg_misc(wil, "add_iface, type %d\n", type); 5194332cac1SLior David 5204aebd3bdSLior David /* P2P device is not a real virtual interface, it is a management-only 5214aebd3bdSLior David * interface that shares the main interface. 5224aebd3bdSLior David * Skip concurrency checks here. 5234aebd3bdSLior David */ 5244aebd3bdSLior David if (type == NL80211_IFTYPE_P2P_DEVICE) { 5254332cac1SLior David if (wil->p2p_wdev) { 526af3db60aSLazar Alexei wil_err(wil, "P2P_DEVICE interface already created\n"); 5274332cac1SLior David return ERR_PTR(-EINVAL); 5284332cac1SLior David } 5294332cac1SLior David 5305bd60982SLior David p2p_wdev = kzalloc(sizeof(*p2p_wdev), GFP_KERNEL); 5315bd60982SLior David if (!p2p_wdev) 5324332cac1SLior David return ERR_PTR(-ENOMEM); 5334332cac1SLior David 5344332cac1SLior David p2p_wdev->iftype = type; 5354332cac1SLior David p2p_wdev->wiphy = wiphy; 5364332cac1SLior David /* use our primary ethernet address */ 5374aebd3bdSLior David ether_addr_copy(p2p_wdev->address, ndev_main->perm_addr); 5384332cac1SLior David 5394332cac1SLior David wil->p2p_wdev = p2p_wdev; 5404332cac1SLior David 5414332cac1SLior David return p2p_wdev; 5424332cac1SLior David } 5434332cac1SLior David 5444aebd3bdSLior David if (!wil->wiphy->n_iface_combinations) { 5454aebd3bdSLior David wil_err(wil, "virtual interfaces not supported\n"); 5464aebd3bdSLior David return ERR_PTR(-EINVAL); 5474aebd3bdSLior David } 5484aebd3bdSLior David 5494aebd3bdSLior David rc = wil_cfg80211_validate_add_iface(wil, type); 5504aebd3bdSLior David if (rc) { 5514aebd3bdSLior David wil_err(wil, "iface validation failed, err=%d\n", rc); 5524aebd3bdSLior David return ERR_PTR(rc); 5534aebd3bdSLior David } 5544aebd3bdSLior David 5554aebd3bdSLior David vif = wil_vif_alloc(wil, name, name_assign_type, type); 5564aebd3bdSLior David if (IS_ERR(vif)) 5574aebd3bdSLior David return ERR_CAST(vif); 5584aebd3bdSLior David 5594aebd3bdSLior David ndev = vif_to_ndev(vif); 5604aebd3bdSLior David ether_addr_copy(ndev->perm_addr, ndev_main->perm_addr); 5614aebd3bdSLior David if (is_valid_ether_addr(params->macaddr)) { 5624aebd3bdSLior David ether_addr_copy(ndev->dev_addr, params->macaddr); 5634aebd3bdSLior David } else { 5644aebd3bdSLior David ether_addr_copy(ndev->dev_addr, ndev_main->perm_addr); 5654aebd3bdSLior David ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << vif->mid)) | 5664aebd3bdSLior David 0x2; /* locally administered */ 5674aebd3bdSLior David } 5684aebd3bdSLior David wdev = vif_to_wdev(vif); 5694aebd3bdSLior David ether_addr_copy(wdev->address, ndev->dev_addr); 5704aebd3bdSLior David 5714aebd3bdSLior David rc = wil_vif_add(wil, vif); 5724aebd3bdSLior David if (rc) 5734aebd3bdSLior David goto out; 5744aebd3bdSLior David 5754aebd3bdSLior David wil_info(wil, "added VIF, mid %d iftype %d MAC %pM\n", 5764aebd3bdSLior David vif->mid, type, wdev->address); 5774aebd3bdSLior David return wdev; 5784aebd3bdSLior David out: 5794aebd3bdSLior David wil_vif_free(vif); 5804aebd3bdSLior David return ERR_PTR(rc); 5814aebd3bdSLior David } 5824aebd3bdSLior David 5833ada9314SLior David int wil_vif_prepare_stop(struct wil6210_vif *vif) 5844aebd3bdSLior David { 5853ada9314SLior David struct wil6210_priv *wil = vif_to_wil(vif); 5864aebd3bdSLior David struct wireless_dev *wdev = vif_to_wdev(vif); 5874aebd3bdSLior David struct net_device *ndev; 5884aebd3bdSLior David int rc; 5894aebd3bdSLior David 5904aebd3bdSLior David if (wdev->iftype != NL80211_IFTYPE_AP) 5914aebd3bdSLior David return 0; 5924aebd3bdSLior David 5934aebd3bdSLior David ndev = vif_to_ndev(vif); 5944aebd3bdSLior David if (netif_carrier_ok(ndev)) { 5954aebd3bdSLior David rc = wmi_pcp_stop(vif); 5964aebd3bdSLior David if (rc) { 5974aebd3bdSLior David wil_info(wil, "failed to stop AP, status %d\n", 5984aebd3bdSLior David rc); 5994aebd3bdSLior David /* continue */ 6004aebd3bdSLior David } 6013ada9314SLior David wil_bcast_fini(vif); 6024aebd3bdSLior David netif_carrier_off(ndev); 6034aebd3bdSLior David } 6044aebd3bdSLior David 6054aebd3bdSLior David return 0; 6064aebd3bdSLior David } 6074aebd3bdSLior David 6084332cac1SLior David static int wil_cfg80211_del_iface(struct wiphy *wiphy, 6094332cac1SLior David struct wireless_dev *wdev) 6104332cac1SLior David { 6114332cac1SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 6124aebd3bdSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 6134aebd3bdSLior David int rc; 6144332cac1SLior David 615af3db60aSLazar Alexei wil_dbg_misc(wil, "del_iface\n"); 6164332cac1SLior David 6174aebd3bdSLior David if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE) { 6184332cac1SLior David if (wdev != wil->p2p_wdev) { 6194aebd3bdSLior David wil_err(wil, "delete of incorrect interface 0x%p\n", 6204aebd3bdSLior David wdev); 6214332cac1SLior David return -EINVAL; 6224332cac1SLior David } 6234332cac1SLior David 62469fecf59SLior David wil_cfg80211_stop_p2p_device(wiphy, wdev); 6254332cac1SLior David wil_p2p_wdev_free(wil); 6264332cac1SLior David return 0; 6274332cac1SLior David } 6284332cac1SLior David 6294aebd3bdSLior David if (vif->mid == 0) { 6304aebd3bdSLior David wil_err(wil, "cannot remove the main interface\n"); 6314aebd3bdSLior David return -EINVAL; 6324aebd3bdSLior David } 6334aebd3bdSLior David 6343ada9314SLior David rc = wil_vif_prepare_stop(vif); 6354aebd3bdSLior David if (rc) 6364aebd3bdSLior David goto out; 6374aebd3bdSLior David 6384aebd3bdSLior David wil_info(wil, "deleted VIF, mid %d iftype %d MAC %pM\n", 6394aebd3bdSLior David vif->mid, wdev->iftype, wdev->address); 6404aebd3bdSLior David 6414aebd3bdSLior David wil_vif_remove(wil, vif->mid); 6424aebd3bdSLior David out: 6434aebd3bdSLior David return rc; 6444aebd3bdSLior David } 6454aebd3bdSLior David 646b913e330SAlexei Avshalom Lazar static bool wil_is_safe_switch(enum nl80211_iftype from, 647b913e330SAlexei Avshalom Lazar enum nl80211_iftype to) 648b913e330SAlexei Avshalom Lazar { 649b913e330SAlexei Avshalom Lazar if (from == NL80211_IFTYPE_STATION && 650b913e330SAlexei Avshalom Lazar to == NL80211_IFTYPE_P2P_CLIENT) 651b913e330SAlexei Avshalom Lazar return true; 652b913e330SAlexei Avshalom Lazar 653b913e330SAlexei Avshalom Lazar return false; 654b913e330SAlexei Avshalom Lazar } 655b913e330SAlexei Avshalom Lazar 6562be7d22fSVladimir Kondratiev static int wil_cfg80211_change_iface(struct wiphy *wiphy, 6572be7d22fSVladimir Kondratiev struct net_device *ndev, 658818a986eSJohannes Berg enum nl80211_iftype type, 6592be7d22fSVladimir Kondratiev struct vif_params *params) 6602be7d22fSVladimir Kondratiev { 6612be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 662e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 663e00243faSLior David struct wireless_dev *wdev = vif_to_wdev(vif); 664e6d68341SDedy Lansky int rc; 6653ada9314SLior David bool fw_reset = false; 666e6d68341SDedy Lansky 667af3db60aSLazar Alexei wil_dbg_misc(wil, "change_iface: type=%d\n", type); 668e6d68341SDedy Lansky 6694aebd3bdSLior David if (wiphy->n_iface_combinations) { 6704aebd3bdSLior David rc = wil_cfg80211_validate_change_iface(wil, vif, type); 6714aebd3bdSLior David if (rc) { 6724aebd3bdSLior David wil_err(wil, "iface validation failed, err=%d\n", rc); 6734aebd3bdSLior David return rc; 6744aebd3bdSLior David } 6754aebd3bdSLior David } 6764aebd3bdSLior David 6774aebd3bdSLior David /* do not reset FW when there are active VIFs, 6784aebd3bdSLior David * because it can cause significant disruption 6794aebd3bdSLior David */ 6803ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, true, false) && 681b913e330SAlexei Avshalom Lazar netif_running(ndev) && !wil_is_recovery_blocked(wil) && 682b913e330SAlexei Avshalom Lazar !wil_is_safe_switch(wdev->iftype, type)) { 683e6d68341SDedy Lansky wil_dbg_misc(wil, "interface is up. resetting...\n"); 684e6d68341SDedy Lansky mutex_lock(&wil->mutex); 685e6d68341SDedy Lansky __wil_down(wil); 686e6d68341SDedy Lansky rc = __wil_up(wil); 687e6d68341SDedy Lansky mutex_unlock(&wil->mutex); 688e6d68341SDedy Lansky 689e6d68341SDedy Lansky if (rc) 690e6d68341SDedy Lansky return rc; 6913ada9314SLior David fw_reset = true; 692e6d68341SDedy Lansky } 6932be7d22fSVladimir Kondratiev 6942be7d22fSVladimir Kondratiev switch (type) { 6952be7d22fSVladimir Kondratiev case NL80211_IFTYPE_STATION: 6962be7d22fSVladimir Kondratiev case NL80211_IFTYPE_AP: 6972be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 6982be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 6992be7d22fSVladimir Kondratiev break; 7002be7d22fSVladimir Kondratiev case NL80211_IFTYPE_MONITOR: 701818a986eSJohannes Berg if (params->flags) 702818a986eSJohannes Berg wil->monitor_flags = params->flags; 7032be7d22fSVladimir Kondratiev break; 7042be7d22fSVladimir Kondratiev default: 7052be7d22fSVladimir Kondratiev return -EOPNOTSUPP; 7062be7d22fSVladimir Kondratiev } 7072be7d22fSVladimir Kondratiev 7083ada9314SLior David if (vif->mid != 0 && wil_has_active_ifaces(wil, true, false)) { 7093ada9314SLior David if (!fw_reset) 7103ada9314SLior David wil_vif_prepare_stop(vif); 7114aebd3bdSLior David rc = wmi_port_delete(wil, vif->mid); 7124aebd3bdSLior David if (rc) 7134aebd3bdSLior David return rc; 7144aebd3bdSLior David rc = wmi_port_allocate(wil, vif->mid, ndev->dev_addr, type); 7154aebd3bdSLior David if (rc) 7164aebd3bdSLior David return rc; 7174aebd3bdSLior David } 7182be7d22fSVladimir Kondratiev 7194aebd3bdSLior David wdev->iftype = type; 7202be7d22fSVladimir Kondratiev return 0; 7212be7d22fSVladimir Kondratiev } 7222be7d22fSVladimir Kondratiev 7232be7d22fSVladimir Kondratiev static int wil_cfg80211_scan(struct wiphy *wiphy, 7242be7d22fSVladimir Kondratiev struct cfg80211_scan_request *request) 7252be7d22fSVladimir Kondratiev { 7262be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 7274332cac1SLior David struct wireless_dev *wdev = request->wdev; 728e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 7292be7d22fSVladimir Kondratiev struct { 7302be7d22fSVladimir Kondratiev struct wmi_start_scan_cmd cmd; 7312be7d22fSVladimir Kondratiev u16 chnl[4]; 7322be7d22fSVladimir Kondratiev } __packed cmd; 7332be7d22fSVladimir Kondratiev uint i, n; 734ed6f9dc6SVladimir Kondratiev int rc; 7352be7d22fSVladimir Kondratiev 736af3db60aSLazar Alexei wil_dbg_misc(wil, "scan: wdev=0x%p iftype=%d\n", wdev, wdev->iftype); 737e6d68341SDedy Lansky 738af2cd85eSAhmad Masri /* scan is supported on client interfaces and on AP interface */ 7392be7d22fSVladimir Kondratiev switch (wdev->iftype) { 7402be7d22fSVladimir Kondratiev case NL80211_IFTYPE_STATION: 7412be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 7424332cac1SLior David case NL80211_IFTYPE_P2P_DEVICE: 743af2cd85eSAhmad Masri case NL80211_IFTYPE_AP: 7442be7d22fSVladimir Kondratiev break; 7452be7d22fSVladimir Kondratiev default: 7462be7d22fSVladimir Kondratiev return -EOPNOTSUPP; 7472be7d22fSVladimir Kondratiev } 7482be7d22fSVladimir Kondratiev 7492be7d22fSVladimir Kondratiev /* FW don't support scan after connection attempt */ 7509419b6a2SVladimir Kondratiev if (test_bit(wil_status_dontscan, wil->status)) { 751e83eb2fcSVladimir Kondratiev wil_err(wil, "Can't scan now\n"); 7522be7d22fSVladimir Kondratiev return -EBUSY; 7532be7d22fSVladimir Kondratiev } 7542be7d22fSVladimir Kondratiev 755bb6743f7SLior David mutex_lock(&wil->mutex); 756bb6743f7SLior David 757404bbb3cSLior David mutex_lock(&wil->vif_mutex); 758e00243faSLior David if (vif->scan_request || vif->p2p.discovery_started) { 759bb6743f7SLior David wil_err(wil, "Already scanning\n"); 760404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 761bb6743f7SLior David rc = -EAGAIN; 762bb6743f7SLior David goto out; 763bb6743f7SLior David } 764404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 765bb6743f7SLior David 7664a0e45a7SLior David if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE) { 767e00243faSLior David if (!wil->p2p_dev_started) { 768eb57a5b3SLior David wil_err(wil, "P2P search requested on stopped P2P device\n"); 769bb6743f7SLior David rc = -EIO; 770bb6743f7SLior David goto out; 771eb57a5b3SLior David } 7724a0e45a7SLior David /* social scan on P2P_DEVICE is handled as p2p search */ 7734a0e45a7SLior David if (wil_p2p_is_social_scan(request)) { 774e00243faSLior David vif->scan_request = request; 775e00243faSLior David if (vif->mid == 0) 7764332cac1SLior David wil->radio_wdev = wdev; 777e00243faSLior David rc = wil_p2p_search(vif, request); 7784332cac1SLior David if (rc) { 779e00243faSLior David if (vif->mid == 0) 780e00243faSLior David wil->radio_wdev = 781e00243faSLior David wil->main_ndev->ieee80211_ptr; 782e00243faSLior David vif->scan_request = NULL; 7834332cac1SLior David } 784bb6743f7SLior David goto out; 785e6d68341SDedy Lansky } 7864a0e45a7SLior David } 787e6d68341SDedy Lansky 788e00243faSLior David (void)wil_p2p_stop_discovery(vif); 789e6d68341SDedy Lansky 7902a91d7d0SVladimir Kondratiev wil_dbg_misc(wil, "Start scan_request 0x%p\n", request); 7918e52fe30SHamad Kadmany wil_dbg_misc(wil, "SSID count: %d", request->n_ssids); 7928e52fe30SHamad Kadmany 7938e52fe30SHamad Kadmany for (i = 0; i < request->n_ssids; i++) { 7948e52fe30SHamad Kadmany wil_dbg_misc(wil, "SSID[%d]", i); 7955eb443e9SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 7968e52fe30SHamad Kadmany request->ssids[i].ssid, 7975eb443e9SDedy Lansky request->ssids[i].ssid_len, true); 7988e52fe30SHamad Kadmany } 7998e52fe30SHamad Kadmany 8008e52fe30SHamad Kadmany if (request->n_ssids) 801e00243faSLior David rc = wmi_set_ssid(vif, request->ssids[0].ssid_len, 8028e52fe30SHamad Kadmany request->ssids[0].ssid); 8038e52fe30SHamad Kadmany else 804e00243faSLior David rc = wmi_set_ssid(vif, 0, NULL); 8058e52fe30SHamad Kadmany 8068e52fe30SHamad Kadmany if (rc) { 8078e52fe30SHamad Kadmany wil_err(wil, "set SSID for scan request failed: %d\n", rc); 808bb6743f7SLior David goto out; 8098e52fe30SHamad Kadmany } 8108e52fe30SHamad Kadmany 811e00243faSLior David vif->scan_request = request; 812e00243faSLior David mod_timer(&vif->scan_timer, jiffies + WIL6210_SCAN_TO); 8132be7d22fSVladimir Kondratiev 8142be7d22fSVladimir Kondratiev memset(&cmd, 0, sizeof(cmd)); 81574997a53SLior David cmd.cmd.scan_type = WMI_ACTIVE_SCAN; 8162be7d22fSVladimir Kondratiev cmd.cmd.num_channels = 0; 8172be7d22fSVladimir Kondratiev n = min(request->n_channels, 4U); 8182be7d22fSVladimir Kondratiev for (i = 0; i < n; i++) { 8192be7d22fSVladimir Kondratiev int ch = request->channels[i]->hw_value; 8208fe59627SVladimir Kondratiev 8212be7d22fSVladimir Kondratiev if (ch == 0) { 8222be7d22fSVladimir Kondratiev wil_err(wil, 8232be7d22fSVladimir Kondratiev "Scan requested for unknown frequency %dMhz\n", 8242be7d22fSVladimir Kondratiev request->channels[i]->center_freq); 8252be7d22fSVladimir Kondratiev continue; 8262be7d22fSVladimir Kondratiev } 8272be7d22fSVladimir Kondratiev /* 0-based channel indexes */ 8282be7d22fSVladimir Kondratiev cmd.cmd.channel_list[cmd.cmd.num_channels++].channel = ch - 1; 8297743882dSVladimir Kondratiev wil_dbg_misc(wil, "Scan for ch %d : %d MHz\n", ch, 8302be7d22fSVladimir Kondratiev request->channels[i]->center_freq); 8312be7d22fSVladimir Kondratiev } 8322be7d22fSVladimir Kondratiev 83377c91295SVladimir Kondratiev if (request->ie_len) 8345eb443e9SDedy Lansky wil_hex_dump_misc("Scan IE ", DUMP_PREFIX_OFFSET, 16, 1, 8355eb443e9SDedy Lansky request->ie, request->ie_len, true); 83677c91295SVladimir Kondratiev else 83777c91295SVladimir Kondratiev wil_dbg_misc(wil, "Scan has no IE's\n"); 83877c91295SVladimir Kondratiev 839e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_PROBE_REQ, 840e00243faSLior David request->ie_len, request->ie); 8415421bf0cSVladimir Kondratiev if (rc) 842bb6743f7SLior David goto out_restore; 84377c91295SVladimir Kondratiev 84474997a53SLior David if (wil->discovery_mode && cmd.cmd.scan_type == WMI_ACTIVE_SCAN) { 84574997a53SLior David cmd.cmd.discovery_mode = 1; 84674997a53SLior David wil_dbg_misc(wil, "active scan with discovery_mode=1\n"); 84774997a53SLior David } 84874997a53SLior David 849e00243faSLior David if (vif->mid == 0) 8504332cac1SLior David wil->radio_wdev = wdev; 851e00243faSLior David rc = wmi_send(wil, WMI_START_SCAN_CMDID, vif->mid, 852e00243faSLior David &cmd, sizeof(cmd.cmd) + 8532be7d22fSVladimir Kondratiev cmd.cmd.num_channels * sizeof(cmd.cmd.channel_list[0])); 854ed6f9dc6SVladimir Kondratiev 855bb6743f7SLior David out_restore: 856a2142086SVladimir Kondratiev if (rc) { 857e00243faSLior David del_timer_sync(&vif->scan_timer); 858e00243faSLior David if (vif->mid == 0) 859e00243faSLior David wil->radio_wdev = wil->main_ndev->ieee80211_ptr; 860e00243faSLior David vif->scan_request = NULL; 861a2142086SVladimir Kondratiev } 862bb6743f7SLior David out: 863bb6743f7SLior David mutex_unlock(&wil->mutex); 864ed6f9dc6SVladimir Kondratiev return rc; 8652be7d22fSVladimir Kondratiev } 8662be7d22fSVladimir Kondratiev 867035859a5SMaya Erez static void wil_cfg80211_abort_scan(struct wiphy *wiphy, 868035859a5SMaya Erez struct wireless_dev *wdev) 869035859a5SMaya Erez { 870035859a5SMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 871e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 872035859a5SMaya Erez 873035859a5SMaya Erez wil_dbg_misc(wil, "wdev=0x%p iftype=%d\n", wdev, wdev->iftype); 874035859a5SMaya Erez 875035859a5SMaya Erez mutex_lock(&wil->mutex); 876404bbb3cSLior David mutex_lock(&wil->vif_mutex); 877035859a5SMaya Erez 878e00243faSLior David if (!vif->scan_request) 879035859a5SMaya Erez goto out; 880035859a5SMaya Erez 881e00243faSLior David if (wdev != vif->scan_request->wdev) { 882035859a5SMaya Erez wil_dbg_misc(wil, "abort scan was called on the wrong iface\n"); 883035859a5SMaya Erez goto out; 884035859a5SMaya Erez } 885035859a5SMaya Erez 886e00243faSLior David if (wdev == wil->p2p_wdev && wil->radio_wdev == wil->p2p_wdev) 887035859a5SMaya Erez wil_p2p_stop_radio_operations(wil); 888035859a5SMaya Erez else 889e00243faSLior David wil_abort_scan(vif, true); 890035859a5SMaya Erez 891035859a5SMaya Erez out: 892404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 893035859a5SMaya Erez mutex_unlock(&wil->mutex); 894035859a5SMaya Erez } 895035859a5SMaya Erez 896feeac225SVladimir Kondratiev static void wil_print_crypto(struct wil6210_priv *wil, 897feeac225SVladimir Kondratiev struct cfg80211_crypto_settings *c) 898feeac225SVladimir Kondratiev { 899feeac225SVladimir Kondratiev int i, n; 900feeac225SVladimir Kondratiev 901feeac225SVladimir Kondratiev wil_dbg_misc(wil, "WPA versions: 0x%08x cipher group 0x%08x\n", 902feeac225SVladimir Kondratiev c->wpa_versions, c->cipher_group); 903feeac225SVladimir Kondratiev wil_dbg_misc(wil, "Pairwise ciphers [%d] {\n", c->n_ciphers_pairwise); 904feeac225SVladimir Kondratiev n = min_t(int, c->n_ciphers_pairwise, ARRAY_SIZE(c->ciphers_pairwise)); 905feeac225SVladimir Kondratiev for (i = 0; i < n; i++) 906feeac225SVladimir Kondratiev wil_dbg_misc(wil, " [%d] = 0x%08x\n", i, 907feeac225SVladimir Kondratiev c->ciphers_pairwise[i]); 908feeac225SVladimir Kondratiev wil_dbg_misc(wil, "}\n"); 909feeac225SVladimir Kondratiev wil_dbg_misc(wil, "AKM suites [%d] {\n", c->n_akm_suites); 910feeac225SVladimir Kondratiev n = min_t(int, c->n_akm_suites, ARRAY_SIZE(c->akm_suites)); 911feeac225SVladimir Kondratiev for (i = 0; i < n; i++) 912feeac225SVladimir Kondratiev wil_dbg_misc(wil, " [%d] = 0x%08x\n", i, 913feeac225SVladimir Kondratiev c->akm_suites[i]); 914feeac225SVladimir Kondratiev wil_dbg_misc(wil, "}\n"); 915feeac225SVladimir Kondratiev wil_dbg_misc(wil, "Control port : %d, eth_type 0x%04x no_encrypt %d\n", 916feeac225SVladimir Kondratiev c->control_port, be16_to_cpu(c->control_port_ethertype), 917feeac225SVladimir Kondratiev c->control_port_no_encrypt); 918feeac225SVladimir Kondratiev } 919feeac225SVladimir Kondratiev 920b9010f10SAhmad Masri static const char * 921b9010f10SAhmad Masri wil_get_auth_type_name(enum nl80211_auth_type auth_type) 922b9010f10SAhmad Masri { 923b9010f10SAhmad Masri switch (auth_type) { 924b9010f10SAhmad Masri case NL80211_AUTHTYPE_OPEN_SYSTEM: 925b9010f10SAhmad Masri return "OPEN_SYSTEM"; 926b9010f10SAhmad Masri case NL80211_AUTHTYPE_SHARED_KEY: 927b9010f10SAhmad Masri return "SHARED_KEY"; 928b9010f10SAhmad Masri case NL80211_AUTHTYPE_FT: 929b9010f10SAhmad Masri return "FT"; 930b9010f10SAhmad Masri case NL80211_AUTHTYPE_NETWORK_EAP: 931b9010f10SAhmad Masri return "NETWORK_EAP"; 932b9010f10SAhmad Masri case NL80211_AUTHTYPE_SAE: 933b9010f10SAhmad Masri return "SAE"; 934b9010f10SAhmad Masri case NL80211_AUTHTYPE_AUTOMATIC: 935b9010f10SAhmad Masri return "AUTOMATIC"; 936b9010f10SAhmad Masri default: 937b9010f10SAhmad Masri return "unknown"; 938b9010f10SAhmad Masri } 939b9010f10SAhmad Masri } 9408ca26163SVladimir Kondratiev static void wil_print_connect_params(struct wil6210_priv *wil, 9418ca26163SVladimir Kondratiev struct cfg80211_connect_params *sme) 9428ca26163SVladimir Kondratiev { 9438ca26163SVladimir Kondratiev wil_info(wil, "Connecting to:\n"); 9448ca26163SVladimir Kondratiev if (sme->channel) { 9458ca26163SVladimir Kondratiev wil_info(wil, " Channel: %d freq %d\n", 9468ca26163SVladimir Kondratiev sme->channel->hw_value, sme->channel->center_freq); 9478ca26163SVladimir Kondratiev } 9488ca26163SVladimir Kondratiev if (sme->bssid) 9498ca26163SVladimir Kondratiev wil_info(wil, " BSSID: %pM\n", sme->bssid); 9508ca26163SVladimir Kondratiev if (sme->ssid) 9518ca26163SVladimir Kondratiev print_hex_dump(KERN_INFO, " SSID: ", DUMP_PREFIX_OFFSET, 9528ca26163SVladimir Kondratiev 16, 1, sme->ssid, sme->ssid_len, true); 953b9010f10SAhmad Masri if (sme->prev_bssid) 954b9010f10SAhmad Masri wil_info(wil, " Previous BSSID=%pM\n", sme->prev_bssid); 955b9010f10SAhmad Masri wil_info(wil, " Auth Type: %s\n", 956b9010f10SAhmad Masri wil_get_auth_type_name(sme->auth_type)); 9578ca26163SVladimir Kondratiev wil_info(wil, " Privacy: %s\n", sme->privacy ? "secure" : "open"); 958eabb03b4SLior David wil_info(wil, " PBSS: %d\n", sme->pbss); 959feeac225SVladimir Kondratiev wil_print_crypto(wil, &sme->crypto); 9608ca26163SVladimir Kondratiev } 9618ca26163SVladimir Kondratiev 962b9010f10SAhmad Masri static int wil_ft_connect(struct wiphy *wiphy, 963b9010f10SAhmad Masri struct net_device *ndev, 964b9010f10SAhmad Masri struct cfg80211_connect_params *sme) 965b9010f10SAhmad Masri { 966b9010f10SAhmad Masri struct wil6210_priv *wil = wiphy_to_wil(wiphy); 967b9010f10SAhmad Masri struct wil6210_vif *vif = ndev_to_vif(ndev); 968b9010f10SAhmad Masri struct wmi_ft_auth_cmd auth_cmd; 969b9010f10SAhmad Masri int rc; 970b9010f10SAhmad Masri 971b9010f10SAhmad Masri if (!test_bit(WMI_FW_CAPABILITY_FT_ROAMING, wil->fw_capabilities)) { 972b9010f10SAhmad Masri wil_err(wil, "FT: FW does not support FT roaming\n"); 973b9010f10SAhmad Masri return -EOPNOTSUPP; 974b9010f10SAhmad Masri } 975b9010f10SAhmad Masri 976b9010f10SAhmad Masri if (!sme->prev_bssid) { 977b9010f10SAhmad Masri wil_err(wil, "FT: prev_bssid was not set\n"); 978b9010f10SAhmad Masri return -EINVAL; 979b9010f10SAhmad Masri } 980b9010f10SAhmad Masri 981b9010f10SAhmad Masri if (ether_addr_equal(sme->prev_bssid, sme->bssid)) { 982b9010f10SAhmad Masri wil_err(wil, "FT: can not roam to same AP\n"); 983b9010f10SAhmad Masri return -EINVAL; 984b9010f10SAhmad Masri } 985b9010f10SAhmad Masri 986b9010f10SAhmad Masri if (!test_bit(wil_vif_fwconnected, vif->status)) { 987b9010f10SAhmad Masri wil_err(wil, "FT: roam while not connected\n"); 988b9010f10SAhmad Masri return -EINVAL; 989b9010f10SAhmad Masri } 990b9010f10SAhmad Masri 991b9010f10SAhmad Masri if (vif->privacy != sme->privacy) { 992b9010f10SAhmad Masri wil_err(wil, "FT: privacy mismatch, current (%d) roam (%d)\n", 993b9010f10SAhmad Masri vif->privacy, sme->privacy); 994b9010f10SAhmad Masri return -EINVAL; 995b9010f10SAhmad Masri } 996b9010f10SAhmad Masri 997b9010f10SAhmad Masri if (sme->pbss) { 998b9010f10SAhmad Masri wil_err(wil, "FT: roam is not valid for PBSS\n"); 999b9010f10SAhmad Masri return -EINVAL; 1000b9010f10SAhmad Masri } 1001b9010f10SAhmad Masri 1002b9010f10SAhmad Masri memset(&auth_cmd, 0, sizeof(auth_cmd)); 1003b9010f10SAhmad Masri auth_cmd.channel = sme->channel->hw_value - 1; 1004b9010f10SAhmad Masri ether_addr_copy(auth_cmd.bssid, sme->bssid); 1005b9010f10SAhmad Masri 1006b9010f10SAhmad Masri wil_info(wil, "FT: roaming\n"); 1007b9010f10SAhmad Masri 1008b9010f10SAhmad Masri set_bit(wil_vif_ft_roam, vif->status); 1009b9010f10SAhmad Masri rc = wmi_send(wil, WMI_FT_AUTH_CMDID, vif->mid, 1010b9010f10SAhmad Masri &auth_cmd, sizeof(auth_cmd)); 1011b9010f10SAhmad Masri if (rc == 0) 1012b9010f10SAhmad Masri mod_timer(&vif->connect_timer, 1013b9010f10SAhmad Masri jiffies + msecs_to_jiffies(5000)); 1014b9010f10SAhmad Masri else 1015b9010f10SAhmad Masri clear_bit(wil_vif_ft_roam, vif->status); 1016b9010f10SAhmad Masri 1017b9010f10SAhmad Masri return rc; 1018b9010f10SAhmad Masri } 1019b9010f10SAhmad Masri 10202be7d22fSVladimir Kondratiev static int wil_cfg80211_connect(struct wiphy *wiphy, 10212be7d22fSVladimir Kondratiev struct net_device *ndev, 10222be7d22fSVladimir Kondratiev struct cfg80211_connect_params *sme) 10232be7d22fSVladimir Kondratiev { 10242be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1025e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 10262be7d22fSVladimir Kondratiev struct cfg80211_bss *bss; 10272be7d22fSVladimir Kondratiev struct wmi_connect_cmd conn; 10282be7d22fSVladimir Kondratiev const u8 *ssid_eid; 10292be7d22fSVladimir Kondratiev const u8 *rsn_eid; 10302be7d22fSVladimir Kondratiev int ch; 10312be7d22fSVladimir Kondratiev int rc = 0; 1032b9010f10SAhmad Masri bool is_ft_roam = false; 1033b9010f10SAhmad Masri u8 network_type; 1034eabb03b4SLior David enum ieee80211_bss_type bss_type = IEEE80211_BSS_TYPE_ESS; 10352be7d22fSVladimir Kondratiev 1036e00243faSLior David wil_dbg_misc(wil, "connect, mid=%d\n", vif->mid); 1037344a7024SVladimir Kondratiev wil_print_connect_params(wil, sme); 1038344a7024SVladimir Kondratiev 1039b9010f10SAhmad Masri if (sme->auth_type == NL80211_AUTHTYPE_FT) 1040b9010f10SAhmad Masri is_ft_roam = true; 1041b9010f10SAhmad Masri if (sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC && 1042b9010f10SAhmad Masri test_bit(wil_vif_fwconnected, vif->status)) 1043b9010f10SAhmad Masri is_ft_roam = true; 1044b9010f10SAhmad Masri 1045b9010f10SAhmad Masri if (!is_ft_roam) 10465bd60982SLior David if (test_bit(wil_vif_fwconnecting, vif->status) || 10475bd60982SLior David test_bit(wil_vif_fwconnected, vif->status)) 10484cd9e837SVladimir Kondratiev return -EALREADY; 10494cd9e837SVladimir Kondratiev 1050344a7024SVladimir Kondratiev if (sme->ie_len > WMI_MAX_IE_LEN) { 1051344a7024SVladimir Kondratiev wil_err(wil, "IE too large (%td bytes)\n", sme->ie_len); 1052344a7024SVladimir Kondratiev return -ERANGE; 1053344a7024SVladimir Kondratiev } 1054344a7024SVladimir Kondratiev 1055344a7024SVladimir Kondratiev rsn_eid = sme->ie ? 1056344a7024SVladimir Kondratiev cfg80211_find_ie(WLAN_EID_RSN, sme->ie, sme->ie_len) : 1057344a7024SVladimir Kondratiev NULL; 1058b9010f10SAhmad Masri if (sme->privacy && !rsn_eid) { 105927aa6b71SVladimir Kondratiev wil_info(wil, "WSC connection\n"); 1060b9010f10SAhmad Masri if (is_ft_roam) { 1061b9010f10SAhmad Masri wil_err(wil, "No WSC with FT roam\n"); 1062b9010f10SAhmad Masri return -EINVAL; 1063b9010f10SAhmad Masri } 1064b9010f10SAhmad Masri } 10658ca26163SVladimir Kondratiev 1066eabb03b4SLior David if (sme->pbss) 1067eabb03b4SLior David bss_type = IEEE80211_BSS_TYPE_PBSS; 106834d50519SLior David 10692be7d22fSVladimir Kondratiev bss = cfg80211_get_bss(wiphy, sme->channel, sme->bssid, 10702be7d22fSVladimir Kondratiev sme->ssid, sme->ssid_len, 1071eabb03b4SLior David bss_type, IEEE80211_PRIVACY_ANY); 10722be7d22fSVladimir Kondratiev if (!bss) { 10732be7d22fSVladimir Kondratiev wil_err(wil, "Unable to find BSS\n"); 10742be7d22fSVladimir Kondratiev return -ENOENT; 10752be7d22fSVladimir Kondratiev } 10762be7d22fSVladimir Kondratiev 10772be7d22fSVladimir Kondratiev ssid_eid = ieee80211_bss_get_ie(bss, WLAN_EID_SSID); 10782be7d22fSVladimir Kondratiev if (!ssid_eid) { 10792be7d22fSVladimir Kondratiev wil_err(wil, "No SSID\n"); 10802be7d22fSVladimir Kondratiev rc = -ENOENT; 10812be7d22fSVladimir Kondratiev goto out; 10822be7d22fSVladimir Kondratiev } 1083e00243faSLior David vif->privacy = sme->privacy; 1084e00243faSLior David vif->pbss = sme->pbss; 10852be7d22fSVladimir Kondratiev 1086b9010f10SAhmad Masri rc = wmi_set_ie(vif, WMI_FRAME_ASSOC_REQ, sme->ie_len, sme->ie); 1087b9010f10SAhmad Masri if (rc) 1088b9010f10SAhmad Masri goto out; 1089b9010f10SAhmad Masri 1090b9010f10SAhmad Masri switch (bss->capability & WLAN_CAPABILITY_DMG_TYPE_MASK) { 1091b9010f10SAhmad Masri case WLAN_CAPABILITY_DMG_TYPE_AP: 1092b9010f10SAhmad Masri network_type = WMI_NETTYPE_INFRA; 1093b9010f10SAhmad Masri break; 1094b9010f10SAhmad Masri case WLAN_CAPABILITY_DMG_TYPE_PBSS: 1095b9010f10SAhmad Masri network_type = WMI_NETTYPE_P2P; 1096b9010f10SAhmad Masri break; 1097b9010f10SAhmad Masri default: 1098b9010f10SAhmad Masri wil_err(wil, "Unsupported BSS type, capability= 0x%04x\n", 1099b9010f10SAhmad Masri bss->capability); 1100b9010f10SAhmad Masri rc = -EINVAL; 1101b9010f10SAhmad Masri goto out; 1102b9010f10SAhmad Masri } 1103b9010f10SAhmad Masri 1104b9010f10SAhmad Masri ch = bss->channel->hw_value; 1105b9010f10SAhmad Masri if (ch == 0) { 1106b9010f10SAhmad Masri wil_err(wil, "BSS at unknown frequency %dMhz\n", 1107b9010f10SAhmad Masri bss->channel->center_freq); 1108b9010f10SAhmad Masri rc = -EOPNOTSUPP; 1109b9010f10SAhmad Masri goto out; 1110b9010f10SAhmad Masri } 1111b9010f10SAhmad Masri 1112b9010f10SAhmad Masri if (is_ft_roam) { 1113b9010f10SAhmad Masri if (network_type != WMI_NETTYPE_INFRA) { 1114b9010f10SAhmad Masri wil_err(wil, "FT: Unsupported BSS type, capability= 0x%04x\n", 1115b9010f10SAhmad Masri bss->capability); 1116b9010f10SAhmad Masri rc = -EINVAL; 1117b9010f10SAhmad Masri goto out; 1118b9010f10SAhmad Masri } 1119b9010f10SAhmad Masri rc = wil_ft_connect(wiphy, ndev, sme); 1120b9010f10SAhmad Masri if (rc == 0) 1121b9010f10SAhmad Masri vif->bss = bss; 1122b9010f10SAhmad Masri goto out; 1123b9010f10SAhmad Masri } 1124b9010f10SAhmad Masri 1125e00243faSLior David if (vif->privacy) { 1126230d8442SVladimir Kondratiev /* For secure assoc, remove old keys */ 1127e00243faSLior David rc = wmi_del_cipher_key(vif, 0, bss->bssid, 1128230d8442SVladimir Kondratiev WMI_KEY_USE_PAIRWISE); 11292be7d22fSVladimir Kondratiev if (rc) { 1130230d8442SVladimir Kondratiev wil_err(wil, "WMI_DELETE_CIPHER_KEY_CMD(PTK) failed\n"); 1131230d8442SVladimir Kondratiev goto out; 1132230d8442SVladimir Kondratiev } 1133e00243faSLior David rc = wmi_del_cipher_key(vif, 0, bss->bssid, 1134230d8442SVladimir Kondratiev WMI_KEY_USE_RX_GROUP); 1135230d8442SVladimir Kondratiev if (rc) { 1136230d8442SVladimir Kondratiev wil_err(wil, "WMI_DELETE_CIPHER_KEY_CMD(GTK) failed\n"); 11372be7d22fSVladimir Kondratiev goto out; 11382be7d22fSVladimir Kondratiev } 1139ac4acdb7SVladimir Kondratiev } 1140ac4acdb7SVladimir Kondratiev 11412be7d22fSVladimir Kondratiev /* WMI_CONNECT_CMD */ 11422be7d22fSVladimir Kondratiev memset(&conn, 0, sizeof(conn)); 1143b9010f10SAhmad Masri conn.network_type = network_type; 1144e00243faSLior David if (vif->privacy) { 114527aa6b71SVladimir Kondratiev if (rsn_eid) { /* regular secure connection */ 11462be7d22fSVladimir Kondratiev conn.dot11_auth_mode = WMI_AUTH11_SHARED; 11472be7d22fSVladimir Kondratiev conn.auth_mode = WMI_AUTH_WPA2_PSK; 11482be7d22fSVladimir Kondratiev conn.pairwise_crypto_type = WMI_CRYPT_AES_GCMP; 11492be7d22fSVladimir Kondratiev conn.pairwise_crypto_len = 16; 1150230d8442SVladimir Kondratiev conn.group_crypto_type = WMI_CRYPT_AES_GCMP; 1151230d8442SVladimir Kondratiev conn.group_crypto_len = 16; 115227aa6b71SVladimir Kondratiev } else { /* WSC */ 115327aa6b71SVladimir Kondratiev conn.dot11_auth_mode = WMI_AUTH11_WSC; 115427aa6b71SVladimir Kondratiev conn.auth_mode = WMI_AUTH_NONE; 115527aa6b71SVladimir Kondratiev } 115627aa6b71SVladimir Kondratiev } else { /* insecure connection */ 11572be7d22fSVladimir Kondratiev conn.dot11_auth_mode = WMI_AUTH11_OPEN; 11582be7d22fSVladimir Kondratiev conn.auth_mode = WMI_AUTH_NONE; 11592be7d22fSVladimir Kondratiev } 11602be7d22fSVladimir Kondratiev 11612be7d22fSVladimir Kondratiev conn.ssid_len = min_t(u8, ssid_eid[1], 32); 11622be7d22fSVladimir Kondratiev memcpy(conn.ssid, ssid_eid+2, conn.ssid_len); 11632be7d22fSVladimir Kondratiev conn.channel = ch - 1; 11642be7d22fSVladimir Kondratiev 1165a82553bbSVladimir Kondratiev ether_addr_copy(conn.bssid, bss->bssid); 1166a82553bbSVladimir Kondratiev ether_addr_copy(conn.dst_mac, bss->bssid); 1167e83eb2fcSVladimir Kondratiev 11685bd60982SLior David set_bit(wil_vif_fwconnecting, vif->status); 11692be7d22fSVladimir Kondratiev 1170e00243faSLior David rc = wmi_send(wil, WMI_CONNECT_CMDID, vif->mid, &conn, sizeof(conn)); 11712be7d22fSVladimir Kondratiev if (rc == 0) { 1172c5e96c91SDedy Lansky netif_carrier_on(ndev); 11735bd60982SLior David if (!wil_has_other_active_ifaces(wil, ndev, false, true)) 11749953a782SLior David wil6210_bus_request(wil, WIL_MAX_BUS_REQUEST_KBPS); 1175e00243faSLior David vif->bss = bss; 11762be7d22fSVladimir Kondratiev /* Connect can take lots of time */ 1177e00243faSLior David mod_timer(&vif->connect_timer, 1178d83ad4c4SLior David jiffies + msecs_to_jiffies(5000)); 1179b338f74eSVladimir Kondratiev } else { 11805bd60982SLior David clear_bit(wil_vif_fwconnecting, vif->status); 11812be7d22fSVladimir Kondratiev } 11822be7d22fSVladimir Kondratiev 11832be7d22fSVladimir Kondratiev out: 11845b112d3dSJohannes Berg cfg80211_put_bss(wiphy, bss); 11852be7d22fSVladimir Kondratiev 11862be7d22fSVladimir Kondratiev return rc; 11872be7d22fSVladimir Kondratiev } 11882be7d22fSVladimir Kondratiev 11892be7d22fSVladimir Kondratiev static int wil_cfg80211_disconnect(struct wiphy *wiphy, 11902be7d22fSVladimir Kondratiev struct net_device *ndev, 11912be7d22fSVladimir Kondratiev u16 reason_code) 11922be7d22fSVladimir Kondratiev { 11932be7d22fSVladimir Kondratiev int rc; 11942be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1195e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 11962be7d22fSVladimir Kondratiev 1197e00243faSLior David wil_dbg_misc(wil, "disconnect: reason=%d, mid=%d\n", 1198e00243faSLior David reason_code, vif->mid); 1199de9084efSVladimir Kondratiev 12005bd60982SLior David if (!(test_bit(wil_vif_fwconnecting, vif->status) || 12015bd60982SLior David test_bit(wil_vif_fwconnected, vif->status))) { 1202af3db60aSLazar Alexei wil_err(wil, "Disconnect was called while disconnected\n"); 120378771d76SVladimir Kondratiev return 0; 120478771d76SVladimir Kondratiev } 120578771d76SVladimir Kondratiev 1206e00243faSLior David vif->locally_generated_disc = true; 1207e00243faSLior David rc = wmi_call(wil, WMI_DISCONNECT_CMDID, vif->mid, NULL, 0, 120878771d76SVladimir Kondratiev WMI_DISCONNECT_EVENTID, NULL, 0, 120978771d76SVladimir Kondratiev WIL6210_DISCONNECT_TO_MS); 121078771d76SVladimir Kondratiev if (rc) 1211af3db60aSLazar Alexei wil_err(wil, "disconnect error %d\n", rc); 12122be7d22fSVladimir Kondratiev 12132be7d22fSVladimir Kondratiev return rc; 12142be7d22fSVladimir Kondratiev } 12152be7d22fSVladimir Kondratiev 12163fea18d0SLior David static int wil_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 12173fea18d0SLior David { 12183fea18d0SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 12193fea18d0SLior David int rc; 12203fea18d0SLior David 12213fea18d0SLior David /* these parameters are explicitly not supported */ 12223fea18d0SLior David if (changed & (WIPHY_PARAM_RETRY_LONG | 12233fea18d0SLior David WIPHY_PARAM_FRAG_THRESHOLD | 12243fea18d0SLior David WIPHY_PARAM_RTS_THRESHOLD)) 12253fea18d0SLior David return -ENOTSUPP; 12263fea18d0SLior David 12273fea18d0SLior David if (changed & WIPHY_PARAM_RETRY_SHORT) { 12283fea18d0SLior David rc = wmi_set_mgmt_retry(wil, wiphy->retry_short); 12293fea18d0SLior David if (rc) 12303fea18d0SLior David return rc; 12313fea18d0SLior David } 12323fea18d0SLior David 12333fea18d0SLior David return 0; 12343fea18d0SLior David } 12353fea18d0SLior David 12360b39aaf2SVladimir Kondratiev int wil_cfg80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, 12371647f12fSVladimir Kondratiev struct cfg80211_mgmt_tx_params *params, 12381647f12fSVladimir Kondratiev u64 *cookie) 12391647f12fSVladimir Kondratiev { 12401647f12fSVladimir Kondratiev const u8 *buf = params->buf; 12411c21cc5fSDedy Lansky size_t len = params->len; 12421647f12fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1243e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 12441647f12fSVladimir Kondratiev int rc; 12451c21cc5fSDedy Lansky bool tx_status; 12461647f12fSVladimir Kondratiev 1247b698e2dfSAhmad Masri wil_dbg_misc(wil, "mgmt_tx: channel %d offchan %d, wait %d\n", 1248b698e2dfSAhmad Masri params->chan ? params->chan->hw_value : -1, 1249b698e2dfSAhmad Masri params->offchan, 1250b698e2dfSAhmad Masri params->wait); 1251b698e2dfSAhmad Masri 1252b698e2dfSAhmad Masri /* Note, currently we support the "wait" parameter only on AP mode. 1253b698e2dfSAhmad Masri * In other modes, user-space must call remain_on_channel before 1254b698e2dfSAhmad Masri * mgmt_tx or listen on a channel other than active one. 1255e6d68341SDedy Lansky */ 1256e6d68341SDedy Lansky 1257b698e2dfSAhmad Masri if (params->chan && params->chan->hw_value == 0) { 1258b698e2dfSAhmad Masri wil_err(wil, "invalid channel\n"); 1259b698e2dfSAhmad Masri return -EINVAL; 1260b698e2dfSAhmad Masri } 1261e6d68341SDedy Lansky 1262b698e2dfSAhmad Masri if (wdev->iftype != NL80211_IFTYPE_AP) { 1263b698e2dfSAhmad Masri wil_dbg_misc(wil, 1264b698e2dfSAhmad Masri "send WMI_SW_TX_REQ_CMDID on non-AP interfaces\n"); 1265b698e2dfSAhmad Masri rc = wmi_mgmt_tx(vif, buf, len); 1266b698e2dfSAhmad Masri goto out; 1267b698e2dfSAhmad Masri } 1268b698e2dfSAhmad Masri 1269b698e2dfSAhmad Masri if (!params->chan || params->chan->hw_value == vif->channel) { 1270b698e2dfSAhmad Masri wil_dbg_misc(wil, 1271b698e2dfSAhmad Masri "send WMI_SW_TX_REQ_CMDID for on-channel\n"); 1272b698e2dfSAhmad Masri rc = wmi_mgmt_tx(vif, buf, len); 1273b698e2dfSAhmad Masri goto out; 1274b698e2dfSAhmad Masri } 1275b698e2dfSAhmad Masri 1276b698e2dfSAhmad Masri if (params->offchan == 0) { 1277b698e2dfSAhmad Masri wil_err(wil, 1278b698e2dfSAhmad Masri "invalid channel params: current %d requested %d, off-channel not allowed\n", 1279b698e2dfSAhmad Masri vif->channel, params->chan->hw_value); 1280b698e2dfSAhmad Masri return -EBUSY; 1281b698e2dfSAhmad Masri } 1282b698e2dfSAhmad Masri 1283b698e2dfSAhmad Masri /* use the wmi_mgmt_tx_ext only on AP mode and off-channel */ 1284b698e2dfSAhmad Masri rc = wmi_mgmt_tx_ext(vif, buf, len, params->chan->hw_value, 1285b698e2dfSAhmad Masri params->wait); 1286b698e2dfSAhmad Masri 1287b698e2dfSAhmad Masri out: 128849122ec4SLior David /* when the sent packet was not acked by receiver(ACK=0), rc will 128949122ec4SLior David * be -EAGAIN. In this case this function needs to return success, 129049122ec4SLior David * the ACK=0 will be reflected in tx_status. 129149122ec4SLior David */ 1292b698e2dfSAhmad Masri tx_status = (rc == 0); 129349122ec4SLior David rc = (rc == -EAGAIN) ? 0 : rc; 1294304464f4SVladimir Kondratiev cfg80211_mgmt_tx_status(wdev, cookie ? *cookie : 0, buf, len, 1295304464f4SVladimir Kondratiev tx_status, GFP_KERNEL); 1296b698e2dfSAhmad Masri 12971647f12fSVladimir Kondratiev return rc; 12981647f12fSVladimir Kondratiev } 12991647f12fSVladimir Kondratiev 13002be7d22fSVladimir Kondratiev static int wil_cfg80211_set_channel(struct wiphy *wiphy, 13012be7d22fSVladimir Kondratiev struct cfg80211_chan_def *chandef) 13022be7d22fSVladimir Kondratiev { 13032be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 13042be7d22fSVladimir Kondratiev 13057d3e4dbeSLior David wil->monitor_chandef = *chandef; 13062be7d22fSVladimir Kondratiev 13072be7d22fSVladimir Kondratiev return 0; 13082be7d22fSVladimir Kondratiev } 13092be7d22fSVladimir Kondratiev 1310e00243faSLior David static enum wmi_key_usage wil_detect_key_usage(struct wireless_dev *wdev, 1311230d8442SVladimir Kondratiev bool pairwise) 1312230d8442SVladimir Kondratiev { 1313e00243faSLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 1314230d8442SVladimir Kondratiev enum wmi_key_usage rc; 1315230d8442SVladimir Kondratiev 1316230d8442SVladimir Kondratiev if (pairwise) { 1317230d8442SVladimir Kondratiev rc = WMI_KEY_USE_PAIRWISE; 1318230d8442SVladimir Kondratiev } else { 1319230d8442SVladimir Kondratiev switch (wdev->iftype) { 1320230d8442SVladimir Kondratiev case NL80211_IFTYPE_STATION: 1321e6d68341SDedy Lansky case NL80211_IFTYPE_P2P_CLIENT: 1322230d8442SVladimir Kondratiev rc = WMI_KEY_USE_RX_GROUP; 1323230d8442SVladimir Kondratiev break; 1324230d8442SVladimir Kondratiev case NL80211_IFTYPE_AP: 1325e6d68341SDedy Lansky case NL80211_IFTYPE_P2P_GO: 1326230d8442SVladimir Kondratiev rc = WMI_KEY_USE_TX_GROUP; 1327230d8442SVladimir Kondratiev break; 1328230d8442SVladimir Kondratiev default: 1329230d8442SVladimir Kondratiev /* TODO: Rx GTK or Tx GTK? */ 1330230d8442SVladimir Kondratiev wil_err(wil, "Can't determine GTK type\n"); 1331230d8442SVladimir Kondratiev rc = WMI_KEY_USE_RX_GROUP; 1332230d8442SVladimir Kondratiev break; 1333230d8442SVladimir Kondratiev } 1334230d8442SVladimir Kondratiev } 1335af3db60aSLazar Alexei wil_dbg_misc(wil, "detect_key_usage: -> %s\n", key_usage_str[rc]); 1336230d8442SVladimir Kondratiev 1337230d8442SVladimir Kondratiev return rc; 1338230d8442SVladimir Kondratiev } 1339230d8442SVladimir Kondratiev 134074b6ac58SMaya Erez static struct wil_sta_info * 1341e00243faSLior David wil_find_sta_by_key_usage(struct wil6210_priv *wil, u8 mid, 134258527421SVladimir Kondratiev enum wmi_key_usage key_usage, const u8 *mac_addr) 134358527421SVladimir Kondratiev { 134458527421SVladimir Kondratiev int cid = -EINVAL; 134558527421SVladimir Kondratiev 134658527421SVladimir Kondratiev if (key_usage == WMI_KEY_USE_TX_GROUP) 134758527421SVladimir Kondratiev return NULL; /* not needed */ 134858527421SVladimir Kondratiev 134958527421SVladimir Kondratiev /* supplicant provides Rx group key in STA mode with NULL MAC address */ 135058527421SVladimir Kondratiev if (mac_addr) 1351e00243faSLior David cid = wil_find_cid(wil, mid, mac_addr); 135258527421SVladimir Kondratiev else if (key_usage == WMI_KEY_USE_RX_GROUP) 1353e00243faSLior David cid = wil_find_cid_by_idx(wil, mid, 0); 135458527421SVladimir Kondratiev if (cid < 0) { 135574b6ac58SMaya Erez wil_err(wil, "No CID for %pM %s\n", mac_addr, 135674b6ac58SMaya Erez key_usage_str[key_usage]); 135758527421SVladimir Kondratiev return ERR_PTR(cid); 135858527421SVladimir Kondratiev } 135958527421SVladimir Kondratiev 136074b6ac58SMaya Erez return &wil->sta[cid]; 136174b6ac58SMaya Erez } 136258527421SVladimir Kondratiev 1363b9010f10SAhmad Masri void wil_set_crypto_rx(u8 key_index, enum wmi_key_usage key_usage, 136474b6ac58SMaya Erez struct wil_sta_info *cs, 136574b6ac58SMaya Erez struct key_params *params) 136674b6ac58SMaya Erez { 136774b6ac58SMaya Erez struct wil_tid_crypto_rx_single *cc; 136874b6ac58SMaya Erez int tid; 136974b6ac58SMaya Erez 137074b6ac58SMaya Erez if (!cs) 137174b6ac58SMaya Erez return; 137274b6ac58SMaya Erez 137374b6ac58SMaya Erez switch (key_usage) { 137474b6ac58SMaya Erez case WMI_KEY_USE_PAIRWISE: 137574b6ac58SMaya Erez for (tid = 0; tid < WIL_STA_TID_NUM; tid++) { 137674b6ac58SMaya Erez cc = &cs->tid_crypto_rx[tid].key_id[key_index]; 137774b6ac58SMaya Erez if (params->seq) 137874b6ac58SMaya Erez memcpy(cc->pn, params->seq, 137974b6ac58SMaya Erez IEEE80211_GCMP_PN_LEN); 138074b6ac58SMaya Erez else 138174b6ac58SMaya Erez memset(cc->pn, 0, IEEE80211_GCMP_PN_LEN); 138274b6ac58SMaya Erez cc->key_set = true; 138374b6ac58SMaya Erez } 138474b6ac58SMaya Erez break; 138574b6ac58SMaya Erez case WMI_KEY_USE_RX_GROUP: 138674b6ac58SMaya Erez cc = &cs->group_crypto_rx.key_id[key_index]; 138774b6ac58SMaya Erez if (params->seq) 138874b6ac58SMaya Erez memcpy(cc->pn, params->seq, IEEE80211_GCMP_PN_LEN); 138974b6ac58SMaya Erez else 139074b6ac58SMaya Erez memset(cc->pn, 0, IEEE80211_GCMP_PN_LEN); 139174b6ac58SMaya Erez cc->key_set = true; 139274b6ac58SMaya Erez break; 139374b6ac58SMaya Erez default: 139474b6ac58SMaya Erez break; 139574b6ac58SMaya Erez } 139674b6ac58SMaya Erez } 139774b6ac58SMaya Erez 139874b6ac58SMaya Erez static void wil_del_rx_key(u8 key_index, enum wmi_key_usage key_usage, 139974b6ac58SMaya Erez struct wil_sta_info *cs) 140074b6ac58SMaya Erez { 140174b6ac58SMaya Erez struct wil_tid_crypto_rx_single *cc; 140274b6ac58SMaya Erez int tid; 140374b6ac58SMaya Erez 140474b6ac58SMaya Erez if (!cs) 140574b6ac58SMaya Erez return; 140674b6ac58SMaya Erez 140774b6ac58SMaya Erez switch (key_usage) { 140874b6ac58SMaya Erez case WMI_KEY_USE_PAIRWISE: 140974b6ac58SMaya Erez for (tid = 0; tid < WIL_STA_TID_NUM; tid++) { 141074b6ac58SMaya Erez cc = &cs->tid_crypto_rx[tid].key_id[key_index]; 141174b6ac58SMaya Erez cc->key_set = false; 141274b6ac58SMaya Erez } 141374b6ac58SMaya Erez break; 141474b6ac58SMaya Erez case WMI_KEY_USE_RX_GROUP: 141574b6ac58SMaya Erez cc = &cs->group_crypto_rx.key_id[key_index]; 141674b6ac58SMaya Erez cc->key_set = false; 141774b6ac58SMaya Erez break; 141874b6ac58SMaya Erez default: 141974b6ac58SMaya Erez break; 142074b6ac58SMaya Erez } 142158527421SVladimir Kondratiev } 142258527421SVladimir Kondratiev 14232be7d22fSVladimir Kondratiev static int wil_cfg80211_add_key(struct wiphy *wiphy, 14242be7d22fSVladimir Kondratiev struct net_device *ndev, 14252be7d22fSVladimir Kondratiev u8 key_index, bool pairwise, 14262be7d22fSVladimir Kondratiev const u8 *mac_addr, 14272be7d22fSVladimir Kondratiev struct key_params *params) 14282be7d22fSVladimir Kondratiev { 142958527421SVladimir Kondratiev int rc; 1430e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 14312be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1432e00243faSLior David struct wireless_dev *wdev = vif_to_wdev(vif); 1433e00243faSLior David enum wmi_key_usage key_usage = wil_detect_key_usage(wdev, pairwise); 1434e00243faSLior David struct wil_sta_info *cs = wil_find_sta_by_key_usage(wil, vif->mid, 1435e00243faSLior David key_usage, 143658527421SVladimir Kondratiev mac_addr); 14372be7d22fSVladimir Kondratiev 143874b6ac58SMaya Erez if (!params) { 143974b6ac58SMaya Erez wil_err(wil, "NULL params\n"); 144074b6ac58SMaya Erez return -EINVAL; 144174b6ac58SMaya Erez } 144274b6ac58SMaya Erez 1443af3db60aSLazar Alexei wil_dbg_misc(wil, "add_key: %pM %s[%d] PN %*phN\n", 144458527421SVladimir Kondratiev mac_addr, key_usage_str[key_usage], key_index, 144558527421SVladimir Kondratiev params->seq_len, params->seq); 1446db8adcbfSVladimir Kondratiev 144774b6ac58SMaya Erez if (IS_ERR(cs)) { 1448b9010f10SAhmad Masri /* in FT, sta info may not be available as add_key may be 1449b9010f10SAhmad Masri * sent by host before FW sends WMI_CONNECT_EVENT 1450b9010f10SAhmad Masri */ 1451b9010f10SAhmad Masri if (!test_bit(wil_vif_ft_roam, vif->status)) { 1452af3db60aSLazar Alexei wil_err(wil, "Not connected, %pM %s[%d] PN %*phN\n", 1453af3db60aSLazar Alexei mac_addr, key_usage_str[key_usage], key_index, 145458527421SVladimir Kondratiev params->seq_len, params->seq); 145558527421SVladimir Kondratiev return -EINVAL; 145658527421SVladimir Kondratiev } 1457b9010f10SAhmad Masri } 145858527421SVladimir Kondratiev 1459b9010f10SAhmad Masri if (!IS_ERR(cs)) 146074b6ac58SMaya Erez wil_del_rx_key(key_index, key_usage, cs); 146158527421SVladimir Kondratiev 146258527421SVladimir Kondratiev if (params->seq && params->seq_len != IEEE80211_GCMP_PN_LEN) { 146358527421SVladimir Kondratiev wil_err(wil, 1464af3db60aSLazar Alexei "Wrong PN len %d, %pM %s[%d] PN %*phN\n", 1465af3db60aSLazar Alexei params->seq_len, mac_addr, 146658527421SVladimir Kondratiev key_usage_str[key_usage], key_index, 146758527421SVladimir Kondratiev params->seq_len, params->seq); 146858527421SVladimir Kondratiev return -EINVAL; 146958527421SVladimir Kondratiev } 147058527421SVladimir Kondratiev 1471e00243faSLior David rc = wmi_add_cipher_key(vif, key_index, mac_addr, params->key_len, 1472230d8442SVladimir Kondratiev params->key, key_usage); 1473e41ab937SDedy Lansky if (!rc && !IS_ERR(cs)) { 1474e41ab937SDedy Lansky /* update local storage used for AP recovery */ 1475e41ab937SDedy Lansky if (key_usage == WMI_KEY_USE_TX_GROUP && params->key && 1476e41ab937SDedy Lansky params->key_len <= WMI_MAX_KEY_LEN) { 1477e41ab937SDedy Lansky vif->gtk_index = key_index; 1478e41ab937SDedy Lansky memcpy(vif->gtk, params->key, params->key_len); 1479e41ab937SDedy Lansky vif->gtk_len = params->key_len; 1480e41ab937SDedy Lansky } 1481b9010f10SAhmad Masri /* in FT set crypto will take place upon receiving 1482b9010f10SAhmad Masri * WMI_RING_EN_EVENTID event 1483b9010f10SAhmad Masri */ 148474b6ac58SMaya Erez wil_set_crypto_rx(key_index, key_usage, cs, params); 1485e41ab937SDedy Lansky } 148658527421SVladimir Kondratiev 148758527421SVladimir Kondratiev return rc; 14882be7d22fSVladimir Kondratiev } 14892be7d22fSVladimir Kondratiev 14902be7d22fSVladimir Kondratiev static int wil_cfg80211_del_key(struct wiphy *wiphy, 14912be7d22fSVladimir Kondratiev struct net_device *ndev, 14922be7d22fSVladimir Kondratiev u8 key_index, bool pairwise, 14932be7d22fSVladimir Kondratiev const u8 *mac_addr) 14942be7d22fSVladimir Kondratiev { 1495e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 14962be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1497e00243faSLior David struct wireless_dev *wdev = vif_to_wdev(vif); 1498e00243faSLior David enum wmi_key_usage key_usage = wil_detect_key_usage(wdev, pairwise); 1499e00243faSLior David struct wil_sta_info *cs = wil_find_sta_by_key_usage(wil, vif->mid, 1500e00243faSLior David key_usage, 150158527421SVladimir Kondratiev mac_addr); 15022be7d22fSVladimir Kondratiev 1503af3db60aSLazar Alexei wil_dbg_misc(wil, "del_key: %pM %s[%d]\n", mac_addr, 150458527421SVladimir Kondratiev key_usage_str[key_usage], key_index); 150558527421SVladimir Kondratiev 150674b6ac58SMaya Erez if (IS_ERR(cs)) 1507af3db60aSLazar Alexei wil_info(wil, "Not connected, %pM %s[%d]\n", 150858527421SVladimir Kondratiev mac_addr, key_usage_str[key_usage], key_index); 150958527421SVladimir Kondratiev 151074b6ac58SMaya Erez if (!IS_ERR_OR_NULL(cs)) 151174b6ac58SMaya Erez wil_del_rx_key(key_index, key_usage, cs); 1512db8adcbfSVladimir Kondratiev 1513e00243faSLior David return wmi_del_cipher_key(vif, key_index, mac_addr, key_usage); 15142be7d22fSVladimir Kondratiev } 15152be7d22fSVladimir Kondratiev 15162be7d22fSVladimir Kondratiev /* Need to be present or wiphy_new() will WARN */ 15172be7d22fSVladimir Kondratiev static int wil_cfg80211_set_default_key(struct wiphy *wiphy, 15182be7d22fSVladimir Kondratiev struct net_device *ndev, 15192be7d22fSVladimir Kondratiev u8 key_index, bool unicast, 15202be7d22fSVladimir Kondratiev bool multicast) 15212be7d22fSVladimir Kondratiev { 1522280ab987SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1523280ab987SLior David 1524af3db60aSLazar Alexei wil_dbg_misc(wil, "set_default_key: entered\n"); 15252be7d22fSVladimir Kondratiev return 0; 15262be7d22fSVladimir Kondratiev } 15272be7d22fSVladimir Kondratiev 15281647f12fSVladimir Kondratiev static int wil_remain_on_channel(struct wiphy *wiphy, 15291647f12fSVladimir Kondratiev struct wireless_dev *wdev, 15301647f12fSVladimir Kondratiev struct ieee80211_channel *chan, 15311647f12fSVladimir Kondratiev unsigned int duration, 15321647f12fSVladimir Kondratiev u64 *cookie) 15331647f12fSVladimir Kondratiev { 15341647f12fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 15351647f12fSVladimir Kondratiev int rc; 15361647f12fSVladimir Kondratiev 1537af3db60aSLazar Alexei wil_dbg_misc(wil, 1538af3db60aSLazar Alexei "remain_on_channel: center_freq=%d, duration=%d iftype=%d\n", 1539af3db60aSLazar Alexei chan->center_freq, duration, wdev->iftype); 15401647f12fSVladimir Kondratiev 1541bb6743f7SLior David rc = wil_p2p_listen(wil, wdev, duration, chan, cookie); 15421647f12fSVladimir Kondratiev return rc; 15431647f12fSVladimir Kondratiev } 15441647f12fSVladimir Kondratiev 15451647f12fSVladimir Kondratiev static int wil_cancel_remain_on_channel(struct wiphy *wiphy, 15461647f12fSVladimir Kondratiev struct wireless_dev *wdev, 15471647f12fSVladimir Kondratiev u64 cookie) 15481647f12fSVladimir Kondratiev { 15491647f12fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1550e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 15511647f12fSVladimir Kondratiev 1552af3db60aSLazar Alexei wil_dbg_misc(wil, "cancel_remain_on_channel\n"); 15531647f12fSVladimir Kondratiev 1554e00243faSLior David return wil_p2p_cancel_listen(vif, cookie); 15551647f12fSVladimir Kondratiev } 15561647f12fSVladimir Kondratiev 1557c100c883SLior David /** 1558c100c883SLior David * find a specific IE in a list of IEs 1559c100c883SLior David * return a pointer to the beginning of IE in the list 1560c100c883SLior David * or NULL if not found 1561c100c883SLior David */ 1562c100c883SLior David static const u8 *_wil_cfg80211_find_ie(const u8 *ies, u16 ies_len, const u8 *ie, 1563c100c883SLior David u16 ie_len) 1564c100c883SLior David { 1565c100c883SLior David struct ieee80211_vendor_ie *vie; 1566c100c883SLior David u32 oui; 1567c100c883SLior David 1568c100c883SLior David /* IE tag at offset 0, length at offset 1 */ 1569c100c883SLior David if (ie_len < 2 || 2 + ie[1] > ie_len) 1570c100c883SLior David return NULL; 1571c100c883SLior David 1572c100c883SLior David if (ie[0] != WLAN_EID_VENDOR_SPECIFIC) 1573c100c883SLior David return cfg80211_find_ie(ie[0], ies, ies_len); 1574c100c883SLior David 1575c100c883SLior David /* make sure there is room for 3 bytes OUI + 1 byte OUI type */ 1576c100c883SLior David if (ie[1] < 4) 1577c100c883SLior David return NULL; 1578c100c883SLior David vie = (struct ieee80211_vendor_ie *)ie; 1579c100c883SLior David oui = vie->oui[0] << 16 | vie->oui[1] << 8 | vie->oui[2]; 1580c100c883SLior David return cfg80211_find_vendor_ie(oui, vie->oui_type, ies, 1581c100c883SLior David ies_len); 1582c100c883SLior David } 1583c100c883SLior David 1584c100c883SLior David /** 1585c100c883SLior David * merge the IEs in two lists into a single list. 1586c100c883SLior David * do not include IEs from the second list which exist in the first list. 1587c100c883SLior David * add only vendor specific IEs from second list to keep 1588c100c883SLior David * the merged list sorted (since vendor-specific IE has the 1589c100c883SLior David * highest tag number) 1590c100c883SLior David * caller must free the allocated memory for merged IEs 1591c100c883SLior David */ 1592c100c883SLior David static int _wil_cfg80211_merge_extra_ies(const u8 *ies1, u16 ies1_len, 1593c100c883SLior David const u8 *ies2, u16 ies2_len, 1594c100c883SLior David u8 **merged_ies, u16 *merged_len) 1595c100c883SLior David { 1596c100c883SLior David u8 *buf, *dpos; 1597c100c883SLior David const u8 *spos; 1598c100c883SLior David 1599de77a53cSAlexei Avshalom Lazar if (!ies1) 1600de77a53cSAlexei Avshalom Lazar ies1_len = 0; 1601de77a53cSAlexei Avshalom Lazar 1602de77a53cSAlexei Avshalom Lazar if (!ies2) 1603de77a53cSAlexei Avshalom Lazar ies2_len = 0; 1604de77a53cSAlexei Avshalom Lazar 1605c100c883SLior David if (ies1_len == 0 && ies2_len == 0) { 1606c100c883SLior David *merged_ies = NULL; 1607c100c883SLior David *merged_len = 0; 1608c100c883SLior David return 0; 1609c100c883SLior David } 1610c100c883SLior David 1611c100c883SLior David buf = kmalloc(ies1_len + ies2_len, GFP_KERNEL); 1612c100c883SLior David if (!buf) 1613c100c883SLior David return -ENOMEM; 1614de77a53cSAlexei Avshalom Lazar if (ies1) 1615c100c883SLior David memcpy(buf, ies1, ies1_len); 1616c100c883SLior David dpos = buf + ies1_len; 1617c100c883SLior David spos = ies2; 1618de77a53cSAlexei Avshalom Lazar while (spos && (spos + 1 < ies2 + ies2_len)) { 1619c100c883SLior David /* IE tag at offset 0, length at offset 1 */ 1620c100c883SLior David u16 ielen = 2 + spos[1]; 1621c100c883SLior David 1622c100c883SLior David if (spos + ielen > ies2 + ies2_len) 1623c100c883SLior David break; 1624c100c883SLior David if (spos[0] == WLAN_EID_VENDOR_SPECIFIC && 1625de77a53cSAlexei Avshalom Lazar (!ies1 || !_wil_cfg80211_find_ie(ies1, ies1_len, 1626de77a53cSAlexei Avshalom Lazar spos, ielen))) { 1627c100c883SLior David memcpy(dpos, spos, ielen); 1628c100c883SLior David dpos += ielen; 1629c100c883SLior David } 1630c100c883SLior David spos += ielen; 1631c100c883SLior David } 1632c100c883SLior David 1633c100c883SLior David *merged_ies = buf; 1634c100c883SLior David *merged_len = dpos - buf; 1635c100c883SLior David return 0; 1636c100c883SLior David } 1637c100c883SLior David 1638ca959773SVladimir Kondratiev static void wil_print_bcon_data(struct cfg80211_beacon_data *b) 1639ca959773SVladimir Kondratiev { 16405eb443e9SDedy Lansky wil_hex_dump_misc("head ", DUMP_PREFIX_OFFSET, 16, 1, 16415eb443e9SDedy Lansky b->head, b->head_len, true); 16425eb443e9SDedy Lansky wil_hex_dump_misc("tail ", DUMP_PREFIX_OFFSET, 16, 1, 16435eb443e9SDedy Lansky b->tail, b->tail_len, true); 16445eb443e9SDedy Lansky wil_hex_dump_misc("BCON IE ", DUMP_PREFIX_OFFSET, 16, 1, 16455eb443e9SDedy Lansky b->beacon_ies, b->beacon_ies_len, true); 16465eb443e9SDedy Lansky wil_hex_dump_misc("PROBE ", DUMP_PREFIX_OFFSET, 16, 1, 16475eb443e9SDedy Lansky b->probe_resp, b->probe_resp_len, true); 16485eb443e9SDedy Lansky wil_hex_dump_misc("PROBE IE ", DUMP_PREFIX_OFFSET, 16, 1, 16495eb443e9SDedy Lansky b->proberesp_ies, b->proberesp_ies_len, true); 16505eb443e9SDedy Lansky wil_hex_dump_misc("ASSOC IE ", DUMP_PREFIX_OFFSET, 16, 1, 16515eb443e9SDedy Lansky b->assocresp_ies, b->assocresp_ies_len, true); 1652ca959773SVladimir Kondratiev } 1653ca959773SVladimir Kondratiev 165433190ebfSVladimir Kondratiev /* internal functions for device reset and starting AP */ 1655b9010f10SAhmad Masri static u8 * 1656b9010f10SAhmad Masri _wil_cfg80211_get_proberesp_ies(const u8 *proberesp, u16 proberesp_len, 1657b9010f10SAhmad Masri u16 *ies_len) 1658b9010f10SAhmad Masri { 1659b9010f10SAhmad Masri u8 *ies = NULL; 1660b9010f10SAhmad Masri 1661b9010f10SAhmad Masri if (proberesp) { 1662b9010f10SAhmad Masri struct ieee80211_mgmt *f = 1663b9010f10SAhmad Masri (struct ieee80211_mgmt *)proberesp; 1664b9010f10SAhmad Masri size_t hlen = offsetof(struct ieee80211_mgmt, 1665b9010f10SAhmad Masri u.probe_resp.variable); 1666b9010f10SAhmad Masri 1667b9010f10SAhmad Masri ies = f->u.probe_resp.variable; 1668b9010f10SAhmad Masri if (ies_len) 1669b9010f10SAhmad Masri *ies_len = proberesp_len - hlen; 1670b9010f10SAhmad Masri } 1671b9010f10SAhmad Masri 1672b9010f10SAhmad Masri return ies; 1673b9010f10SAhmad Masri } 1674b9010f10SAhmad Masri 1675e00243faSLior David static int _wil_cfg80211_set_ies(struct wil6210_vif *vif, 1676cab5abbfSVladimir Kondratiev struct cfg80211_beacon_data *bcon) 167733190ebfSVladimir Kondratiev { 167833190ebfSVladimir Kondratiev int rc; 1679c100c883SLior David u16 len = 0, proberesp_len = 0; 1680b9010f10SAhmad Masri u8 *ies = NULL, *proberesp; 168133190ebfSVladimir Kondratiev 1682e41ab937SDedy Lansky /* update local storage used for AP recovery */ 1683e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp, &vif->proberesp_len, bcon->probe_resp, 1684e41ab937SDedy Lansky bcon->probe_resp_len); 1685e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp_ies, &vif->proberesp_ies_len, 1686e41ab937SDedy Lansky bcon->proberesp_ies, bcon->proberesp_ies_len); 1687e41ab937SDedy Lansky wil_memdup_ie(&vif->assocresp_ies, &vif->assocresp_ies_len, 1688e41ab937SDedy Lansky bcon->assocresp_ies, bcon->assocresp_ies_len); 1689e41ab937SDedy Lansky 1690b9010f10SAhmad Masri proberesp = _wil_cfg80211_get_proberesp_ies(bcon->probe_resp, 1691b9010f10SAhmad Masri bcon->probe_resp_len, 1692b9010f10SAhmad Masri &proberesp_len); 1693c100c883SLior David rc = _wil_cfg80211_merge_extra_ies(proberesp, 1694c100c883SLior David proberesp_len, 1695c100c883SLior David bcon->proberesp_ies, 1696c100c883SLior David bcon->proberesp_ies_len, 1697c100c883SLior David &ies, &len); 1698c100c883SLior David 16995421bf0cSVladimir Kondratiev if (rc) 1700c100c883SLior David goto out; 170133190ebfSVladimir Kondratiev 1702e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_PROBE_RESP, len, ies); 1703c100c883SLior David if (rc) 1704c100c883SLior David goto out; 1705c100c883SLior David 1706c100c883SLior David if (bcon->assocresp_ies) 1707e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_ASSOC_RESP, 1708c100c883SLior David bcon->assocresp_ies_len, bcon->assocresp_ies); 1709c100c883SLior David else 1710e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_ASSOC_RESP, len, ies); 1711cab5abbfSVladimir Kondratiev #if 0 /* to use beacon IE's, remove this #if 0 */ 17125421bf0cSVladimir Kondratiev if (rc) 1713c100c883SLior David goto out; 17145421bf0cSVladimir Kondratiev 1715e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_BEACON, 1716e00243faSLior David bcon->tail_len, bcon->tail); 1717cab5abbfSVladimir Kondratiev #endif 1718c100c883SLior David out: 1719c100c883SLior David kfree(ies); 17205421bf0cSVladimir Kondratiev return rc; 172133190ebfSVladimir Kondratiev } 172233190ebfSVladimir Kondratiev 172333190ebfSVladimir Kondratiev static int _wil_cfg80211_start_ap(struct wiphy *wiphy, 172433190ebfSVladimir Kondratiev struct net_device *ndev, 172533190ebfSVladimir Kondratiev const u8 *ssid, size_t ssid_len, u32 privacy, 172633190ebfSVladimir Kondratiev int bi, u8 chan, 1727cab5abbfSVladimir Kondratiev struct cfg80211_beacon_data *bcon, 1728eabb03b4SLior David u8 hidden_ssid, u32 pbss) 172933190ebfSVladimir Kondratiev { 173033190ebfSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1731e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 173233190ebfSVladimir Kondratiev int rc; 173333190ebfSVladimir Kondratiev struct wireless_dev *wdev = ndev->ieee80211_ptr; 173433190ebfSVladimir Kondratiev u8 wmi_nettype = wil_iftype_nl2wmi(wdev->iftype); 1735b4944f2cSLior David u8 is_go = (wdev->iftype == NL80211_IFTYPE_P2P_GO); 1736b9010f10SAhmad Masri u16 proberesp_len = 0; 1737b9010f10SAhmad Masri u8 *proberesp; 1738b9010f10SAhmad Masri bool ft = false; 173933190ebfSVladimir Kondratiev 1740eabb03b4SLior David if (pbss) 1741eabb03b4SLior David wmi_nettype = WMI_NETTYPE_P2P; 1742eabb03b4SLior David 1743e00243faSLior David wil_dbg_misc(wil, "start_ap: mid=%d, is_go=%d\n", vif->mid, is_go); 1744b4944f2cSLior David if (is_go && !pbss) { 1745af3db60aSLazar Alexei wil_err(wil, "P2P GO must be in PBSS\n"); 1746b4944f2cSLior David return -ENOTSUPP; 1747b4944f2cSLior David } 1748b4944f2cSLior David 174933190ebfSVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 175033190ebfSVladimir Kondratiev 1751b9010f10SAhmad Masri proberesp = _wil_cfg80211_get_proberesp_ies(bcon->probe_resp, 1752b9010f10SAhmad Masri bcon->probe_resp_len, 1753b9010f10SAhmad Masri &proberesp_len); 1754b9010f10SAhmad Masri /* check that the probe response IEs has a MDE */ 1755b9010f10SAhmad Masri if ((proberesp && proberesp_len > 0 && 1756b9010f10SAhmad Masri cfg80211_find_ie(WLAN_EID_MOBILITY_DOMAIN, 1757b9010f10SAhmad Masri proberesp, 1758b9010f10SAhmad Masri proberesp_len))) 1759b9010f10SAhmad Masri ft = true; 1760b9010f10SAhmad Masri 1761b9010f10SAhmad Masri if (ft) { 1762b9010f10SAhmad Masri if (!test_bit(WMI_FW_CAPABILITY_FT_ROAMING, 1763b9010f10SAhmad Masri wil->fw_capabilities)) { 1764b9010f10SAhmad Masri wil_err(wil, "FW does not support FT roaming\n"); 1765b9010f10SAhmad Masri return -ENOTSUPP; 1766b9010f10SAhmad Masri } 1767b9010f10SAhmad Masri set_bit(wil_vif_ft_roam, vif->status); 1768b9010f10SAhmad Masri } 1769b9010f10SAhmad Masri 177033190ebfSVladimir Kondratiev mutex_lock(&wil->mutex); 177133190ebfSVladimir Kondratiev 17723ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, true, false)) { 177333190ebfSVladimir Kondratiev __wil_down(wil); 177433190ebfSVladimir Kondratiev rc = __wil_up(wil); 177533190ebfSVladimir Kondratiev if (rc) 177633190ebfSVladimir Kondratiev goto out; 17773ada9314SLior David } 177833190ebfSVladimir Kondratiev 1779e00243faSLior David rc = wmi_set_ssid(vif, ssid_len, ssid); 178033190ebfSVladimir Kondratiev if (rc) 178133190ebfSVladimir Kondratiev goto out; 178233190ebfSVladimir Kondratiev 1783e00243faSLior David rc = _wil_cfg80211_set_ies(vif, bcon); 178433190ebfSVladimir Kondratiev if (rc) 178533190ebfSVladimir Kondratiev goto out; 178633190ebfSVladimir Kondratiev 1787e00243faSLior David vif->privacy = privacy; 1788e00243faSLior David vif->channel = chan; 1789e00243faSLior David vif->hidden_ssid = hidden_ssid; 1790e00243faSLior David vif->pbss = pbss; 1791e41ab937SDedy Lansky vif->bi = bi; 1792e41ab937SDedy Lansky memcpy(vif->ssid, ssid, ssid_len); 1793e41ab937SDedy Lansky vif->ssid_len = ssid_len; 179433190ebfSVladimir Kondratiev 179533190ebfSVladimir Kondratiev netif_carrier_on(ndev); 17963ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, false, true)) 17979953a782SLior David wil6210_bus_request(wil, WIL_MAX_BUS_REQUEST_KBPS); 179833190ebfSVladimir Kondratiev 1799e00243faSLior David rc = wmi_pcp_start(vif, bi, wmi_nettype, chan, hidden_ssid, is_go); 180033190ebfSVladimir Kondratiev if (rc) 180133190ebfSVladimir Kondratiev goto err_pcp_start; 180233190ebfSVladimir Kondratiev 1803e00243faSLior David rc = wil_bcast_init(vif); 180433190ebfSVladimir Kondratiev if (rc) 180533190ebfSVladimir Kondratiev goto err_bcast; 180633190ebfSVladimir Kondratiev 180733190ebfSVladimir Kondratiev goto out; /* success */ 180833190ebfSVladimir Kondratiev 180933190ebfSVladimir Kondratiev err_bcast: 1810e00243faSLior David wmi_pcp_stop(vif); 181133190ebfSVladimir Kondratiev err_pcp_start: 181233190ebfSVladimir Kondratiev netif_carrier_off(ndev); 18133ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, false, true)) 18149953a782SLior David wil6210_bus_request(wil, WIL_DEFAULT_BUS_REQUEST_KBPS); 181533190ebfSVladimir Kondratiev out: 181633190ebfSVladimir Kondratiev mutex_unlock(&wil->mutex); 181733190ebfSVladimir Kondratiev return rc; 181833190ebfSVladimir Kondratiev } 181933190ebfSVladimir Kondratiev 1820e41ab937SDedy Lansky void wil_cfg80211_ap_recovery(struct wil6210_priv *wil) 1821e41ab937SDedy Lansky { 1822e41ab937SDedy Lansky int rc, i; 1823e41ab937SDedy Lansky struct wiphy *wiphy = wil_to_wiphy(wil); 1824e41ab937SDedy Lansky 1825e4a29bddSAhmad Masri for (i = 0; i < GET_MAX_VIFS(wil); i++) { 1826e41ab937SDedy Lansky struct wil6210_vif *vif = wil->vifs[i]; 1827e41ab937SDedy Lansky struct net_device *ndev; 1828e41ab937SDedy Lansky struct cfg80211_beacon_data bcon = {}; 1829e41ab937SDedy Lansky struct key_params key_params = {}; 1830e41ab937SDedy Lansky 1831e41ab937SDedy Lansky if (!vif || vif->ssid_len == 0) 1832e41ab937SDedy Lansky continue; 1833e41ab937SDedy Lansky 1834e41ab937SDedy Lansky ndev = vif_to_ndev(vif); 1835e41ab937SDedy Lansky bcon.proberesp_ies = vif->proberesp_ies; 1836e41ab937SDedy Lansky bcon.assocresp_ies = vif->assocresp_ies; 1837e41ab937SDedy Lansky bcon.probe_resp = vif->proberesp; 1838e41ab937SDedy Lansky bcon.proberesp_ies_len = vif->proberesp_ies_len; 1839e41ab937SDedy Lansky bcon.assocresp_ies_len = vif->assocresp_ies_len; 1840e41ab937SDedy Lansky bcon.probe_resp_len = vif->proberesp_len; 1841e41ab937SDedy Lansky 1842e41ab937SDedy Lansky wil_info(wil, 1843e41ab937SDedy Lansky "AP (vif %d) recovery: privacy %d, bi %d, channel %d, hidden %d, pbss %d\n", 1844e41ab937SDedy Lansky i, vif->privacy, vif->bi, vif->channel, 1845e41ab937SDedy Lansky vif->hidden_ssid, vif->pbss); 1846e41ab937SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 1847e41ab937SDedy Lansky vif->ssid, vif->ssid_len, true); 1848e41ab937SDedy Lansky rc = _wil_cfg80211_start_ap(wiphy, ndev, 1849e41ab937SDedy Lansky vif->ssid, vif->ssid_len, 1850e41ab937SDedy Lansky vif->privacy, vif->bi, 1851e41ab937SDedy Lansky vif->channel, &bcon, 1852e41ab937SDedy Lansky vif->hidden_ssid, vif->pbss); 1853e41ab937SDedy Lansky if (rc) { 1854e41ab937SDedy Lansky wil_err(wil, "vif %d recovery failed (%d)\n", i, rc); 1855e41ab937SDedy Lansky continue; 1856e41ab937SDedy Lansky } 1857e41ab937SDedy Lansky 1858e41ab937SDedy Lansky if (!vif->privacy || vif->gtk_len == 0) 1859e41ab937SDedy Lansky continue; 1860e41ab937SDedy Lansky 1861e41ab937SDedy Lansky key_params.key = vif->gtk; 1862e41ab937SDedy Lansky key_params.key_len = vif->gtk_len; 1863e41ab937SDedy Lansky key_params.seq_len = IEEE80211_GCMP_PN_LEN; 1864e41ab937SDedy Lansky rc = wil_cfg80211_add_key(wiphy, ndev, vif->gtk_index, false, 1865e41ab937SDedy Lansky NULL, &key_params); 1866e41ab937SDedy Lansky if (rc) 1867e41ab937SDedy Lansky wil_err(wil, "vif %d recovery add key failed (%d)\n", 1868e41ab937SDedy Lansky i, rc); 1869e41ab937SDedy Lansky } 1870e41ab937SDedy Lansky } 1871e41ab937SDedy Lansky 18721bd922fcSVladimir Kondratiev static int wil_cfg80211_change_beacon(struct wiphy *wiphy, 18731bd922fcSVladimir Kondratiev struct net_device *ndev, 18741bd922fcSVladimir Kondratiev struct cfg80211_beacon_data *bcon) 18751bd922fcSVladimir Kondratiev { 18761bd922fcSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1877e41ab937SDedy Lansky struct wireless_dev *wdev = ndev->ieee80211_ptr; 1878e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 18791bd922fcSVladimir Kondratiev int rc; 188033190ebfSVladimir Kondratiev u32 privacy = 0; 18811bd922fcSVladimir Kondratiev 1882e00243faSLior David wil_dbg_misc(wil, "change_beacon, mid=%d\n", vif->mid); 18831e7e5a0dSVladimir Kondratiev wil_print_bcon_data(bcon); 18841e7e5a0dSVladimir Kondratiev 1885c5a157e4SLior David if (bcon->tail && 1886c5a157e4SLior David cfg80211_find_ie(WLAN_EID_RSN, bcon->tail, 1887c5a157e4SLior David bcon->tail_len)) 188833190ebfSVladimir Kondratiev privacy = 1; 18891bd922fcSVladimir Kondratiev 1890e41ab937SDedy Lansky memcpy(vif->ssid, wdev->ssid, wdev->ssid_len); 1891e41ab937SDedy Lansky vif->ssid_len = wdev->ssid_len; 1892e41ab937SDedy Lansky 189333190ebfSVladimir Kondratiev /* in case privacy has changed, need to restart the AP */ 1894e00243faSLior David if (vif->privacy != privacy) { 189533190ebfSVladimir Kondratiev wil_dbg_misc(wil, "privacy changed %d=>%d. Restarting AP\n", 1896e00243faSLior David vif->privacy, privacy); 189733190ebfSVladimir Kondratiev 1898e41ab937SDedy Lansky rc = _wil_cfg80211_start_ap(wiphy, ndev, vif->ssid, 1899e41ab937SDedy Lansky vif->ssid_len, privacy, 190033190ebfSVladimir Kondratiev wdev->beacon_interval, 1901e00243faSLior David vif->channel, bcon, 1902e00243faSLior David vif->hidden_ssid, 1903e00243faSLior David vif->pbss); 190433190ebfSVladimir Kondratiev } else { 1905e00243faSLior David rc = _wil_cfg80211_set_ies(vif, bcon); 19061bd922fcSVladimir Kondratiev } 19071bd922fcSVladimir Kondratiev 190833190ebfSVladimir Kondratiev return rc; 19091bd922fcSVladimir Kondratiev } 19101bd922fcSVladimir Kondratiev 19112be7d22fSVladimir Kondratiev static int wil_cfg80211_start_ap(struct wiphy *wiphy, 19122be7d22fSVladimir Kondratiev struct net_device *ndev, 19132be7d22fSVladimir Kondratiev struct cfg80211_ap_settings *info) 19142be7d22fSVladimir Kondratiev { 191533190ebfSVladimir Kondratiev int rc; 19162be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 19172be7d22fSVladimir Kondratiev struct ieee80211_channel *channel = info->chandef.chan; 19182be7d22fSVladimir Kondratiev struct cfg80211_beacon_data *bcon = &info->beacon; 1919ca959773SVladimir Kondratiev struct cfg80211_crypto_settings *crypto = &info->crypto; 19208e52fe30SHamad Kadmany u8 hidden_ssid; 19212be7d22fSVladimir Kondratiev 1922af3db60aSLazar Alexei wil_dbg_misc(wil, "start_ap\n"); 1923ca959773SVladimir Kondratiev 19242be7d22fSVladimir Kondratiev if (!channel) { 19252be7d22fSVladimir Kondratiev wil_err(wil, "AP: No channel???\n"); 19262be7d22fSVladimir Kondratiev return -EINVAL; 19272be7d22fSVladimir Kondratiev } 19282be7d22fSVladimir Kondratiev 192933190ebfSVladimir Kondratiev switch (info->hidden_ssid) { 193033190ebfSVladimir Kondratiev case NL80211_HIDDEN_SSID_NOT_IN_USE: 193133190ebfSVladimir Kondratiev hidden_ssid = WMI_HIDDEN_SSID_DISABLED; 193233190ebfSVladimir Kondratiev break; 193333190ebfSVladimir Kondratiev 193433190ebfSVladimir Kondratiev case NL80211_HIDDEN_SSID_ZERO_LEN: 193533190ebfSVladimir Kondratiev hidden_ssid = WMI_HIDDEN_SSID_SEND_EMPTY; 193633190ebfSVladimir Kondratiev break; 193733190ebfSVladimir Kondratiev 193833190ebfSVladimir Kondratiev case NL80211_HIDDEN_SSID_ZERO_CONTENTS: 193933190ebfSVladimir Kondratiev hidden_ssid = WMI_HIDDEN_SSID_CLEAR; 194033190ebfSVladimir Kondratiev break; 194133190ebfSVladimir Kondratiev 194233190ebfSVladimir Kondratiev default: 194333190ebfSVladimir Kondratiev wil_err(wil, "AP: Invalid hidden SSID %d\n", info->hidden_ssid); 194433190ebfSVladimir Kondratiev return -EOPNOTSUPP; 194533190ebfSVladimir Kondratiev } 19467743882dSVladimir Kondratiev wil_dbg_misc(wil, "AP on Channel %d %d MHz, %s\n", channel->hw_value, 19472be7d22fSVladimir Kondratiev channel->center_freq, info->privacy ? "secure" : "open"); 1948ca959773SVladimir Kondratiev wil_dbg_misc(wil, "Privacy: %d auth_type %d\n", 1949ca959773SVladimir Kondratiev info->privacy, info->auth_type); 19508e52fe30SHamad Kadmany wil_dbg_misc(wil, "Hidden SSID mode: %d\n", 19518e52fe30SHamad Kadmany info->hidden_ssid); 1952ca959773SVladimir Kondratiev wil_dbg_misc(wil, "BI %d DTIM %d\n", info->beacon_interval, 1953ca959773SVladimir Kondratiev info->dtim_period); 1954eabb03b4SLior David wil_dbg_misc(wil, "PBSS %d\n", info->pbss); 19555eb443e9SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 19565eb443e9SDedy Lansky info->ssid, info->ssid_len, true); 1957ca959773SVladimir Kondratiev wil_print_bcon_data(bcon); 1958ca959773SVladimir Kondratiev wil_print_crypto(wil, crypto); 19592be7d22fSVladimir Kondratiev 196033190ebfSVladimir Kondratiev rc = _wil_cfg80211_start_ap(wiphy, ndev, 196133190ebfSVladimir Kondratiev info->ssid, info->ssid_len, info->privacy, 196233190ebfSVladimir Kondratiev info->beacon_interval, channel->hw_value, 1963eabb03b4SLior David bcon, hidden_ssid, info->pbss); 1964c33407a8SVladimir Kondratiev 19652be7d22fSVladimir Kondratiev return rc; 19662be7d22fSVladimir Kondratiev } 19672be7d22fSVladimir Kondratiev 19682be7d22fSVladimir Kondratiev static int wil_cfg80211_stop_ap(struct wiphy *wiphy, 19692be7d22fSVladimir Kondratiev struct net_device *ndev) 19702be7d22fSVladimir Kondratiev { 19712be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1972e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 19733ada9314SLior David bool last; 19742be7d22fSVladimir Kondratiev 19753ada9314SLior David wil_dbg_misc(wil, "stop_ap, mid=%d\n", vif->mid); 1976ca959773SVladimir Kondratiev 1977c5e96c91SDedy Lansky netif_carrier_off(ndev); 19783ada9314SLior David last = !wil_has_other_active_ifaces(wil, ndev, false, true); 19793ada9314SLior David if (last) { 19809953a782SLior David wil6210_bus_request(wil, WIL_DEFAULT_BUS_REQUEST_KBPS); 1981c33407a8SVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 1982646d402dSHamad Kadmany set_bit(wil_status_resetting, wil->status); 19833ada9314SLior David } 1984646d402dSHamad Kadmany 19859c3bde56SVladimir Kondratiev mutex_lock(&wil->mutex); 19869c3bde56SVladimir Kondratiev 1987e00243faSLior David wmi_pcp_stop(vif); 1988b9010f10SAhmad Masri clear_bit(wil_vif_ft_roam, vif->status); 1989e41ab937SDedy Lansky vif->ssid_len = 0; 1990e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp, &vif->proberesp_len, NULL, 0); 1991e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp_ies, &vif->proberesp_ies_len, NULL, 0); 1992e41ab937SDedy Lansky wil_memdup_ie(&vif->assocresp_ies, &vif->assocresp_ies_len, NULL, 0); 1993e41ab937SDedy Lansky memset(vif->gtk, 0, WMI_MAX_KEY_LEN); 1994e41ab937SDedy Lansky vif->gtk_len = 0; 19952be7d22fSVladimir Kondratiev 19963ada9314SLior David if (last) 199773d839aeSVladimir Kondratiev __wil_down(wil); 19983ada9314SLior David else 19993ada9314SLior David wil_bcast_fini(vif); 200073d839aeSVladimir Kondratiev 20019c3bde56SVladimir Kondratiev mutex_unlock(&wil->mutex); 200273d839aeSVladimir Kondratiev 200332a20d46SDedy Lansky return 0; 20042be7d22fSVladimir Kondratiev } 20052be7d22fSVladimir Kondratiev 2006849a564bSDedy Lansky static int wil_cfg80211_add_station(struct wiphy *wiphy, 2007849a564bSDedy Lansky struct net_device *dev, 2008849a564bSDedy Lansky const u8 *mac, 2009849a564bSDedy Lansky struct station_parameters *params) 2010849a564bSDedy Lansky { 2011e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 2012849a564bSDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2013849a564bSDedy Lansky 2014b9010f10SAhmad Masri wil_dbg_misc(wil, "add station %pM aid %d mid %d mask 0x%x set 0x%x\n", 2015b9010f10SAhmad Masri mac, params->aid, vif->mid, 2016b9010f10SAhmad Masri params->sta_flags_mask, params->sta_flags_set); 2017849a564bSDedy Lansky 2018849a564bSDedy Lansky if (!disable_ap_sme) { 2019849a564bSDedy Lansky wil_err(wil, "not supported with AP SME enabled\n"); 2020849a564bSDedy Lansky return -EOPNOTSUPP; 2021849a564bSDedy Lansky } 2022849a564bSDedy Lansky 2023849a564bSDedy Lansky if (params->aid > WIL_MAX_DMG_AID) { 2024849a564bSDedy Lansky wil_err(wil, "invalid aid\n"); 2025849a564bSDedy Lansky return -EINVAL; 2026849a564bSDedy Lansky } 2027849a564bSDedy Lansky 2028e00243faSLior David return wmi_new_sta(vif, mac, params->aid); 2029849a564bSDedy Lansky } 2030849a564bSDedy Lansky 20314d55a0a1SVladimir Kondratiev static int wil_cfg80211_del_station(struct wiphy *wiphy, 203289c771e5SJouni Malinen struct net_device *dev, 203389c771e5SJouni Malinen struct station_del_parameters *params) 20344d55a0a1SVladimir Kondratiev { 2035e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 20364d55a0a1SVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2037097638a0SVladimir Kondratiev 2038e00243faSLior David wil_dbg_misc(wil, "del_station: %pM, reason=%d mid=%d\n", 2039e00243faSLior David params->mac, params->reason_code, vif->mid); 2040de9084efSVladimir Kondratiev 2041097638a0SVladimir Kondratiev mutex_lock(&wil->mutex); 2042e1b43407SAhmad Masri wil6210_disconnect(vif, params->mac, params->reason_code); 2043097638a0SVladimir Kondratiev mutex_unlock(&wil->mutex); 2044097638a0SVladimir Kondratiev 20454d55a0a1SVladimir Kondratiev return 0; 20464d55a0a1SVladimir Kondratiev } 20474d55a0a1SVladimir Kondratiev 2048849a564bSDedy Lansky static int wil_cfg80211_change_station(struct wiphy *wiphy, 2049849a564bSDedy Lansky struct net_device *dev, 2050849a564bSDedy Lansky const u8 *mac, 2051849a564bSDedy Lansky struct station_parameters *params) 2052849a564bSDedy Lansky { 2053e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 2054849a564bSDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2055849a564bSDedy Lansky int authorize; 2056849a564bSDedy Lansky int cid, i; 205710590c6aSGidon Studinski struct wil_ring_tx_data *txdata = NULL; 2058849a564bSDedy Lansky 2059e00243faSLior David wil_dbg_misc(wil, "change station %pM mask 0x%x set 0x%x mid %d\n", 2060e00243faSLior David mac, params->sta_flags_mask, params->sta_flags_set, 2061e00243faSLior David vif->mid); 2062849a564bSDedy Lansky 2063849a564bSDedy Lansky if (!disable_ap_sme) { 2064849a564bSDedy Lansky wil_dbg_misc(wil, "not supported with AP SME enabled\n"); 2065849a564bSDedy Lansky return -EOPNOTSUPP; 2066849a564bSDedy Lansky } 2067849a564bSDedy Lansky 2068849a564bSDedy Lansky if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 2069849a564bSDedy Lansky return 0; 2070849a564bSDedy Lansky 2071e00243faSLior David cid = wil_find_cid(wil, vif->mid, mac); 2072849a564bSDedy Lansky if (cid < 0) { 2073849a564bSDedy Lansky wil_err(wil, "station not found\n"); 2074849a564bSDedy Lansky return -ENOLINK; 2075849a564bSDedy Lansky } 2076849a564bSDedy Lansky 207710590c6aSGidon Studinski for (i = 0; i < ARRAY_SIZE(wil->ring2cid_tid); i++) 207810590c6aSGidon Studinski if (wil->ring2cid_tid[i][0] == cid) { 207910590c6aSGidon Studinski txdata = &wil->ring_tx_data[i]; 2080849a564bSDedy Lansky break; 2081849a564bSDedy Lansky } 2082849a564bSDedy Lansky 2083849a564bSDedy Lansky if (!txdata) { 208410590c6aSGidon Studinski wil_err(wil, "ring data not found\n"); 2085849a564bSDedy Lansky return -ENOLINK; 2086849a564bSDedy Lansky } 2087849a564bSDedy Lansky 2088849a564bSDedy Lansky authorize = params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED); 2089849a564bSDedy Lansky txdata->dot1x_open = authorize ? 1 : 0; 209010590c6aSGidon Studinski wil_dbg_misc(wil, "cid %d ring %d authorize %d\n", cid, i, 2091849a564bSDedy Lansky txdata->dot1x_open); 2092849a564bSDedy Lansky 2093849a564bSDedy Lansky return 0; 2094849a564bSDedy Lansky } 2095849a564bSDedy Lansky 209640822a90SVladimir Kondratiev /* probe_client handling */ 209740822a90SVladimir Kondratiev static void wil_probe_client_handle(struct wil6210_priv *wil, 2098e00243faSLior David struct wil6210_vif *vif, 209940822a90SVladimir Kondratiev struct wil_probe_client_req *req) 210040822a90SVladimir Kondratiev { 2101e00243faSLior David struct net_device *ndev = vif_to_ndev(vif); 210240822a90SVladimir Kondratiev struct wil_sta_info *sta = &wil->sta[req->cid]; 210340822a90SVladimir Kondratiev /* assume STA is alive if it is still connected, 210440822a90SVladimir Kondratiev * else FW will disconnect it 210540822a90SVladimir Kondratiev */ 210640822a90SVladimir Kondratiev bool alive = (sta->status == wil_sta_connected); 210740822a90SVladimir Kondratiev 2108c4b50cd3SVenkateswara Naralasetty cfg80211_probe_status(ndev, sta->addr, req->cookie, alive, 2109c4b50cd3SVenkateswara Naralasetty 0, false, GFP_KERNEL); 211040822a90SVladimir Kondratiev } 211140822a90SVladimir Kondratiev 2112e00243faSLior David static struct list_head *next_probe_client(struct wil6210_vif *vif) 211340822a90SVladimir Kondratiev { 211440822a90SVladimir Kondratiev struct list_head *ret = NULL; 211540822a90SVladimir Kondratiev 2116e00243faSLior David mutex_lock(&vif->probe_client_mutex); 211740822a90SVladimir Kondratiev 2118e00243faSLior David if (!list_empty(&vif->probe_client_pending)) { 2119e00243faSLior David ret = vif->probe_client_pending.next; 212040822a90SVladimir Kondratiev list_del(ret); 212140822a90SVladimir Kondratiev } 212240822a90SVladimir Kondratiev 2123e00243faSLior David mutex_unlock(&vif->probe_client_mutex); 212440822a90SVladimir Kondratiev 212540822a90SVladimir Kondratiev return ret; 212640822a90SVladimir Kondratiev } 212740822a90SVladimir Kondratiev 212840822a90SVladimir Kondratiev void wil_probe_client_worker(struct work_struct *work) 212940822a90SVladimir Kondratiev { 2130e00243faSLior David struct wil6210_vif *vif = container_of(work, struct wil6210_vif, 213140822a90SVladimir Kondratiev probe_client_worker); 2132e00243faSLior David struct wil6210_priv *wil = vif_to_wil(vif); 213340822a90SVladimir Kondratiev struct wil_probe_client_req *req; 213440822a90SVladimir Kondratiev struct list_head *lh; 213540822a90SVladimir Kondratiev 2136e00243faSLior David while ((lh = next_probe_client(vif)) != NULL) { 213740822a90SVladimir Kondratiev req = list_entry(lh, struct wil_probe_client_req, list); 213840822a90SVladimir Kondratiev 2139e00243faSLior David wil_probe_client_handle(wil, vif, req); 214040822a90SVladimir Kondratiev kfree(req); 214140822a90SVladimir Kondratiev } 214240822a90SVladimir Kondratiev } 214340822a90SVladimir Kondratiev 2144e00243faSLior David void wil_probe_client_flush(struct wil6210_vif *vif) 214540822a90SVladimir Kondratiev { 214640822a90SVladimir Kondratiev struct wil_probe_client_req *req, *t; 2147e00243faSLior David struct wil6210_priv *wil = vif_to_wil(vif); 214840822a90SVladimir Kondratiev 2149af3db60aSLazar Alexei wil_dbg_misc(wil, "probe_client_flush\n"); 215040822a90SVladimir Kondratiev 2151e00243faSLior David mutex_lock(&vif->probe_client_mutex); 215240822a90SVladimir Kondratiev 2153e00243faSLior David list_for_each_entry_safe(req, t, &vif->probe_client_pending, list) { 215440822a90SVladimir Kondratiev list_del(&req->list); 215540822a90SVladimir Kondratiev kfree(req); 215640822a90SVladimir Kondratiev } 215740822a90SVladimir Kondratiev 2158e00243faSLior David mutex_unlock(&vif->probe_client_mutex); 215940822a90SVladimir Kondratiev } 216040822a90SVladimir Kondratiev 216140822a90SVladimir Kondratiev static int wil_cfg80211_probe_client(struct wiphy *wiphy, 216240822a90SVladimir Kondratiev struct net_device *dev, 216340822a90SVladimir Kondratiev const u8 *peer, u64 *cookie) 216440822a90SVladimir Kondratiev { 216540822a90SVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2166e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 216740822a90SVladimir Kondratiev struct wil_probe_client_req *req; 2168e00243faSLior David int cid = wil_find_cid(wil, vif->mid, peer); 216940822a90SVladimir Kondratiev 2170e00243faSLior David wil_dbg_misc(wil, "probe_client: %pM => CID %d MID %d\n", 2171e00243faSLior David peer, cid, vif->mid); 217240822a90SVladimir Kondratiev 217340822a90SVladimir Kondratiev if (cid < 0) 217440822a90SVladimir Kondratiev return -ENOLINK; 217540822a90SVladimir Kondratiev 217640822a90SVladimir Kondratiev req = kzalloc(sizeof(*req), GFP_KERNEL); 217740822a90SVladimir Kondratiev if (!req) 217840822a90SVladimir Kondratiev return -ENOMEM; 217940822a90SVladimir Kondratiev 218040822a90SVladimir Kondratiev req->cid = cid; 218140822a90SVladimir Kondratiev req->cookie = cid; 218240822a90SVladimir Kondratiev 2183e00243faSLior David mutex_lock(&vif->probe_client_mutex); 2184e00243faSLior David list_add_tail(&req->list, &vif->probe_client_pending); 2185e00243faSLior David mutex_unlock(&vif->probe_client_mutex); 218640822a90SVladimir Kondratiev 218740822a90SVladimir Kondratiev *cookie = req->cookie; 2188e00243faSLior David queue_work(wil->wq_service, &vif->probe_client_worker); 218940822a90SVladimir Kondratiev return 0; 219040822a90SVladimir Kondratiev } 219140822a90SVladimir Kondratiev 219202beaf1aSVladimir Kondratiev static int wil_cfg80211_change_bss(struct wiphy *wiphy, 219302beaf1aSVladimir Kondratiev struct net_device *dev, 219402beaf1aSVladimir Kondratiev struct bss_parameters *params) 219502beaf1aSVladimir Kondratiev { 219602beaf1aSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2197e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 219802beaf1aSVladimir Kondratiev 219902beaf1aSVladimir Kondratiev if (params->ap_isolate >= 0) { 2200e00243faSLior David wil_dbg_misc(wil, "change_bss: ap_isolate MID %d, %d => %d\n", 2201e00243faSLior David vif->mid, vif->ap_isolate, params->ap_isolate); 2202e00243faSLior David vif->ap_isolate = params->ap_isolate; 220302beaf1aSVladimir Kondratiev } 220402beaf1aSVladimir Kondratiev 220502beaf1aSVladimir Kondratiev return 0; 220602beaf1aSVladimir Kondratiev } 220702beaf1aSVladimir Kondratiev 22082c207eb8SMaya Erez static int wil_cfg80211_set_power_mgmt(struct wiphy *wiphy, 22092c207eb8SMaya Erez struct net_device *dev, 22102c207eb8SMaya Erez bool enabled, int timeout) 22112c207eb8SMaya Erez { 22122c207eb8SMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 22132c207eb8SMaya Erez enum wmi_ps_profile_type ps_profile; 22142c207eb8SMaya Erez 22152c207eb8SMaya Erez wil_dbg_misc(wil, "enabled=%d, timeout=%d\n", 22162c207eb8SMaya Erez enabled, timeout); 22172c207eb8SMaya Erez 22182c207eb8SMaya Erez if (enabled) 22192c207eb8SMaya Erez ps_profile = WMI_PS_PROFILE_TYPE_DEFAULT; 22202c207eb8SMaya Erez else 22212c207eb8SMaya Erez ps_profile = WMI_PS_PROFILE_TYPE_PS_DISABLED; 22222c207eb8SMaya Erez 22238b068c03SLazar Alexei return wil_ps_update(wil, ps_profile); 22242c207eb8SMaya Erez } 22252c207eb8SMaya Erez 2226fe9ee51eSMaya Erez static int wil_cfg80211_suspend(struct wiphy *wiphy, 2227fe9ee51eSMaya Erez struct cfg80211_wowlan *wow) 2228fe9ee51eSMaya Erez { 2229fe9ee51eSMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2230fe9ee51eSMaya Erez int rc; 2231fe9ee51eSMaya Erez 2232fe9ee51eSMaya Erez /* Setting the wakeup trigger based on wow is TBD */ 2233fe9ee51eSMaya Erez 2234fe9ee51eSMaya Erez if (test_bit(wil_status_suspended, wil->status)) { 2235fe9ee51eSMaya Erez wil_dbg_pm(wil, "trying to suspend while suspended\n"); 2236fe9ee51eSMaya Erez return 0; 2237fe9ee51eSMaya Erez } 2238fe9ee51eSMaya Erez 2239fe9ee51eSMaya Erez rc = wil_can_suspend(wil, false); 2240fe9ee51eSMaya Erez if (rc) 2241fe9ee51eSMaya Erez goto out; 2242fe9ee51eSMaya Erez 2243fe9ee51eSMaya Erez wil_dbg_pm(wil, "suspending\n"); 2244fe9ee51eSMaya Erez 2245144a12a6SHamad Kadmany mutex_lock(&wil->mutex); 2246404bbb3cSLior David mutex_lock(&wil->vif_mutex); 2247144a12a6SHamad Kadmany wil_p2p_stop_radio_operations(wil); 22485bd60982SLior David wil_abort_scan_all_vifs(wil, true); 2249404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 2250144a12a6SHamad Kadmany mutex_unlock(&wil->mutex); 2251fe9ee51eSMaya Erez 2252fe9ee51eSMaya Erez out: 2253fe9ee51eSMaya Erez return rc; 2254fe9ee51eSMaya Erez } 2255fe9ee51eSMaya Erez 2256fe9ee51eSMaya Erez static int wil_cfg80211_resume(struct wiphy *wiphy) 2257fe9ee51eSMaya Erez { 2258fe9ee51eSMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2259fe9ee51eSMaya Erez 2260fe9ee51eSMaya Erez wil_dbg_pm(wil, "resuming\n"); 2261fe9ee51eSMaya Erez 2262fe9ee51eSMaya Erez return 0; 2263fe9ee51eSMaya Erez } 2264fe9ee51eSMaya Erez 2265a5dc6883SDedy Lansky static int 2266a5dc6883SDedy Lansky wil_cfg80211_sched_scan_start(struct wiphy *wiphy, 2267a5dc6883SDedy Lansky struct net_device *dev, 2268a5dc6883SDedy Lansky struct cfg80211_sched_scan_request *request) 2269a5dc6883SDedy Lansky { 2270a5dc6883SDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2271e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 2272a5dc6883SDedy Lansky int i, rc; 2273a5dc6883SDedy Lansky 2274e00243faSLior David if (vif->mid != 0) 2275e00243faSLior David return -EOPNOTSUPP; 2276e00243faSLior David 2277a5dc6883SDedy Lansky wil_dbg_misc(wil, 2278a5dc6883SDedy Lansky "sched scan start: n_ssids %d, ie_len %zu, flags 0x%x\n", 2279a5dc6883SDedy Lansky request->n_ssids, request->ie_len, request->flags); 2280a5dc6883SDedy Lansky for (i = 0; i < request->n_ssids; i++) { 2281a5dc6883SDedy Lansky wil_dbg_misc(wil, "SSID[%d]:", i); 2282a5dc6883SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 2283a5dc6883SDedy Lansky request->ssids[i].ssid, 2284a5dc6883SDedy Lansky request->ssids[i].ssid_len, true); 2285a5dc6883SDedy Lansky } 2286a5dc6883SDedy Lansky wil_dbg_misc(wil, "channels:"); 2287a5dc6883SDedy Lansky for (i = 0; i < request->n_channels; i++) 2288a5dc6883SDedy Lansky wil_dbg_misc(wil, " %d%s", request->channels[i]->hw_value, 2289a5dc6883SDedy Lansky i == request->n_channels - 1 ? "\n" : ""); 2290a5dc6883SDedy Lansky wil_dbg_misc(wil, "n_match_sets %d, min_rssi_thold %d, delay %d\n", 2291a5dc6883SDedy Lansky request->n_match_sets, request->min_rssi_thold, 2292a5dc6883SDedy Lansky request->delay); 2293a5dc6883SDedy Lansky for (i = 0; i < request->n_match_sets; i++) { 2294a5dc6883SDedy Lansky struct cfg80211_match_set *ms = &request->match_sets[i]; 2295a5dc6883SDedy Lansky 2296a5dc6883SDedy Lansky wil_dbg_misc(wil, "MATCHSET[%d]: rssi_thold %d\n", 2297a5dc6883SDedy Lansky i, ms->rssi_thold); 2298a5dc6883SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 2299a5dc6883SDedy Lansky ms->ssid.ssid, 2300a5dc6883SDedy Lansky ms->ssid.ssid_len, true); 2301a5dc6883SDedy Lansky } 2302a5dc6883SDedy Lansky wil_dbg_misc(wil, "n_scan_plans %d\n", request->n_scan_plans); 2303a5dc6883SDedy Lansky for (i = 0; i < request->n_scan_plans; i++) { 2304a5dc6883SDedy Lansky struct cfg80211_sched_scan_plan *sp = &request->scan_plans[i]; 2305a5dc6883SDedy Lansky 2306a5dc6883SDedy Lansky wil_dbg_misc(wil, "SCAN PLAN[%d]: interval %d iterations %d\n", 2307a5dc6883SDedy Lansky i, sp->interval, sp->iterations); 2308a5dc6883SDedy Lansky } 2309a5dc6883SDedy Lansky 2310e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_PROBE_REQ, 2311e00243faSLior David request->ie_len, request->ie); 2312a5dc6883SDedy Lansky if (rc) 2313a5dc6883SDedy Lansky return rc; 2314a5dc6883SDedy Lansky return wmi_start_sched_scan(wil, request); 2315a5dc6883SDedy Lansky } 2316a5dc6883SDedy Lansky 2317a5dc6883SDedy Lansky static int 2318a5dc6883SDedy Lansky wil_cfg80211_sched_scan_stop(struct wiphy *wiphy, struct net_device *dev, 2319a5dc6883SDedy Lansky u64 reqid) 2320a5dc6883SDedy Lansky { 2321a5dc6883SDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2322e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 2323a5dc6883SDedy Lansky int rc; 2324a5dc6883SDedy Lansky 2325e00243faSLior David if (vif->mid != 0) 2326e00243faSLior David return -EOPNOTSUPP; 2327e00243faSLior David 2328a5dc6883SDedy Lansky rc = wmi_stop_sched_scan(wil); 2329a5dc6883SDedy Lansky /* device would return error if it thinks PNO is already stopped. 2330a5dc6883SDedy Lansky * ignore the return code so user space and driver gets back in-sync 2331a5dc6883SDedy Lansky */ 2332a5dc6883SDedy Lansky wil_dbg_misc(wil, "sched scan stopped (%d)\n", rc); 2333a5dc6883SDedy Lansky 2334a5dc6883SDedy Lansky return 0; 2335a5dc6883SDedy Lansky } 2336a5dc6883SDedy Lansky 2337b9010f10SAhmad Masri static int 2338b9010f10SAhmad Masri wil_cfg80211_update_ft_ies(struct wiphy *wiphy, struct net_device *dev, 2339b9010f10SAhmad Masri struct cfg80211_update_ft_ies_params *ftie) 2340b9010f10SAhmad Masri { 2341b9010f10SAhmad Masri struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2342b9010f10SAhmad Masri struct wil6210_vif *vif = ndev_to_vif(dev); 2343b9010f10SAhmad Masri struct cfg80211_bss *bss; 2344b9010f10SAhmad Masri struct wmi_ft_reassoc_cmd reassoc; 2345b9010f10SAhmad Masri int rc = 0; 2346b9010f10SAhmad Masri 2347b9010f10SAhmad Masri wil_dbg_misc(wil, "update ft ies, mid=%d\n", vif->mid); 2348b9010f10SAhmad Masri wil_hex_dump_misc("FT IE ", DUMP_PREFIX_OFFSET, 16, 1, 2349b9010f10SAhmad Masri ftie->ie, ftie->ie_len, true); 2350b9010f10SAhmad Masri 2351b9010f10SAhmad Masri if (!test_bit(WMI_FW_CAPABILITY_FT_ROAMING, wil->fw_capabilities)) { 2352b9010f10SAhmad Masri wil_err(wil, "FW does not support FT roaming\n"); 2353b9010f10SAhmad Masri return -EOPNOTSUPP; 2354b9010f10SAhmad Masri } 2355b9010f10SAhmad Masri 2356b9010f10SAhmad Masri rc = wmi_update_ft_ies(vif, ftie->ie_len, ftie->ie); 2357b9010f10SAhmad Masri if (rc) 2358b9010f10SAhmad Masri return rc; 2359b9010f10SAhmad Masri 2360b9010f10SAhmad Masri if (!test_bit(wil_vif_ft_roam, vif->status)) 2361b9010f10SAhmad Masri /* vif is not roaming */ 2362b9010f10SAhmad Masri return 0; 2363b9010f10SAhmad Masri 2364b9010f10SAhmad Masri /* wil_vif_ft_roam is set. wil_cfg80211_update_ft_ies is used as 2365b9010f10SAhmad Masri * a trigger for reassoc 2366b9010f10SAhmad Masri */ 2367b9010f10SAhmad Masri 2368b9010f10SAhmad Masri bss = vif->bss; 2369b9010f10SAhmad Masri if (!bss) { 2370b9010f10SAhmad Masri wil_err(wil, "FT: bss is NULL\n"); 2371b9010f10SAhmad Masri return -EINVAL; 2372b9010f10SAhmad Masri } 2373b9010f10SAhmad Masri 2374b9010f10SAhmad Masri memset(&reassoc, 0, sizeof(reassoc)); 2375b9010f10SAhmad Masri ether_addr_copy(reassoc.bssid, bss->bssid); 2376b9010f10SAhmad Masri 2377b9010f10SAhmad Masri rc = wmi_send(wil, WMI_FT_REASSOC_CMDID, vif->mid, 2378b9010f10SAhmad Masri &reassoc, sizeof(reassoc)); 2379b9010f10SAhmad Masri if (rc) 2380b9010f10SAhmad Masri wil_err(wil, "FT: reassoc failed (%d)\n", rc); 2381b9010f10SAhmad Masri 2382b9010f10SAhmad Masri return rc; 2383b9010f10SAhmad Masri } 2384b9010f10SAhmad Masri 2385b59eb961SBhumika Goyal static const struct cfg80211_ops wil_cfg80211_ops = { 23864332cac1SLior David .add_virtual_intf = wil_cfg80211_add_iface, 23874332cac1SLior David .del_virtual_intf = wil_cfg80211_del_iface, 23882be7d22fSVladimir Kondratiev .scan = wil_cfg80211_scan, 2389035859a5SMaya Erez .abort_scan = wil_cfg80211_abort_scan, 23902be7d22fSVladimir Kondratiev .connect = wil_cfg80211_connect, 23912be7d22fSVladimir Kondratiev .disconnect = wil_cfg80211_disconnect, 23923fea18d0SLior David .set_wiphy_params = wil_cfg80211_set_wiphy_params, 23932be7d22fSVladimir Kondratiev .change_virtual_intf = wil_cfg80211_change_iface, 23942be7d22fSVladimir Kondratiev .get_station = wil_cfg80211_get_station, 2395ef28afdbSVladimir Kondratiev .dump_station = wil_cfg80211_dump_station, 23961647f12fSVladimir Kondratiev .remain_on_channel = wil_remain_on_channel, 23971647f12fSVladimir Kondratiev .cancel_remain_on_channel = wil_cancel_remain_on_channel, 23981647f12fSVladimir Kondratiev .mgmt_tx = wil_cfg80211_mgmt_tx, 23992be7d22fSVladimir Kondratiev .set_monitor_channel = wil_cfg80211_set_channel, 24002be7d22fSVladimir Kondratiev .add_key = wil_cfg80211_add_key, 24012be7d22fSVladimir Kondratiev .del_key = wil_cfg80211_del_key, 24022be7d22fSVladimir Kondratiev .set_default_key = wil_cfg80211_set_default_key, 24032be7d22fSVladimir Kondratiev /* AP mode */ 24041bd922fcSVladimir Kondratiev .change_beacon = wil_cfg80211_change_beacon, 24052be7d22fSVladimir Kondratiev .start_ap = wil_cfg80211_start_ap, 24062be7d22fSVladimir Kondratiev .stop_ap = wil_cfg80211_stop_ap, 2407849a564bSDedy Lansky .add_station = wil_cfg80211_add_station, 24084d55a0a1SVladimir Kondratiev .del_station = wil_cfg80211_del_station, 2409849a564bSDedy Lansky .change_station = wil_cfg80211_change_station, 241040822a90SVladimir Kondratiev .probe_client = wil_cfg80211_probe_client, 241102beaf1aSVladimir Kondratiev .change_bss = wil_cfg80211_change_bss, 24124332cac1SLior David /* P2P device */ 24134332cac1SLior David .start_p2p_device = wil_cfg80211_start_p2p_device, 24144332cac1SLior David .stop_p2p_device = wil_cfg80211_stop_p2p_device, 24152c207eb8SMaya Erez .set_power_mgmt = wil_cfg80211_set_power_mgmt, 2416fe9ee51eSMaya Erez .suspend = wil_cfg80211_suspend, 2417fe9ee51eSMaya Erez .resume = wil_cfg80211_resume, 2418a5dc6883SDedy Lansky .sched_scan_start = wil_cfg80211_sched_scan_start, 2419a5dc6883SDedy Lansky .sched_scan_stop = wil_cfg80211_sched_scan_stop, 2420b9010f10SAhmad Masri .update_ft_ies = wil_cfg80211_update_ft_ies, 24212be7d22fSVladimir Kondratiev }; 24222be7d22fSVladimir Kondratiev 24232be7d22fSVladimir Kondratiev static void wil_wiphy_init(struct wiphy *wiphy) 24242be7d22fSVladimir Kondratiev { 24258e52fe30SHamad Kadmany wiphy->max_scan_ssids = 1; 242677c91295SVladimir Kondratiev wiphy->max_scan_ie_len = WMI_MAX_IE_LEN; 2427e6d68341SDedy Lansky wiphy->max_remain_on_channel_duration = WIL_MAX_ROC_DURATION_MS; 24282be7d22fSVladimir Kondratiev wiphy->max_num_pmkids = 0 /* TODO: */; 24292be7d22fSVladimir Kondratiev wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 24302be7d22fSVladimir Kondratiev BIT(NL80211_IFTYPE_AP) | 2431e6d68341SDedy Lansky BIT(NL80211_IFTYPE_P2P_CLIENT) | 2432e6d68341SDedy Lansky BIT(NL80211_IFTYPE_P2P_GO) | 24334332cac1SLior David BIT(NL80211_IFTYPE_P2P_DEVICE) | 2434e6d68341SDedy Lansky BIT(NL80211_IFTYPE_MONITOR); 2435849a564bSDedy Lansky wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 24362c207eb8SMaya Erez WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD | 24372c207eb8SMaya Erez WIPHY_FLAG_PS_ON_BY_DEFAULT; 2438849a564bSDedy Lansky if (!disable_ap_sme) 2439849a564bSDedy Lansky wiphy->flags |= WIPHY_FLAG_HAVE_AP_SME; 24409cf10d62SVladimir Kondratiev dev_dbg(wiphy_dev(wiphy), "%s : flags = 0x%08x\n", 24412be7d22fSVladimir Kondratiev __func__, wiphy->flags); 24422be7d22fSVladimir Kondratiev wiphy->probe_resp_offload = 24432be7d22fSVladimir Kondratiev NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 24442be7d22fSVladimir Kondratiev NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 24452be7d22fSVladimir Kondratiev NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 24462be7d22fSVladimir Kondratiev 244757fbcce3SJohannes Berg wiphy->bands[NL80211_BAND_60GHZ] = &wil_band_60ghz; 24482be7d22fSVladimir Kondratiev 244930868f5dSDedy Lansky /* may change after reading FW capabilities */ 2450b8b33a3aSVladimir Kondratiev wiphy->signal_type = CFG80211_SIGNAL_TYPE_UNSPEC; 24512be7d22fSVladimir Kondratiev 24522be7d22fSVladimir Kondratiev wiphy->cipher_suites = wil_cipher_suites; 24532be7d22fSVladimir Kondratiev wiphy->n_cipher_suites = ARRAY_SIZE(wil_cipher_suites); 24542be7d22fSVladimir Kondratiev wiphy->mgmt_stypes = wil_mgmt_stypes; 2455713c8a29SVladimir Kondratiev wiphy->features |= NL80211_FEATURE_SK_TX_STATUS; 24560216a895SLior David 24570216a895SLior David wiphy->n_vendor_commands = ARRAY_SIZE(wil_nl80211_vendor_commands); 24580216a895SLior David wiphy->vendor_commands = wil_nl80211_vendor_commands; 2459d1fbf075SMaya Erez 2460d1fbf075SMaya Erez #ifdef CONFIG_PM 2461d1fbf075SMaya Erez wiphy->wowlan = &wil_wowlan_support; 2462d1fbf075SMaya Erez #endif 24632be7d22fSVladimir Kondratiev } 24642be7d22fSVladimir Kondratiev 24657bfe9e22SLior David int wil_cfg80211_iface_combinations_from_fw( 24667bfe9e22SLior David struct wil6210_priv *wil, const struct wil_fw_record_concurrency *conc) 24677bfe9e22SLior David { 24687bfe9e22SLior David struct wiphy *wiphy = wil_to_wiphy(wil); 24697bfe9e22SLior David u32 total_limits = 0; 24707bfe9e22SLior David u16 n_combos; 24717bfe9e22SLior David const struct wil_fw_concurrency_combo *combo; 24727bfe9e22SLior David const struct wil_fw_concurrency_limit *limit; 24737bfe9e22SLior David struct ieee80211_iface_combination *iface_combinations; 24747bfe9e22SLior David struct ieee80211_iface_limit *iface_limit; 24757bfe9e22SLior David int i, j; 24767bfe9e22SLior David 24777bfe9e22SLior David if (wiphy->iface_combinations) { 24787bfe9e22SLior David wil_dbg_misc(wil, "iface_combinations already set, skipping\n"); 24797bfe9e22SLior David return 0; 24807bfe9e22SLior David } 24817bfe9e22SLior David 24827bfe9e22SLior David combo = conc->combos; 24837bfe9e22SLior David n_combos = le16_to_cpu(conc->n_combos); 24847bfe9e22SLior David for (i = 0; i < n_combos; i++) { 24857bfe9e22SLior David total_limits += combo->n_limits; 24867bfe9e22SLior David limit = combo->limits + combo->n_limits; 24877bfe9e22SLior David combo = (struct wil_fw_concurrency_combo *)limit; 24887bfe9e22SLior David } 24897bfe9e22SLior David 24907bfe9e22SLior David iface_combinations = 24917bfe9e22SLior David kzalloc(n_combos * sizeof(struct ieee80211_iface_combination) + 24927bfe9e22SLior David total_limits * sizeof(struct ieee80211_iface_limit), 24937bfe9e22SLior David GFP_KERNEL); 24947bfe9e22SLior David if (!iface_combinations) 24957bfe9e22SLior David return -ENOMEM; 24967bfe9e22SLior David iface_limit = (struct ieee80211_iface_limit *)(iface_combinations + 24977bfe9e22SLior David n_combos); 24987bfe9e22SLior David combo = conc->combos; 24997bfe9e22SLior David for (i = 0; i < n_combos; i++) { 25007bfe9e22SLior David iface_combinations[i].max_interfaces = combo->max_interfaces; 25017bfe9e22SLior David iface_combinations[i].num_different_channels = 25027bfe9e22SLior David combo->n_diff_channels; 25037bfe9e22SLior David iface_combinations[i].beacon_int_infra_match = 25047bfe9e22SLior David combo->same_bi; 25057bfe9e22SLior David iface_combinations[i].n_limits = combo->n_limits; 25067bfe9e22SLior David wil_dbg_misc(wil, 25077bfe9e22SLior David "iface_combination %d: max_if %d, num_ch %d, bi_match %d\n", 25087bfe9e22SLior David i, iface_combinations[i].max_interfaces, 25097bfe9e22SLior David iface_combinations[i].num_different_channels, 25107bfe9e22SLior David iface_combinations[i].beacon_int_infra_match); 25117bfe9e22SLior David limit = combo->limits; 25127bfe9e22SLior David for (j = 0; j < combo->n_limits; j++) { 25137bfe9e22SLior David iface_limit[j].max = le16_to_cpu(limit[j].max); 25147bfe9e22SLior David iface_limit[j].types = le16_to_cpu(limit[j].types); 25157bfe9e22SLior David wil_dbg_misc(wil, 25167bfe9e22SLior David "limit %d: max %d types 0x%x\n", j, 25177bfe9e22SLior David iface_limit[j].max, iface_limit[j].types); 25187bfe9e22SLior David } 25197bfe9e22SLior David iface_combinations[i].limits = iface_limit; 25207bfe9e22SLior David iface_limit += combo->n_limits; 25217bfe9e22SLior David limit += combo->n_limits; 25227bfe9e22SLior David combo = (struct wil_fw_concurrency_combo *)limit; 25237bfe9e22SLior David } 25247bfe9e22SLior David 25254aebd3bdSLior David wil_dbg_misc(wil, "multiple VIFs supported, n_mids %d\n", conc->n_mids); 25264aebd3bdSLior David wil->max_vifs = conc->n_mids + 1; /* including main interface */ 25274aebd3bdSLior David if (wil->max_vifs > WIL_MAX_VIFS) { 25284aebd3bdSLior David wil_info(wil, "limited number of VIFs supported(%d, FW %d)\n", 25294aebd3bdSLior David WIL_MAX_VIFS, wil->max_vifs); 25304aebd3bdSLior David wil->max_vifs = WIL_MAX_VIFS; 25314aebd3bdSLior David } 25327bfe9e22SLior David wiphy->n_iface_combinations = n_combos; 25337bfe9e22SLior David wiphy->iface_combinations = iface_combinations; 25347bfe9e22SLior David return 0; 25357bfe9e22SLior David } 25367bfe9e22SLior David 25379f38f286SLior David struct wil6210_priv *wil_cfg80211_init(struct device *dev) 25382be7d22fSVladimir Kondratiev { 25399f38f286SLior David struct wiphy *wiphy; 25409f38f286SLior David struct wil6210_priv *wil; 25419f38f286SLior David struct ieee80211_channel *ch; 25422be7d22fSVladimir Kondratiev 25439cf10d62SVladimir Kondratiev dev_dbg(dev, "%s()\n", __func__); 25449cf10d62SVladimir Kondratiev 25459f38f286SLior David /* Note: the wireless_dev structure is no longer allocated here. 25469f38f286SLior David * Instead, it is allocated as part of the net_device structure 25479f38f286SLior David * for main interface and each VIF. 25489f38f286SLior David */ 25499f38f286SLior David wiphy = wiphy_new(&wil_cfg80211_ops, sizeof(struct wil6210_priv)); 25509f38f286SLior David if (!wiphy) 25512be7d22fSVladimir Kondratiev return ERR_PTR(-ENOMEM); 25522be7d22fSVladimir Kondratiev 25539f38f286SLior David set_wiphy_dev(wiphy, dev); 25549f38f286SLior David wil_wiphy_init(wiphy); 25559f38f286SLior David 25569f38f286SLior David wil = wiphy_to_wil(wiphy); 25579f38f286SLior David wil->wiphy = wiphy; 25589f38f286SLior David 25599f38f286SLior David /* default monitor channel */ 25609f38f286SLior David ch = wiphy->bands[NL80211_BAND_60GHZ]->channels; 25619f38f286SLior David cfg80211_chandef_create(&wil->monitor_chandef, ch, NL80211_CHAN_NO_HT); 25629f38f286SLior David 25639f38f286SLior David return wil; 25642be7d22fSVladimir Kondratiev } 25652be7d22fSVladimir Kondratiev 25669f38f286SLior David void wil_cfg80211_deinit(struct wil6210_priv *wil) 25672be7d22fSVladimir Kondratiev { 25689f38f286SLior David struct wiphy *wiphy = wil_to_wiphy(wil); 25692be7d22fSVladimir Kondratiev 25709cf10d62SVladimir Kondratiev dev_dbg(wil_to_dev(wil), "%s()\n", __func__); 25719cf10d62SVladimir Kondratiev 25729f38f286SLior David if (!wiphy) 25732be7d22fSVladimir Kondratiev return; 25742be7d22fSVladimir Kondratiev 25757bfe9e22SLior David kfree(wiphy->iface_combinations); 25767bfe9e22SLior David wiphy->iface_combinations = NULL; 25777bfe9e22SLior David 25789f38f286SLior David wiphy_free(wiphy); 25799f38f286SLior David /* do not access wil6210_priv after returning from here */ 25802be7d22fSVladimir Kondratiev } 25814332cac1SLior David 25824332cac1SLior David void wil_p2p_wdev_free(struct wil6210_priv *wil) 25834332cac1SLior David { 25844332cac1SLior David struct wireless_dev *p2p_wdev; 25854332cac1SLior David 2586404bbb3cSLior David mutex_lock(&wil->vif_mutex); 25874332cac1SLior David p2p_wdev = wil->p2p_wdev; 25884332cac1SLior David wil->p2p_wdev = NULL; 2589e00243faSLior David wil->radio_wdev = wil->main_ndev->ieee80211_ptr; 2590404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 2591d35c2b6fSMaya Erez if (p2p_wdev) { 25924332cac1SLior David cfg80211_unregister_wdev(p2p_wdev); 25935bd60982SLior David kfree(p2p_wdev); 25944332cac1SLior David } 25954332cac1SLior David } 25960216a895SLior David 25970216a895SLior David static int wil_rf_sector_status_to_rc(u8 status) 25980216a895SLior David { 25990216a895SLior David switch (status) { 26000216a895SLior David case WMI_RF_SECTOR_STATUS_SUCCESS: 26010216a895SLior David return 0; 26020216a895SLior David case WMI_RF_SECTOR_STATUS_BAD_PARAMETERS_ERROR: 26030216a895SLior David return -EINVAL; 26040216a895SLior David case WMI_RF_SECTOR_STATUS_BUSY_ERROR: 26050216a895SLior David return -EAGAIN; 26060216a895SLior David case WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR: 26070216a895SLior David return -EOPNOTSUPP; 26080216a895SLior David default: 26090216a895SLior David return -EINVAL; 26100216a895SLior David } 26110216a895SLior David } 26120216a895SLior David 26130216a895SLior David static int wil_rf_sector_get_cfg(struct wiphy *wiphy, 26140216a895SLior David struct wireless_dev *wdev, 26150216a895SLior David const void *data, int data_len) 26160216a895SLior David { 26170216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2618e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 26190216a895SLior David int rc; 26200216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 26210216a895SLior David u16 sector_index; 26220216a895SLior David u8 sector_type; 26230216a895SLior David u32 rf_modules_vec; 26240216a895SLior David struct wmi_get_rf_sector_params_cmd cmd; 26250216a895SLior David struct { 26260216a895SLior David struct wmi_cmd_hdr wmi; 26270216a895SLior David struct wmi_get_rf_sector_params_done_event evt; 2628807b0860SAlexei Avshalom Lazar } __packed reply = { 2629807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2630807b0860SAlexei Avshalom Lazar }; 26310216a895SLior David struct sk_buff *msg; 26320216a895SLior David struct nlattr *nl_cfgs, *nl_cfg; 26330216a895SLior David u32 i; 26340216a895SLior David struct wmi_rf_sector_info *si; 26350216a895SLior David 26360216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 26370216a895SLior David return -EOPNOTSUPP; 26380216a895SLior David 26398cb08174SJohannes Berg rc = nla_parse_deprecated(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, 26408cb08174SJohannes Berg data_len, wil_rf_sector_policy, NULL); 26410216a895SLior David if (rc) { 26420216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 26430216a895SLior David return rc; 26440216a895SLior David } 26450216a895SLior David 26460216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_INDEX] || 26470216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_TYPE] || 26480216a895SLior David !tb[QCA_ATTR_DMG_RF_MODULE_MASK]) { 26490216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 26500216a895SLior David return -EINVAL; 26510216a895SLior David } 26520216a895SLior David 26530216a895SLior David sector_index = nla_get_u16( 26540216a895SLior David tb[QCA_ATTR_DMG_RF_SECTOR_INDEX]); 26550216a895SLior David if (sector_index >= WIL_MAX_RF_SECTORS) { 26560216a895SLior David wil_err(wil, "Invalid sector index %d\n", sector_index); 26570216a895SLior David return -EINVAL; 26580216a895SLior David } 26590216a895SLior David 26600216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 26610216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 26620216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 26630216a895SLior David return -EINVAL; 26640216a895SLior David } 26650216a895SLior David 26660216a895SLior David rf_modules_vec = nla_get_u32( 26670216a895SLior David tb[QCA_ATTR_DMG_RF_MODULE_MASK]); 26680216a895SLior David if (rf_modules_vec >= BIT(WMI_MAX_RF_MODULES_NUM)) { 26690216a895SLior David wil_err(wil, "Invalid rf module mask 0x%x\n", rf_modules_vec); 26700216a895SLior David return -EINVAL; 26710216a895SLior David } 26720216a895SLior David 26730216a895SLior David cmd.sector_idx = cpu_to_le16(sector_index); 26740216a895SLior David cmd.sector_type = sector_type; 26750216a895SLior David cmd.rf_modules_vec = rf_modules_vec & 0xFF; 2676e00243faSLior David rc = wmi_call(wil, WMI_GET_RF_SECTOR_PARAMS_CMDID, vif->mid, 2677e00243faSLior David &cmd, sizeof(cmd), WMI_GET_RF_SECTOR_PARAMS_DONE_EVENTID, 26780216a895SLior David &reply, sizeof(reply), 26790216a895SLior David 500); 26800216a895SLior David if (rc) 26810216a895SLior David return rc; 26820216a895SLior David if (reply.evt.status) { 26830216a895SLior David wil_err(wil, "get rf sector cfg failed with status %d\n", 26840216a895SLior David reply.evt.status); 26850216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 26860216a895SLior David } 26870216a895SLior David 26880216a895SLior David msg = cfg80211_vendor_cmd_alloc_reply_skb( 26890216a895SLior David wiphy, 64 * WMI_MAX_RF_MODULES_NUM); 26900216a895SLior David if (!msg) 26910216a895SLior David return -ENOMEM; 26920216a895SLior David 26930216a895SLior David if (nla_put_u64_64bit(msg, QCA_ATTR_TSF, 26940216a895SLior David le64_to_cpu(reply.evt.tsf), 26950216a895SLior David QCA_ATTR_PAD)) 26960216a895SLior David goto nla_put_failure; 26970216a895SLior David 2698ae0be8deSMichal Kubecek nl_cfgs = nla_nest_start_noflag(msg, QCA_ATTR_DMG_RF_SECTOR_CFG); 26990216a895SLior David if (!nl_cfgs) 27000216a895SLior David goto nla_put_failure; 27010216a895SLior David for (i = 0; i < WMI_MAX_RF_MODULES_NUM; i++) { 27020216a895SLior David if (!(rf_modules_vec & BIT(i))) 27030216a895SLior David continue; 2704ae0be8deSMichal Kubecek nl_cfg = nla_nest_start_noflag(msg, i); 27050216a895SLior David if (!nl_cfg) 27060216a895SLior David goto nla_put_failure; 27070216a895SLior David si = &reply.evt.sectors_info[i]; 27080216a895SLior David if (nla_put_u8(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX, 27090216a895SLior David i) || 27100216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0, 27110216a895SLior David le32_to_cpu(si->etype0)) || 27120216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1, 27130216a895SLior David le32_to_cpu(si->etype1)) || 27140216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2, 27150216a895SLior David le32_to_cpu(si->etype2)) || 27160216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI, 27170216a895SLior David le32_to_cpu(si->psh_hi)) || 27180216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO, 27190216a895SLior David le32_to_cpu(si->psh_lo)) || 27200216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16, 27210216a895SLior David le32_to_cpu(si->dtype_swch_off))) 27220216a895SLior David goto nla_put_failure; 27230216a895SLior David nla_nest_end(msg, nl_cfg); 27240216a895SLior David } 27250216a895SLior David 27260216a895SLior David nla_nest_end(msg, nl_cfgs); 27270216a895SLior David rc = cfg80211_vendor_cmd_reply(msg); 27280216a895SLior David return rc; 27290216a895SLior David nla_put_failure: 27300216a895SLior David kfree_skb(msg); 27310216a895SLior David return -ENOBUFS; 27320216a895SLior David } 27330216a895SLior David 27340216a895SLior David static int wil_rf_sector_set_cfg(struct wiphy *wiphy, 27350216a895SLior David struct wireless_dev *wdev, 27360216a895SLior David const void *data, int data_len) 27370216a895SLior David { 27380216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2739e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 27400216a895SLior David int rc, tmp; 27410216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 27420216a895SLior David struct nlattr *tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_MAX + 1]; 27430216a895SLior David u16 sector_index, rf_module_index; 27440216a895SLior David u8 sector_type; 27450216a895SLior David u32 rf_modules_vec = 0; 27460216a895SLior David struct wmi_set_rf_sector_params_cmd cmd; 27470216a895SLior David struct { 27480216a895SLior David struct wmi_cmd_hdr wmi; 27490216a895SLior David struct wmi_set_rf_sector_params_done_event evt; 2750807b0860SAlexei Avshalom Lazar } __packed reply = { 2751807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2752807b0860SAlexei Avshalom Lazar }; 27530216a895SLior David struct nlattr *nl_cfg; 27540216a895SLior David struct wmi_rf_sector_info *si; 27550216a895SLior David 27560216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 27570216a895SLior David return -EOPNOTSUPP; 27580216a895SLior David 27598cb08174SJohannes Berg rc = nla_parse_deprecated(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, 27608cb08174SJohannes Berg data_len, wil_rf_sector_policy, NULL); 27610216a895SLior David if (rc) { 27620216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 27630216a895SLior David return rc; 27640216a895SLior David } 27650216a895SLior David 27660216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_INDEX] || 27670216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_TYPE] || 27680216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_CFG]) { 27690216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 27700216a895SLior David return -EINVAL; 27710216a895SLior David } 27720216a895SLior David 27730216a895SLior David sector_index = nla_get_u16( 27740216a895SLior David tb[QCA_ATTR_DMG_RF_SECTOR_INDEX]); 27750216a895SLior David if (sector_index >= WIL_MAX_RF_SECTORS) { 27760216a895SLior David wil_err(wil, "Invalid sector index %d\n", sector_index); 27770216a895SLior David return -EINVAL; 27780216a895SLior David } 27790216a895SLior David 27800216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 27810216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 27820216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 27830216a895SLior David return -EINVAL; 27840216a895SLior David } 27850216a895SLior David 27860216a895SLior David memset(&cmd, 0, sizeof(cmd)); 27870216a895SLior David 27880216a895SLior David cmd.sector_idx = cpu_to_le16(sector_index); 27890216a895SLior David cmd.sector_type = sector_type; 27900216a895SLior David nla_for_each_nested(nl_cfg, tb[QCA_ATTR_DMG_RF_SECTOR_CFG], 27910216a895SLior David tmp) { 27928cb08174SJohannes Berg rc = nla_parse_nested_deprecated(tb2, 27938cb08174SJohannes Berg QCA_ATTR_DMG_RF_SECTOR_CFG_MAX, 27948cb08174SJohannes Berg nl_cfg, 27958cb08174SJohannes Berg wil_rf_sector_cfg_policy, 27960216a895SLior David NULL); 27970216a895SLior David if (rc) { 27980216a895SLior David wil_err(wil, "invalid sector cfg\n"); 27990216a895SLior David return -EINVAL; 28000216a895SLior David } 28010216a895SLior David 28020216a895SLior David if (!tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX] || 28030216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0] || 28040216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1] || 28050216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2] || 28060216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI] || 28070216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO] || 28080216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16]) { 28090216a895SLior David wil_err(wil, "missing cfg params\n"); 28100216a895SLior David return -EINVAL; 28110216a895SLior David } 28120216a895SLior David 28130216a895SLior David rf_module_index = nla_get_u8( 28140216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX]); 28150216a895SLior David if (rf_module_index >= WMI_MAX_RF_MODULES_NUM) { 28160216a895SLior David wil_err(wil, "invalid RF module index %d\n", 28170216a895SLior David rf_module_index); 28180216a895SLior David return -EINVAL; 28190216a895SLior David } 28200216a895SLior David rf_modules_vec |= BIT(rf_module_index); 28210216a895SLior David si = &cmd.sectors_info[rf_module_index]; 28220216a895SLior David si->etype0 = cpu_to_le32(nla_get_u32( 28230216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0])); 28240216a895SLior David si->etype1 = cpu_to_le32(nla_get_u32( 28250216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1])); 28260216a895SLior David si->etype2 = cpu_to_le32(nla_get_u32( 28270216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2])); 28280216a895SLior David si->psh_hi = cpu_to_le32(nla_get_u32( 28290216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI])); 28300216a895SLior David si->psh_lo = cpu_to_le32(nla_get_u32( 28310216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO])); 28320216a895SLior David si->dtype_swch_off = cpu_to_le32(nla_get_u32( 28330216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16])); 28340216a895SLior David } 28350216a895SLior David 28360216a895SLior David cmd.rf_modules_vec = rf_modules_vec & 0xFF; 2837e00243faSLior David rc = wmi_call(wil, WMI_SET_RF_SECTOR_PARAMS_CMDID, vif->mid, 2838e00243faSLior David &cmd, sizeof(cmd), WMI_SET_RF_SECTOR_PARAMS_DONE_EVENTID, 28390216a895SLior David &reply, sizeof(reply), 28400216a895SLior David 500); 28410216a895SLior David if (rc) 28420216a895SLior David return rc; 28430216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 28440216a895SLior David } 28450216a895SLior David 28460216a895SLior David static int wil_rf_sector_get_selected(struct wiphy *wiphy, 28470216a895SLior David struct wireless_dev *wdev, 28480216a895SLior David const void *data, int data_len) 28490216a895SLior David { 28500216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2851e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 28520216a895SLior David int rc; 28530216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 28540216a895SLior David u8 sector_type, mac_addr[ETH_ALEN]; 28550216a895SLior David int cid = 0; 28560216a895SLior David struct wmi_get_selected_rf_sector_index_cmd cmd; 28570216a895SLior David struct { 28580216a895SLior David struct wmi_cmd_hdr wmi; 28590216a895SLior David struct wmi_get_selected_rf_sector_index_done_event evt; 2860807b0860SAlexei Avshalom Lazar } __packed reply = { 2861807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2862807b0860SAlexei Avshalom Lazar }; 28630216a895SLior David struct sk_buff *msg; 28640216a895SLior David 28650216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 28660216a895SLior David return -EOPNOTSUPP; 28670216a895SLior David 28688cb08174SJohannes Berg rc = nla_parse_deprecated(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, 28698cb08174SJohannes Berg data_len, wil_rf_sector_policy, NULL); 28700216a895SLior David if (rc) { 28710216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 28720216a895SLior David return rc; 28730216a895SLior David } 28740216a895SLior David 28750216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]) { 28760216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 28770216a895SLior David return -EINVAL; 28780216a895SLior David } 28790216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 28800216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 28810216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 28820216a895SLior David return -EINVAL; 28830216a895SLior David } 28840216a895SLior David 28850216a895SLior David if (tb[QCA_ATTR_MAC_ADDR]) { 28860216a895SLior David ether_addr_copy(mac_addr, nla_data(tb[QCA_ATTR_MAC_ADDR])); 2887e00243faSLior David cid = wil_find_cid(wil, vif->mid, mac_addr); 28880216a895SLior David if (cid < 0) { 28890216a895SLior David wil_err(wil, "invalid MAC address %pM\n", mac_addr); 28900216a895SLior David return -ENOENT; 28910216a895SLior David } 28920216a895SLior David } else { 28935bd60982SLior David if (test_bit(wil_vif_fwconnected, vif->status)) { 28940216a895SLior David wil_err(wil, "must specify MAC address when connected\n"); 28950216a895SLior David return -EINVAL; 28960216a895SLior David } 28970216a895SLior David } 28980216a895SLior David 28990216a895SLior David memset(&cmd, 0, sizeof(cmd)); 29000216a895SLior David cmd.cid = (u8)cid; 29010216a895SLior David cmd.sector_type = sector_type; 2902e00243faSLior David rc = wmi_call(wil, WMI_GET_SELECTED_RF_SECTOR_INDEX_CMDID, vif->mid, 29030216a895SLior David &cmd, sizeof(cmd), 29040216a895SLior David WMI_GET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID, 29050216a895SLior David &reply, sizeof(reply), 29060216a895SLior David 500); 29070216a895SLior David if (rc) 29080216a895SLior David return rc; 29090216a895SLior David if (reply.evt.status) { 29100216a895SLior David wil_err(wil, "get rf selected sector cfg failed with status %d\n", 29110216a895SLior David reply.evt.status); 29120216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 29130216a895SLior David } 29140216a895SLior David 29150216a895SLior David msg = cfg80211_vendor_cmd_alloc_reply_skb( 29160216a895SLior David wiphy, 64 * WMI_MAX_RF_MODULES_NUM); 29170216a895SLior David if (!msg) 29180216a895SLior David return -ENOMEM; 29190216a895SLior David 29200216a895SLior David if (nla_put_u64_64bit(msg, QCA_ATTR_TSF, 29210216a895SLior David le64_to_cpu(reply.evt.tsf), 29220216a895SLior David QCA_ATTR_PAD) || 29230216a895SLior David nla_put_u16(msg, QCA_ATTR_DMG_RF_SECTOR_INDEX, 29240216a895SLior David le16_to_cpu(reply.evt.sector_idx))) 29250216a895SLior David goto nla_put_failure; 29260216a895SLior David 29270216a895SLior David rc = cfg80211_vendor_cmd_reply(msg); 29280216a895SLior David return rc; 29290216a895SLior David nla_put_failure: 29300216a895SLior David kfree_skb(msg); 29310216a895SLior David return -ENOBUFS; 29320216a895SLior David } 29330216a895SLior David 29340216a895SLior David static int wil_rf_sector_wmi_set_selected(struct wil6210_priv *wil, 2935e00243faSLior David u8 mid, u16 sector_index, 29360216a895SLior David u8 sector_type, u8 cid) 29370216a895SLior David { 29380216a895SLior David struct wmi_set_selected_rf_sector_index_cmd cmd; 29390216a895SLior David struct { 29400216a895SLior David struct wmi_cmd_hdr wmi; 29410216a895SLior David struct wmi_set_selected_rf_sector_index_done_event evt; 2942807b0860SAlexei Avshalom Lazar } __packed reply = { 2943807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2944807b0860SAlexei Avshalom Lazar }; 29450216a895SLior David int rc; 29460216a895SLior David 29470216a895SLior David memset(&cmd, 0, sizeof(cmd)); 29480216a895SLior David cmd.sector_idx = cpu_to_le16(sector_index); 29490216a895SLior David cmd.sector_type = sector_type; 29500216a895SLior David cmd.cid = (u8)cid; 2951e00243faSLior David rc = wmi_call(wil, WMI_SET_SELECTED_RF_SECTOR_INDEX_CMDID, mid, 29520216a895SLior David &cmd, sizeof(cmd), 29530216a895SLior David WMI_SET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID, 29540216a895SLior David &reply, sizeof(reply), 29550216a895SLior David 500); 29560216a895SLior David if (rc) 29570216a895SLior David return rc; 29580216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 29590216a895SLior David } 29600216a895SLior David 29610216a895SLior David static int wil_rf_sector_set_selected(struct wiphy *wiphy, 29620216a895SLior David struct wireless_dev *wdev, 29630216a895SLior David const void *data, int data_len) 29640216a895SLior David { 29650216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2966e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 29670216a895SLior David int rc; 29680216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 29690216a895SLior David u16 sector_index; 29700216a895SLior David u8 sector_type, mac_addr[ETH_ALEN], i; 29710216a895SLior David int cid = 0; 29720216a895SLior David 29730216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 29740216a895SLior David return -EOPNOTSUPP; 29750216a895SLior David 29768cb08174SJohannes Berg rc = nla_parse_deprecated(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, 29778cb08174SJohannes Berg data_len, wil_rf_sector_policy, NULL); 29780216a895SLior David if (rc) { 29790216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 29800216a895SLior David return rc; 29810216a895SLior David } 29820216a895SLior David 29830216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_INDEX] || 29840216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]) { 29850216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 29860216a895SLior David return -EINVAL; 29870216a895SLior David } 29880216a895SLior David 29890216a895SLior David sector_index = nla_get_u16( 29900216a895SLior David tb[QCA_ATTR_DMG_RF_SECTOR_INDEX]); 29910216a895SLior David if (sector_index >= WIL_MAX_RF_SECTORS && 29920216a895SLior David sector_index != WMI_INVALID_RF_SECTOR_INDEX) { 29930216a895SLior David wil_err(wil, "Invalid sector index %d\n", sector_index); 29940216a895SLior David return -EINVAL; 29950216a895SLior David } 29960216a895SLior David 29970216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 29980216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 29990216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 30000216a895SLior David return -EINVAL; 30010216a895SLior David } 30020216a895SLior David 30030216a895SLior David if (tb[QCA_ATTR_MAC_ADDR]) { 30040216a895SLior David ether_addr_copy(mac_addr, nla_data(tb[QCA_ATTR_MAC_ADDR])); 30050216a895SLior David if (!is_broadcast_ether_addr(mac_addr)) { 3006e00243faSLior David cid = wil_find_cid(wil, vif->mid, mac_addr); 30070216a895SLior David if (cid < 0) { 30080216a895SLior David wil_err(wil, "invalid MAC address %pM\n", 30090216a895SLior David mac_addr); 30100216a895SLior David return -ENOENT; 30110216a895SLior David } 30120216a895SLior David } else { 30130216a895SLior David if (sector_index != WMI_INVALID_RF_SECTOR_INDEX) { 30140216a895SLior David wil_err(wil, "broadcast MAC valid only with unlocking\n"); 30150216a895SLior David return -EINVAL; 30160216a895SLior David } 30170216a895SLior David cid = -1; 30180216a895SLior David } 30190216a895SLior David } else { 30205bd60982SLior David if (test_bit(wil_vif_fwconnected, vif->status)) { 30210216a895SLior David wil_err(wil, "must specify MAC address when connected\n"); 30220216a895SLior David return -EINVAL; 30230216a895SLior David } 30240216a895SLior David /* otherwise, using cid=0 for unassociated station */ 30250216a895SLior David } 30260216a895SLior David 30270216a895SLior David if (cid >= 0) { 3028e00243faSLior David rc = wil_rf_sector_wmi_set_selected(wil, vif->mid, sector_index, 30290216a895SLior David sector_type, cid); 30300216a895SLior David } else { 30310216a895SLior David /* unlock all cids */ 30320216a895SLior David rc = wil_rf_sector_wmi_set_selected( 3033e00243faSLior David wil, vif->mid, WMI_INVALID_RF_SECTOR_INDEX, 3034e00243faSLior David sector_type, WIL_CID_ALL); 30350216a895SLior David if (rc == -EINVAL) { 3036ddf7afddSAhmad Masri for (i = 0; i < wil->max_assoc_sta; i++) { 3037e00243faSLior David if (wil->sta[i].mid != vif->mid) 3038e00243faSLior David continue; 30390216a895SLior David rc = wil_rf_sector_wmi_set_selected( 3040e00243faSLior David wil, vif->mid, 3041e00243faSLior David WMI_INVALID_RF_SECTOR_INDEX, 30420216a895SLior David sector_type, i); 30430216a895SLior David /* the FW will silently ignore and return 30440216a895SLior David * success for unused cid, so abort the loop 30450216a895SLior David * on any other error 30460216a895SLior David */ 30470216a895SLior David if (rc) { 30480216a895SLior David wil_err(wil, "unlock cid %d failed with status %d\n", 30490216a895SLior David i, rc); 30500216a895SLior David break; 30510216a895SLior David } 30520216a895SLior David } 30530216a895SLior David } 30540216a895SLior David } 30550216a895SLior David 30560216a895SLior David return rc; 30570216a895SLior David } 3058