12be7d22fSVladimir Kondratiev /* 2849a564bSDedy Lansky * Copyright (c) 2012-2017 Qualcomm Atheros, Inc. 39f38f286SLior David * Copyright (c) 2018, 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); 383ef28afdbSVladimir Kondratiev if (cid < 0) 384c14c5d99SVladimir Kondratiev return cid; 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 398ef28afdbSVladimir Kondratiev for (i = 0; i < ARRAY_SIZE(wil->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 420ef28afdbSVladimir Kondratiev if (cid < 0) 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 4684aebd3bdSLior David for (i = 0; i < wil->max_vifs; 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 4894aebd3bdSLior David for (i = 0; i < wil->max_vifs; 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 6462be7d22fSVladimir Kondratiev static int wil_cfg80211_change_iface(struct wiphy *wiphy, 6472be7d22fSVladimir Kondratiev struct net_device *ndev, 648818a986eSJohannes Berg enum nl80211_iftype type, 6492be7d22fSVladimir Kondratiev struct vif_params *params) 6502be7d22fSVladimir Kondratiev { 6512be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 652e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 653e00243faSLior David struct wireless_dev *wdev = vif_to_wdev(vif); 654e6d68341SDedy Lansky int rc; 6553ada9314SLior David bool fw_reset = false; 656e6d68341SDedy Lansky 657af3db60aSLazar Alexei wil_dbg_misc(wil, "change_iface: type=%d\n", type); 658e6d68341SDedy Lansky 6594aebd3bdSLior David if (wiphy->n_iface_combinations) { 6604aebd3bdSLior David rc = wil_cfg80211_validate_change_iface(wil, vif, type); 6614aebd3bdSLior David if (rc) { 6624aebd3bdSLior David wil_err(wil, "iface validation failed, err=%d\n", rc); 6634aebd3bdSLior David return rc; 6644aebd3bdSLior David } 6654aebd3bdSLior David } 6664aebd3bdSLior David 6674aebd3bdSLior David /* do not reset FW when there are active VIFs, 6684aebd3bdSLior David * because it can cause significant disruption 6694aebd3bdSLior David */ 6703ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, true, false) && 6714aebd3bdSLior David netif_running(ndev) && !wil_is_recovery_blocked(wil)) { 672e6d68341SDedy Lansky wil_dbg_misc(wil, "interface is up. resetting...\n"); 673e6d68341SDedy Lansky mutex_lock(&wil->mutex); 674e6d68341SDedy Lansky __wil_down(wil); 675e6d68341SDedy Lansky rc = __wil_up(wil); 676e6d68341SDedy Lansky mutex_unlock(&wil->mutex); 677e6d68341SDedy Lansky 678e6d68341SDedy Lansky if (rc) 679e6d68341SDedy Lansky return rc; 6803ada9314SLior David fw_reset = true; 681e6d68341SDedy Lansky } 6822be7d22fSVladimir Kondratiev 6832be7d22fSVladimir Kondratiev switch (type) { 6842be7d22fSVladimir Kondratiev case NL80211_IFTYPE_STATION: 6852be7d22fSVladimir Kondratiev case NL80211_IFTYPE_AP: 6862be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 6872be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_GO: 6882be7d22fSVladimir Kondratiev break; 6892be7d22fSVladimir Kondratiev case NL80211_IFTYPE_MONITOR: 690818a986eSJohannes Berg if (params->flags) 691818a986eSJohannes Berg wil->monitor_flags = params->flags; 6922be7d22fSVladimir Kondratiev break; 6932be7d22fSVladimir Kondratiev default: 6942be7d22fSVladimir Kondratiev return -EOPNOTSUPP; 6952be7d22fSVladimir Kondratiev } 6962be7d22fSVladimir Kondratiev 6973ada9314SLior David if (vif->mid != 0 && wil_has_active_ifaces(wil, true, false)) { 6983ada9314SLior David if (!fw_reset) 6993ada9314SLior David wil_vif_prepare_stop(vif); 7004aebd3bdSLior David rc = wmi_port_delete(wil, vif->mid); 7014aebd3bdSLior David if (rc) 7024aebd3bdSLior David return rc; 7034aebd3bdSLior David rc = wmi_port_allocate(wil, vif->mid, ndev->dev_addr, type); 7044aebd3bdSLior David if (rc) 7054aebd3bdSLior David return rc; 7064aebd3bdSLior David } 7072be7d22fSVladimir Kondratiev 7084aebd3bdSLior David wdev->iftype = type; 7092be7d22fSVladimir Kondratiev return 0; 7102be7d22fSVladimir Kondratiev } 7112be7d22fSVladimir Kondratiev 7122be7d22fSVladimir Kondratiev static int wil_cfg80211_scan(struct wiphy *wiphy, 7132be7d22fSVladimir Kondratiev struct cfg80211_scan_request *request) 7142be7d22fSVladimir Kondratiev { 7152be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 7164332cac1SLior David struct wireless_dev *wdev = request->wdev; 717e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 7182be7d22fSVladimir Kondratiev struct { 7192be7d22fSVladimir Kondratiev struct wmi_start_scan_cmd cmd; 7202be7d22fSVladimir Kondratiev u16 chnl[4]; 7212be7d22fSVladimir Kondratiev } __packed cmd; 7222be7d22fSVladimir Kondratiev uint i, n; 723ed6f9dc6SVladimir Kondratiev int rc; 7242be7d22fSVladimir Kondratiev 725af3db60aSLazar Alexei wil_dbg_misc(wil, "scan: wdev=0x%p iftype=%d\n", wdev, wdev->iftype); 726e6d68341SDedy Lansky 727af2cd85eSAhmad Masri /* scan is supported on client interfaces and on AP interface */ 7282be7d22fSVladimir Kondratiev switch (wdev->iftype) { 7292be7d22fSVladimir Kondratiev case NL80211_IFTYPE_STATION: 7302be7d22fSVladimir Kondratiev case NL80211_IFTYPE_P2P_CLIENT: 7314332cac1SLior David case NL80211_IFTYPE_P2P_DEVICE: 732af2cd85eSAhmad Masri case NL80211_IFTYPE_AP: 7332be7d22fSVladimir Kondratiev break; 7342be7d22fSVladimir Kondratiev default: 7352be7d22fSVladimir Kondratiev return -EOPNOTSUPP; 7362be7d22fSVladimir Kondratiev } 7372be7d22fSVladimir Kondratiev 7382be7d22fSVladimir Kondratiev /* FW don't support scan after connection attempt */ 7399419b6a2SVladimir Kondratiev if (test_bit(wil_status_dontscan, wil->status)) { 740e83eb2fcSVladimir Kondratiev wil_err(wil, "Can't scan now\n"); 7412be7d22fSVladimir Kondratiev return -EBUSY; 7422be7d22fSVladimir Kondratiev } 7432be7d22fSVladimir Kondratiev 744bb6743f7SLior David mutex_lock(&wil->mutex); 745bb6743f7SLior David 746404bbb3cSLior David mutex_lock(&wil->vif_mutex); 747e00243faSLior David if (vif->scan_request || vif->p2p.discovery_started) { 748bb6743f7SLior David wil_err(wil, "Already scanning\n"); 749404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 750bb6743f7SLior David rc = -EAGAIN; 751bb6743f7SLior David goto out; 752bb6743f7SLior David } 753404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 754bb6743f7SLior David 7554a0e45a7SLior David if (wdev->iftype == NL80211_IFTYPE_P2P_DEVICE) { 756e00243faSLior David if (!wil->p2p_dev_started) { 757eb57a5b3SLior David wil_err(wil, "P2P search requested on stopped P2P device\n"); 758bb6743f7SLior David rc = -EIO; 759bb6743f7SLior David goto out; 760eb57a5b3SLior David } 7614a0e45a7SLior David /* social scan on P2P_DEVICE is handled as p2p search */ 7624a0e45a7SLior David if (wil_p2p_is_social_scan(request)) { 763e00243faSLior David vif->scan_request = request; 764e00243faSLior David if (vif->mid == 0) 7654332cac1SLior David wil->radio_wdev = wdev; 766e00243faSLior David rc = wil_p2p_search(vif, request); 7674332cac1SLior David if (rc) { 768e00243faSLior David if (vif->mid == 0) 769e00243faSLior David wil->radio_wdev = 770e00243faSLior David wil->main_ndev->ieee80211_ptr; 771e00243faSLior David vif->scan_request = NULL; 7724332cac1SLior David } 773bb6743f7SLior David goto out; 774e6d68341SDedy Lansky } 7754a0e45a7SLior David } 776e6d68341SDedy Lansky 777e00243faSLior David (void)wil_p2p_stop_discovery(vif); 778e6d68341SDedy Lansky 7792a91d7d0SVladimir Kondratiev wil_dbg_misc(wil, "Start scan_request 0x%p\n", request); 7808e52fe30SHamad Kadmany wil_dbg_misc(wil, "SSID count: %d", request->n_ssids); 7818e52fe30SHamad Kadmany 7828e52fe30SHamad Kadmany for (i = 0; i < request->n_ssids; i++) { 7838e52fe30SHamad Kadmany wil_dbg_misc(wil, "SSID[%d]", i); 7845eb443e9SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 7858e52fe30SHamad Kadmany request->ssids[i].ssid, 7865eb443e9SDedy Lansky request->ssids[i].ssid_len, true); 7878e52fe30SHamad Kadmany } 7888e52fe30SHamad Kadmany 7898e52fe30SHamad Kadmany if (request->n_ssids) 790e00243faSLior David rc = wmi_set_ssid(vif, request->ssids[0].ssid_len, 7918e52fe30SHamad Kadmany request->ssids[0].ssid); 7928e52fe30SHamad Kadmany else 793e00243faSLior David rc = wmi_set_ssid(vif, 0, NULL); 7948e52fe30SHamad Kadmany 7958e52fe30SHamad Kadmany if (rc) { 7968e52fe30SHamad Kadmany wil_err(wil, "set SSID for scan request failed: %d\n", rc); 797bb6743f7SLior David goto out; 7988e52fe30SHamad Kadmany } 7998e52fe30SHamad Kadmany 800e00243faSLior David vif->scan_request = request; 801e00243faSLior David mod_timer(&vif->scan_timer, jiffies + WIL6210_SCAN_TO); 8022be7d22fSVladimir Kondratiev 8032be7d22fSVladimir Kondratiev memset(&cmd, 0, sizeof(cmd)); 80474997a53SLior David cmd.cmd.scan_type = WMI_ACTIVE_SCAN; 8052be7d22fSVladimir Kondratiev cmd.cmd.num_channels = 0; 8062be7d22fSVladimir Kondratiev n = min(request->n_channels, 4U); 8072be7d22fSVladimir Kondratiev for (i = 0; i < n; i++) { 8082be7d22fSVladimir Kondratiev int ch = request->channels[i]->hw_value; 8098fe59627SVladimir Kondratiev 8102be7d22fSVladimir Kondratiev if (ch == 0) { 8112be7d22fSVladimir Kondratiev wil_err(wil, 8122be7d22fSVladimir Kondratiev "Scan requested for unknown frequency %dMhz\n", 8132be7d22fSVladimir Kondratiev request->channels[i]->center_freq); 8142be7d22fSVladimir Kondratiev continue; 8152be7d22fSVladimir Kondratiev } 8162be7d22fSVladimir Kondratiev /* 0-based channel indexes */ 8172be7d22fSVladimir Kondratiev cmd.cmd.channel_list[cmd.cmd.num_channels++].channel = ch - 1; 8187743882dSVladimir Kondratiev wil_dbg_misc(wil, "Scan for ch %d : %d MHz\n", ch, 8192be7d22fSVladimir Kondratiev request->channels[i]->center_freq); 8202be7d22fSVladimir Kondratiev } 8212be7d22fSVladimir Kondratiev 82277c91295SVladimir Kondratiev if (request->ie_len) 8235eb443e9SDedy Lansky wil_hex_dump_misc("Scan IE ", DUMP_PREFIX_OFFSET, 16, 1, 8245eb443e9SDedy Lansky request->ie, request->ie_len, true); 82577c91295SVladimir Kondratiev else 82677c91295SVladimir Kondratiev wil_dbg_misc(wil, "Scan has no IE's\n"); 82777c91295SVladimir Kondratiev 828e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_PROBE_REQ, 829e00243faSLior David request->ie_len, request->ie); 8305421bf0cSVladimir Kondratiev if (rc) 831bb6743f7SLior David goto out_restore; 83277c91295SVladimir Kondratiev 83374997a53SLior David if (wil->discovery_mode && cmd.cmd.scan_type == WMI_ACTIVE_SCAN) { 83474997a53SLior David cmd.cmd.discovery_mode = 1; 83574997a53SLior David wil_dbg_misc(wil, "active scan with discovery_mode=1\n"); 83674997a53SLior David } 83774997a53SLior David 838e00243faSLior David if (vif->mid == 0) 8394332cac1SLior David wil->radio_wdev = wdev; 840e00243faSLior David rc = wmi_send(wil, WMI_START_SCAN_CMDID, vif->mid, 841e00243faSLior David &cmd, sizeof(cmd.cmd) + 8422be7d22fSVladimir Kondratiev cmd.cmd.num_channels * sizeof(cmd.cmd.channel_list[0])); 843ed6f9dc6SVladimir Kondratiev 844bb6743f7SLior David out_restore: 845a2142086SVladimir Kondratiev if (rc) { 846e00243faSLior David del_timer_sync(&vif->scan_timer); 847e00243faSLior David if (vif->mid == 0) 848e00243faSLior David wil->radio_wdev = wil->main_ndev->ieee80211_ptr; 849e00243faSLior David vif->scan_request = NULL; 850a2142086SVladimir Kondratiev } 851bb6743f7SLior David out: 852bb6743f7SLior David mutex_unlock(&wil->mutex); 853ed6f9dc6SVladimir Kondratiev return rc; 8542be7d22fSVladimir Kondratiev } 8552be7d22fSVladimir Kondratiev 856035859a5SMaya Erez static void wil_cfg80211_abort_scan(struct wiphy *wiphy, 857035859a5SMaya Erez struct wireless_dev *wdev) 858035859a5SMaya Erez { 859035859a5SMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 860e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 861035859a5SMaya Erez 862035859a5SMaya Erez wil_dbg_misc(wil, "wdev=0x%p iftype=%d\n", wdev, wdev->iftype); 863035859a5SMaya Erez 864035859a5SMaya Erez mutex_lock(&wil->mutex); 865404bbb3cSLior David mutex_lock(&wil->vif_mutex); 866035859a5SMaya Erez 867e00243faSLior David if (!vif->scan_request) 868035859a5SMaya Erez goto out; 869035859a5SMaya Erez 870e00243faSLior David if (wdev != vif->scan_request->wdev) { 871035859a5SMaya Erez wil_dbg_misc(wil, "abort scan was called on the wrong iface\n"); 872035859a5SMaya Erez goto out; 873035859a5SMaya Erez } 874035859a5SMaya Erez 875e00243faSLior David if (wdev == wil->p2p_wdev && wil->radio_wdev == wil->p2p_wdev) 876035859a5SMaya Erez wil_p2p_stop_radio_operations(wil); 877035859a5SMaya Erez else 878e00243faSLior David wil_abort_scan(vif, true); 879035859a5SMaya Erez 880035859a5SMaya Erez out: 881404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 882035859a5SMaya Erez mutex_unlock(&wil->mutex); 883035859a5SMaya Erez } 884035859a5SMaya Erez 885feeac225SVladimir Kondratiev static void wil_print_crypto(struct wil6210_priv *wil, 886feeac225SVladimir Kondratiev struct cfg80211_crypto_settings *c) 887feeac225SVladimir Kondratiev { 888feeac225SVladimir Kondratiev int i, n; 889feeac225SVladimir Kondratiev 890feeac225SVladimir Kondratiev wil_dbg_misc(wil, "WPA versions: 0x%08x cipher group 0x%08x\n", 891feeac225SVladimir Kondratiev c->wpa_versions, c->cipher_group); 892feeac225SVladimir Kondratiev wil_dbg_misc(wil, "Pairwise ciphers [%d] {\n", c->n_ciphers_pairwise); 893feeac225SVladimir Kondratiev n = min_t(int, c->n_ciphers_pairwise, ARRAY_SIZE(c->ciphers_pairwise)); 894feeac225SVladimir Kondratiev for (i = 0; i < n; i++) 895feeac225SVladimir Kondratiev wil_dbg_misc(wil, " [%d] = 0x%08x\n", i, 896feeac225SVladimir Kondratiev c->ciphers_pairwise[i]); 897feeac225SVladimir Kondratiev wil_dbg_misc(wil, "}\n"); 898feeac225SVladimir Kondratiev wil_dbg_misc(wil, "AKM suites [%d] {\n", c->n_akm_suites); 899feeac225SVladimir Kondratiev n = min_t(int, c->n_akm_suites, ARRAY_SIZE(c->akm_suites)); 900feeac225SVladimir Kondratiev for (i = 0; i < n; i++) 901feeac225SVladimir Kondratiev wil_dbg_misc(wil, " [%d] = 0x%08x\n", i, 902feeac225SVladimir Kondratiev c->akm_suites[i]); 903feeac225SVladimir Kondratiev wil_dbg_misc(wil, "}\n"); 904feeac225SVladimir Kondratiev wil_dbg_misc(wil, "Control port : %d, eth_type 0x%04x no_encrypt %d\n", 905feeac225SVladimir Kondratiev c->control_port, be16_to_cpu(c->control_port_ethertype), 906feeac225SVladimir Kondratiev c->control_port_no_encrypt); 907feeac225SVladimir Kondratiev } 908feeac225SVladimir Kondratiev 909b9010f10SAhmad Masri static const char * 910b9010f10SAhmad Masri wil_get_auth_type_name(enum nl80211_auth_type auth_type) 911b9010f10SAhmad Masri { 912b9010f10SAhmad Masri switch (auth_type) { 913b9010f10SAhmad Masri case NL80211_AUTHTYPE_OPEN_SYSTEM: 914b9010f10SAhmad Masri return "OPEN_SYSTEM"; 915b9010f10SAhmad Masri case NL80211_AUTHTYPE_SHARED_KEY: 916b9010f10SAhmad Masri return "SHARED_KEY"; 917b9010f10SAhmad Masri case NL80211_AUTHTYPE_FT: 918b9010f10SAhmad Masri return "FT"; 919b9010f10SAhmad Masri case NL80211_AUTHTYPE_NETWORK_EAP: 920b9010f10SAhmad Masri return "NETWORK_EAP"; 921b9010f10SAhmad Masri case NL80211_AUTHTYPE_SAE: 922b9010f10SAhmad Masri return "SAE"; 923b9010f10SAhmad Masri case NL80211_AUTHTYPE_AUTOMATIC: 924b9010f10SAhmad Masri return "AUTOMATIC"; 925b9010f10SAhmad Masri default: 926b9010f10SAhmad Masri return "unknown"; 927b9010f10SAhmad Masri } 928b9010f10SAhmad Masri } 9298ca26163SVladimir Kondratiev static void wil_print_connect_params(struct wil6210_priv *wil, 9308ca26163SVladimir Kondratiev struct cfg80211_connect_params *sme) 9318ca26163SVladimir Kondratiev { 9328ca26163SVladimir Kondratiev wil_info(wil, "Connecting to:\n"); 9338ca26163SVladimir Kondratiev if (sme->channel) { 9348ca26163SVladimir Kondratiev wil_info(wil, " Channel: %d freq %d\n", 9358ca26163SVladimir Kondratiev sme->channel->hw_value, sme->channel->center_freq); 9368ca26163SVladimir Kondratiev } 9378ca26163SVladimir Kondratiev if (sme->bssid) 9388ca26163SVladimir Kondratiev wil_info(wil, " BSSID: %pM\n", sme->bssid); 9398ca26163SVladimir Kondratiev if (sme->ssid) 9408ca26163SVladimir Kondratiev print_hex_dump(KERN_INFO, " SSID: ", DUMP_PREFIX_OFFSET, 9418ca26163SVladimir Kondratiev 16, 1, sme->ssid, sme->ssid_len, true); 942b9010f10SAhmad Masri if (sme->prev_bssid) 943b9010f10SAhmad Masri wil_info(wil, " Previous BSSID=%pM\n", sme->prev_bssid); 944b9010f10SAhmad Masri wil_info(wil, " Auth Type: %s\n", 945b9010f10SAhmad Masri wil_get_auth_type_name(sme->auth_type)); 9468ca26163SVladimir Kondratiev wil_info(wil, " Privacy: %s\n", sme->privacy ? "secure" : "open"); 947eabb03b4SLior David wil_info(wil, " PBSS: %d\n", sme->pbss); 948feeac225SVladimir Kondratiev wil_print_crypto(wil, &sme->crypto); 9498ca26163SVladimir Kondratiev } 9508ca26163SVladimir Kondratiev 951b9010f10SAhmad Masri static int wil_ft_connect(struct wiphy *wiphy, 952b9010f10SAhmad Masri struct net_device *ndev, 953b9010f10SAhmad Masri struct cfg80211_connect_params *sme) 954b9010f10SAhmad Masri { 955b9010f10SAhmad Masri struct wil6210_priv *wil = wiphy_to_wil(wiphy); 956b9010f10SAhmad Masri struct wil6210_vif *vif = ndev_to_vif(ndev); 957b9010f10SAhmad Masri struct wmi_ft_auth_cmd auth_cmd; 958b9010f10SAhmad Masri int rc; 959b9010f10SAhmad Masri 960b9010f10SAhmad Masri if (!test_bit(WMI_FW_CAPABILITY_FT_ROAMING, wil->fw_capabilities)) { 961b9010f10SAhmad Masri wil_err(wil, "FT: FW does not support FT roaming\n"); 962b9010f10SAhmad Masri return -EOPNOTSUPP; 963b9010f10SAhmad Masri } 964b9010f10SAhmad Masri 965b9010f10SAhmad Masri if (!sme->prev_bssid) { 966b9010f10SAhmad Masri wil_err(wil, "FT: prev_bssid was not set\n"); 967b9010f10SAhmad Masri return -EINVAL; 968b9010f10SAhmad Masri } 969b9010f10SAhmad Masri 970b9010f10SAhmad Masri if (ether_addr_equal(sme->prev_bssid, sme->bssid)) { 971b9010f10SAhmad Masri wil_err(wil, "FT: can not roam to same AP\n"); 972b9010f10SAhmad Masri return -EINVAL; 973b9010f10SAhmad Masri } 974b9010f10SAhmad Masri 975b9010f10SAhmad Masri if (!test_bit(wil_vif_fwconnected, vif->status)) { 976b9010f10SAhmad Masri wil_err(wil, "FT: roam while not connected\n"); 977b9010f10SAhmad Masri return -EINVAL; 978b9010f10SAhmad Masri } 979b9010f10SAhmad Masri 980b9010f10SAhmad Masri if (vif->privacy != sme->privacy) { 981b9010f10SAhmad Masri wil_err(wil, "FT: privacy mismatch, current (%d) roam (%d)\n", 982b9010f10SAhmad Masri vif->privacy, sme->privacy); 983b9010f10SAhmad Masri return -EINVAL; 984b9010f10SAhmad Masri } 985b9010f10SAhmad Masri 986b9010f10SAhmad Masri if (sme->pbss) { 987b9010f10SAhmad Masri wil_err(wil, "FT: roam is not valid for PBSS\n"); 988b9010f10SAhmad Masri return -EINVAL; 989b9010f10SAhmad Masri } 990b9010f10SAhmad Masri 991b9010f10SAhmad Masri memset(&auth_cmd, 0, sizeof(auth_cmd)); 992b9010f10SAhmad Masri auth_cmd.channel = sme->channel->hw_value - 1; 993b9010f10SAhmad Masri ether_addr_copy(auth_cmd.bssid, sme->bssid); 994b9010f10SAhmad Masri 995b9010f10SAhmad Masri wil_info(wil, "FT: roaming\n"); 996b9010f10SAhmad Masri 997b9010f10SAhmad Masri set_bit(wil_vif_ft_roam, vif->status); 998b9010f10SAhmad Masri rc = wmi_send(wil, WMI_FT_AUTH_CMDID, vif->mid, 999b9010f10SAhmad Masri &auth_cmd, sizeof(auth_cmd)); 1000b9010f10SAhmad Masri if (rc == 0) 1001b9010f10SAhmad Masri mod_timer(&vif->connect_timer, 1002b9010f10SAhmad Masri jiffies + msecs_to_jiffies(5000)); 1003b9010f10SAhmad Masri else 1004b9010f10SAhmad Masri clear_bit(wil_vif_ft_roam, vif->status); 1005b9010f10SAhmad Masri 1006b9010f10SAhmad Masri return rc; 1007b9010f10SAhmad Masri } 1008b9010f10SAhmad Masri 10092be7d22fSVladimir Kondratiev static int wil_cfg80211_connect(struct wiphy *wiphy, 10102be7d22fSVladimir Kondratiev struct net_device *ndev, 10112be7d22fSVladimir Kondratiev struct cfg80211_connect_params *sme) 10122be7d22fSVladimir Kondratiev { 10132be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1014e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 10152be7d22fSVladimir Kondratiev struct cfg80211_bss *bss; 10162be7d22fSVladimir Kondratiev struct wmi_connect_cmd conn; 10172be7d22fSVladimir Kondratiev const u8 *ssid_eid; 10182be7d22fSVladimir Kondratiev const u8 *rsn_eid; 10192be7d22fSVladimir Kondratiev int ch; 10202be7d22fSVladimir Kondratiev int rc = 0; 1021b9010f10SAhmad Masri bool is_ft_roam = false; 1022b9010f10SAhmad Masri u8 network_type; 1023eabb03b4SLior David enum ieee80211_bss_type bss_type = IEEE80211_BSS_TYPE_ESS; 10242be7d22fSVladimir Kondratiev 1025e00243faSLior David wil_dbg_misc(wil, "connect, mid=%d\n", vif->mid); 1026344a7024SVladimir Kondratiev wil_print_connect_params(wil, sme); 1027344a7024SVladimir Kondratiev 1028b9010f10SAhmad Masri if (sme->auth_type == NL80211_AUTHTYPE_FT) 1029b9010f10SAhmad Masri is_ft_roam = true; 1030b9010f10SAhmad Masri if (sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC && 1031b9010f10SAhmad Masri test_bit(wil_vif_fwconnected, vif->status)) 1032b9010f10SAhmad Masri is_ft_roam = true; 1033b9010f10SAhmad Masri 1034b9010f10SAhmad Masri if (!is_ft_roam) 10355bd60982SLior David if (test_bit(wil_vif_fwconnecting, vif->status) || 10365bd60982SLior David test_bit(wil_vif_fwconnected, vif->status)) 10374cd9e837SVladimir Kondratiev return -EALREADY; 10384cd9e837SVladimir Kondratiev 1039344a7024SVladimir Kondratiev if (sme->ie_len > WMI_MAX_IE_LEN) { 1040344a7024SVladimir Kondratiev wil_err(wil, "IE too large (%td bytes)\n", sme->ie_len); 1041344a7024SVladimir Kondratiev return -ERANGE; 1042344a7024SVladimir Kondratiev } 1043344a7024SVladimir Kondratiev 1044344a7024SVladimir Kondratiev rsn_eid = sme->ie ? 1045344a7024SVladimir Kondratiev cfg80211_find_ie(WLAN_EID_RSN, sme->ie, sme->ie_len) : 1046344a7024SVladimir Kondratiev NULL; 1047b9010f10SAhmad Masri if (sme->privacy && !rsn_eid) { 104827aa6b71SVladimir Kondratiev wil_info(wil, "WSC connection\n"); 1049b9010f10SAhmad Masri if (is_ft_roam) { 1050b9010f10SAhmad Masri wil_err(wil, "No WSC with FT roam\n"); 1051b9010f10SAhmad Masri return -EINVAL; 1052b9010f10SAhmad Masri } 1053b9010f10SAhmad Masri } 10548ca26163SVladimir Kondratiev 1055eabb03b4SLior David if (sme->pbss) 1056eabb03b4SLior David bss_type = IEEE80211_BSS_TYPE_PBSS; 105734d50519SLior David 10582be7d22fSVladimir Kondratiev bss = cfg80211_get_bss(wiphy, sme->channel, sme->bssid, 10592be7d22fSVladimir Kondratiev sme->ssid, sme->ssid_len, 1060eabb03b4SLior David bss_type, IEEE80211_PRIVACY_ANY); 10612be7d22fSVladimir Kondratiev if (!bss) { 10622be7d22fSVladimir Kondratiev wil_err(wil, "Unable to find BSS\n"); 10632be7d22fSVladimir Kondratiev return -ENOENT; 10642be7d22fSVladimir Kondratiev } 10652be7d22fSVladimir Kondratiev 10662be7d22fSVladimir Kondratiev ssid_eid = ieee80211_bss_get_ie(bss, WLAN_EID_SSID); 10672be7d22fSVladimir Kondratiev if (!ssid_eid) { 10682be7d22fSVladimir Kondratiev wil_err(wil, "No SSID\n"); 10692be7d22fSVladimir Kondratiev rc = -ENOENT; 10702be7d22fSVladimir Kondratiev goto out; 10712be7d22fSVladimir Kondratiev } 1072e00243faSLior David vif->privacy = sme->privacy; 1073e00243faSLior David vif->pbss = sme->pbss; 10742be7d22fSVladimir Kondratiev 1075b9010f10SAhmad Masri rc = wmi_set_ie(vif, WMI_FRAME_ASSOC_REQ, sme->ie_len, sme->ie); 1076b9010f10SAhmad Masri if (rc) 1077b9010f10SAhmad Masri goto out; 1078b9010f10SAhmad Masri 1079b9010f10SAhmad Masri switch (bss->capability & WLAN_CAPABILITY_DMG_TYPE_MASK) { 1080b9010f10SAhmad Masri case WLAN_CAPABILITY_DMG_TYPE_AP: 1081b9010f10SAhmad Masri network_type = WMI_NETTYPE_INFRA; 1082b9010f10SAhmad Masri break; 1083b9010f10SAhmad Masri case WLAN_CAPABILITY_DMG_TYPE_PBSS: 1084b9010f10SAhmad Masri network_type = WMI_NETTYPE_P2P; 1085b9010f10SAhmad Masri break; 1086b9010f10SAhmad Masri default: 1087b9010f10SAhmad Masri wil_err(wil, "Unsupported BSS type, capability= 0x%04x\n", 1088b9010f10SAhmad Masri bss->capability); 1089b9010f10SAhmad Masri rc = -EINVAL; 1090b9010f10SAhmad Masri goto out; 1091b9010f10SAhmad Masri } 1092b9010f10SAhmad Masri 1093b9010f10SAhmad Masri ch = bss->channel->hw_value; 1094b9010f10SAhmad Masri if (ch == 0) { 1095b9010f10SAhmad Masri wil_err(wil, "BSS at unknown frequency %dMhz\n", 1096b9010f10SAhmad Masri bss->channel->center_freq); 1097b9010f10SAhmad Masri rc = -EOPNOTSUPP; 1098b9010f10SAhmad Masri goto out; 1099b9010f10SAhmad Masri } 1100b9010f10SAhmad Masri 1101b9010f10SAhmad Masri if (is_ft_roam) { 1102b9010f10SAhmad Masri if (network_type != WMI_NETTYPE_INFRA) { 1103b9010f10SAhmad Masri wil_err(wil, "FT: Unsupported BSS type, capability= 0x%04x\n", 1104b9010f10SAhmad Masri bss->capability); 1105b9010f10SAhmad Masri rc = -EINVAL; 1106b9010f10SAhmad Masri goto out; 1107b9010f10SAhmad Masri } 1108b9010f10SAhmad Masri rc = wil_ft_connect(wiphy, ndev, sme); 1109b9010f10SAhmad Masri if (rc == 0) 1110b9010f10SAhmad Masri vif->bss = bss; 1111b9010f10SAhmad Masri goto out; 1112b9010f10SAhmad Masri } 1113b9010f10SAhmad Masri 1114e00243faSLior David if (vif->privacy) { 1115230d8442SVladimir Kondratiev /* For secure assoc, remove old keys */ 1116e00243faSLior David rc = wmi_del_cipher_key(vif, 0, bss->bssid, 1117230d8442SVladimir Kondratiev WMI_KEY_USE_PAIRWISE); 11182be7d22fSVladimir Kondratiev if (rc) { 1119230d8442SVladimir Kondratiev wil_err(wil, "WMI_DELETE_CIPHER_KEY_CMD(PTK) failed\n"); 1120230d8442SVladimir Kondratiev goto out; 1121230d8442SVladimir Kondratiev } 1122e00243faSLior David rc = wmi_del_cipher_key(vif, 0, bss->bssid, 1123230d8442SVladimir Kondratiev WMI_KEY_USE_RX_GROUP); 1124230d8442SVladimir Kondratiev if (rc) { 1125230d8442SVladimir Kondratiev wil_err(wil, "WMI_DELETE_CIPHER_KEY_CMD(GTK) failed\n"); 11262be7d22fSVladimir Kondratiev goto out; 11272be7d22fSVladimir Kondratiev } 1128ac4acdb7SVladimir Kondratiev } 1129ac4acdb7SVladimir Kondratiev 11302be7d22fSVladimir Kondratiev /* WMI_CONNECT_CMD */ 11312be7d22fSVladimir Kondratiev memset(&conn, 0, sizeof(conn)); 1132b9010f10SAhmad Masri conn.network_type = network_type; 1133e00243faSLior David if (vif->privacy) { 113427aa6b71SVladimir Kondratiev if (rsn_eid) { /* regular secure connection */ 11352be7d22fSVladimir Kondratiev conn.dot11_auth_mode = WMI_AUTH11_SHARED; 11362be7d22fSVladimir Kondratiev conn.auth_mode = WMI_AUTH_WPA2_PSK; 11372be7d22fSVladimir Kondratiev conn.pairwise_crypto_type = WMI_CRYPT_AES_GCMP; 11382be7d22fSVladimir Kondratiev conn.pairwise_crypto_len = 16; 1139230d8442SVladimir Kondratiev conn.group_crypto_type = WMI_CRYPT_AES_GCMP; 1140230d8442SVladimir Kondratiev conn.group_crypto_len = 16; 114127aa6b71SVladimir Kondratiev } else { /* WSC */ 114227aa6b71SVladimir Kondratiev conn.dot11_auth_mode = WMI_AUTH11_WSC; 114327aa6b71SVladimir Kondratiev conn.auth_mode = WMI_AUTH_NONE; 114427aa6b71SVladimir Kondratiev } 114527aa6b71SVladimir Kondratiev } else { /* insecure connection */ 11462be7d22fSVladimir Kondratiev conn.dot11_auth_mode = WMI_AUTH11_OPEN; 11472be7d22fSVladimir Kondratiev conn.auth_mode = WMI_AUTH_NONE; 11482be7d22fSVladimir Kondratiev } 11492be7d22fSVladimir Kondratiev 11502be7d22fSVladimir Kondratiev conn.ssid_len = min_t(u8, ssid_eid[1], 32); 11512be7d22fSVladimir Kondratiev memcpy(conn.ssid, ssid_eid+2, conn.ssid_len); 11522be7d22fSVladimir Kondratiev conn.channel = ch - 1; 11532be7d22fSVladimir Kondratiev 1154a82553bbSVladimir Kondratiev ether_addr_copy(conn.bssid, bss->bssid); 1155a82553bbSVladimir Kondratiev ether_addr_copy(conn.dst_mac, bss->bssid); 1156e83eb2fcSVladimir Kondratiev 11575bd60982SLior David set_bit(wil_vif_fwconnecting, vif->status); 11582be7d22fSVladimir Kondratiev 1159e00243faSLior David rc = wmi_send(wil, WMI_CONNECT_CMDID, vif->mid, &conn, sizeof(conn)); 11602be7d22fSVladimir Kondratiev if (rc == 0) { 1161c5e96c91SDedy Lansky netif_carrier_on(ndev); 11625bd60982SLior David if (!wil_has_other_active_ifaces(wil, ndev, false, true)) 11639953a782SLior David wil6210_bus_request(wil, WIL_MAX_BUS_REQUEST_KBPS); 1164e00243faSLior David vif->bss = bss; 11652be7d22fSVladimir Kondratiev /* Connect can take lots of time */ 1166e00243faSLior David mod_timer(&vif->connect_timer, 1167d83ad4c4SLior David jiffies + msecs_to_jiffies(5000)); 1168b338f74eSVladimir Kondratiev } else { 11695bd60982SLior David clear_bit(wil_vif_fwconnecting, vif->status); 11702be7d22fSVladimir Kondratiev } 11712be7d22fSVladimir Kondratiev 11722be7d22fSVladimir Kondratiev out: 11735b112d3dSJohannes Berg cfg80211_put_bss(wiphy, bss); 11742be7d22fSVladimir Kondratiev 11752be7d22fSVladimir Kondratiev return rc; 11762be7d22fSVladimir Kondratiev } 11772be7d22fSVladimir Kondratiev 11782be7d22fSVladimir Kondratiev static int wil_cfg80211_disconnect(struct wiphy *wiphy, 11792be7d22fSVladimir Kondratiev struct net_device *ndev, 11802be7d22fSVladimir Kondratiev u16 reason_code) 11812be7d22fSVladimir Kondratiev { 11822be7d22fSVladimir Kondratiev int rc; 11832be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1184e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 11852be7d22fSVladimir Kondratiev 1186e00243faSLior David wil_dbg_misc(wil, "disconnect: reason=%d, mid=%d\n", 1187e00243faSLior David reason_code, vif->mid); 1188de9084efSVladimir Kondratiev 11895bd60982SLior David if (!(test_bit(wil_vif_fwconnecting, vif->status) || 11905bd60982SLior David test_bit(wil_vif_fwconnected, vif->status))) { 1191af3db60aSLazar Alexei wil_err(wil, "Disconnect was called while disconnected\n"); 119278771d76SVladimir Kondratiev return 0; 119378771d76SVladimir Kondratiev } 119478771d76SVladimir Kondratiev 1195e00243faSLior David vif->locally_generated_disc = true; 1196e00243faSLior David rc = wmi_call(wil, WMI_DISCONNECT_CMDID, vif->mid, NULL, 0, 119778771d76SVladimir Kondratiev WMI_DISCONNECT_EVENTID, NULL, 0, 119878771d76SVladimir Kondratiev WIL6210_DISCONNECT_TO_MS); 119978771d76SVladimir Kondratiev if (rc) 1200af3db60aSLazar Alexei wil_err(wil, "disconnect error %d\n", rc); 12012be7d22fSVladimir Kondratiev 12022be7d22fSVladimir Kondratiev return rc; 12032be7d22fSVladimir Kondratiev } 12042be7d22fSVladimir Kondratiev 12053fea18d0SLior David static int wil_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 12063fea18d0SLior David { 12073fea18d0SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 12083fea18d0SLior David int rc; 12093fea18d0SLior David 12103fea18d0SLior David /* these parameters are explicitly not supported */ 12113fea18d0SLior David if (changed & (WIPHY_PARAM_RETRY_LONG | 12123fea18d0SLior David WIPHY_PARAM_FRAG_THRESHOLD | 12133fea18d0SLior David WIPHY_PARAM_RTS_THRESHOLD)) 12143fea18d0SLior David return -ENOTSUPP; 12153fea18d0SLior David 12163fea18d0SLior David if (changed & WIPHY_PARAM_RETRY_SHORT) { 12173fea18d0SLior David rc = wmi_set_mgmt_retry(wil, wiphy->retry_short); 12183fea18d0SLior David if (rc) 12193fea18d0SLior David return rc; 12203fea18d0SLior David } 12213fea18d0SLior David 12223fea18d0SLior David return 0; 12233fea18d0SLior David } 12243fea18d0SLior David 12250b39aaf2SVladimir Kondratiev int wil_cfg80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, 12261647f12fSVladimir Kondratiev struct cfg80211_mgmt_tx_params *params, 12271647f12fSVladimir Kondratiev u64 *cookie) 12281647f12fSVladimir Kondratiev { 12291647f12fSVladimir Kondratiev const u8 *buf = params->buf; 12301c21cc5fSDedy Lansky size_t len = params->len; 12311647f12fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1232e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 12331647f12fSVladimir Kondratiev int rc; 12341c21cc5fSDedy Lansky bool tx_status; 12351647f12fSVladimir Kondratiev 1236b698e2dfSAhmad Masri wil_dbg_misc(wil, "mgmt_tx: channel %d offchan %d, wait %d\n", 1237b698e2dfSAhmad Masri params->chan ? params->chan->hw_value : -1, 1238b698e2dfSAhmad Masri params->offchan, 1239b698e2dfSAhmad Masri params->wait); 1240b698e2dfSAhmad Masri 1241b698e2dfSAhmad Masri /* Note, currently we support the "wait" parameter only on AP mode. 1242b698e2dfSAhmad Masri * In other modes, user-space must call remain_on_channel before 1243b698e2dfSAhmad Masri * mgmt_tx or listen on a channel other than active one. 1244e6d68341SDedy Lansky */ 1245e6d68341SDedy Lansky 1246b698e2dfSAhmad Masri if (params->chan && params->chan->hw_value == 0) { 1247b698e2dfSAhmad Masri wil_err(wil, "invalid channel\n"); 1248b698e2dfSAhmad Masri return -EINVAL; 1249b698e2dfSAhmad Masri } 1250e6d68341SDedy Lansky 1251b698e2dfSAhmad Masri if (wdev->iftype != NL80211_IFTYPE_AP) { 1252b698e2dfSAhmad Masri wil_dbg_misc(wil, 1253b698e2dfSAhmad Masri "send WMI_SW_TX_REQ_CMDID on non-AP interfaces\n"); 1254b698e2dfSAhmad Masri rc = wmi_mgmt_tx(vif, buf, len); 1255b698e2dfSAhmad Masri goto out; 1256b698e2dfSAhmad Masri } 1257b698e2dfSAhmad Masri 1258b698e2dfSAhmad Masri if (!params->chan || params->chan->hw_value == vif->channel) { 1259b698e2dfSAhmad Masri wil_dbg_misc(wil, 1260b698e2dfSAhmad Masri "send WMI_SW_TX_REQ_CMDID for on-channel\n"); 1261b698e2dfSAhmad Masri rc = wmi_mgmt_tx(vif, buf, len); 1262b698e2dfSAhmad Masri goto out; 1263b698e2dfSAhmad Masri } 1264b698e2dfSAhmad Masri 1265b698e2dfSAhmad Masri if (params->offchan == 0) { 1266b698e2dfSAhmad Masri wil_err(wil, 1267b698e2dfSAhmad Masri "invalid channel params: current %d requested %d, off-channel not allowed\n", 1268b698e2dfSAhmad Masri vif->channel, params->chan->hw_value); 1269b698e2dfSAhmad Masri return -EBUSY; 1270b698e2dfSAhmad Masri } 1271b698e2dfSAhmad Masri 1272b698e2dfSAhmad Masri /* use the wmi_mgmt_tx_ext only on AP mode and off-channel */ 1273b698e2dfSAhmad Masri rc = wmi_mgmt_tx_ext(vif, buf, len, params->chan->hw_value, 1274b698e2dfSAhmad Masri params->wait); 1275b698e2dfSAhmad Masri 1276b698e2dfSAhmad Masri out: 1277b698e2dfSAhmad Masri tx_status = (rc == 0); 1278304464f4SVladimir Kondratiev cfg80211_mgmt_tx_status(wdev, cookie ? *cookie : 0, buf, len, 1279304464f4SVladimir Kondratiev tx_status, GFP_KERNEL); 1280b698e2dfSAhmad Masri 12811647f12fSVladimir Kondratiev return rc; 12821647f12fSVladimir Kondratiev } 12831647f12fSVladimir Kondratiev 12842be7d22fSVladimir Kondratiev static int wil_cfg80211_set_channel(struct wiphy *wiphy, 12852be7d22fSVladimir Kondratiev struct cfg80211_chan_def *chandef) 12862be7d22fSVladimir Kondratiev { 12872be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 12882be7d22fSVladimir Kondratiev 12897d3e4dbeSLior David wil->monitor_chandef = *chandef; 12902be7d22fSVladimir Kondratiev 12912be7d22fSVladimir Kondratiev return 0; 12922be7d22fSVladimir Kondratiev } 12932be7d22fSVladimir Kondratiev 1294e00243faSLior David static enum wmi_key_usage wil_detect_key_usage(struct wireless_dev *wdev, 1295230d8442SVladimir Kondratiev bool pairwise) 1296230d8442SVladimir Kondratiev { 1297e00243faSLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 1298230d8442SVladimir Kondratiev enum wmi_key_usage rc; 1299230d8442SVladimir Kondratiev 1300230d8442SVladimir Kondratiev if (pairwise) { 1301230d8442SVladimir Kondratiev rc = WMI_KEY_USE_PAIRWISE; 1302230d8442SVladimir Kondratiev } else { 1303230d8442SVladimir Kondratiev switch (wdev->iftype) { 1304230d8442SVladimir Kondratiev case NL80211_IFTYPE_STATION: 1305e6d68341SDedy Lansky case NL80211_IFTYPE_P2P_CLIENT: 1306230d8442SVladimir Kondratiev rc = WMI_KEY_USE_RX_GROUP; 1307230d8442SVladimir Kondratiev break; 1308230d8442SVladimir Kondratiev case NL80211_IFTYPE_AP: 1309e6d68341SDedy Lansky case NL80211_IFTYPE_P2P_GO: 1310230d8442SVladimir Kondratiev rc = WMI_KEY_USE_TX_GROUP; 1311230d8442SVladimir Kondratiev break; 1312230d8442SVladimir Kondratiev default: 1313230d8442SVladimir Kondratiev /* TODO: Rx GTK or Tx GTK? */ 1314230d8442SVladimir Kondratiev wil_err(wil, "Can't determine GTK type\n"); 1315230d8442SVladimir Kondratiev rc = WMI_KEY_USE_RX_GROUP; 1316230d8442SVladimir Kondratiev break; 1317230d8442SVladimir Kondratiev } 1318230d8442SVladimir Kondratiev } 1319af3db60aSLazar Alexei wil_dbg_misc(wil, "detect_key_usage: -> %s\n", key_usage_str[rc]); 1320230d8442SVladimir Kondratiev 1321230d8442SVladimir Kondratiev return rc; 1322230d8442SVladimir Kondratiev } 1323230d8442SVladimir Kondratiev 132474b6ac58SMaya Erez static struct wil_sta_info * 1325e00243faSLior David wil_find_sta_by_key_usage(struct wil6210_priv *wil, u8 mid, 132658527421SVladimir Kondratiev enum wmi_key_usage key_usage, const u8 *mac_addr) 132758527421SVladimir Kondratiev { 132858527421SVladimir Kondratiev int cid = -EINVAL; 132958527421SVladimir Kondratiev 133058527421SVladimir Kondratiev if (key_usage == WMI_KEY_USE_TX_GROUP) 133158527421SVladimir Kondratiev return NULL; /* not needed */ 133258527421SVladimir Kondratiev 133358527421SVladimir Kondratiev /* supplicant provides Rx group key in STA mode with NULL MAC address */ 133458527421SVladimir Kondratiev if (mac_addr) 1335e00243faSLior David cid = wil_find_cid(wil, mid, mac_addr); 133658527421SVladimir Kondratiev else if (key_usage == WMI_KEY_USE_RX_GROUP) 1337e00243faSLior David cid = wil_find_cid_by_idx(wil, mid, 0); 133858527421SVladimir Kondratiev if (cid < 0) { 133974b6ac58SMaya Erez wil_err(wil, "No CID for %pM %s\n", mac_addr, 134074b6ac58SMaya Erez key_usage_str[key_usage]); 134158527421SVladimir Kondratiev return ERR_PTR(cid); 134258527421SVladimir Kondratiev } 134358527421SVladimir Kondratiev 134474b6ac58SMaya Erez return &wil->sta[cid]; 134574b6ac58SMaya Erez } 134658527421SVladimir Kondratiev 1347b9010f10SAhmad Masri void wil_set_crypto_rx(u8 key_index, enum wmi_key_usage key_usage, 134874b6ac58SMaya Erez struct wil_sta_info *cs, 134974b6ac58SMaya Erez struct key_params *params) 135074b6ac58SMaya Erez { 135174b6ac58SMaya Erez struct wil_tid_crypto_rx_single *cc; 135274b6ac58SMaya Erez int tid; 135374b6ac58SMaya Erez 135474b6ac58SMaya Erez if (!cs) 135574b6ac58SMaya Erez return; 135674b6ac58SMaya Erez 135774b6ac58SMaya Erez switch (key_usage) { 135874b6ac58SMaya Erez case WMI_KEY_USE_PAIRWISE: 135974b6ac58SMaya Erez for (tid = 0; tid < WIL_STA_TID_NUM; tid++) { 136074b6ac58SMaya Erez cc = &cs->tid_crypto_rx[tid].key_id[key_index]; 136174b6ac58SMaya Erez if (params->seq) 136274b6ac58SMaya Erez memcpy(cc->pn, params->seq, 136374b6ac58SMaya Erez IEEE80211_GCMP_PN_LEN); 136474b6ac58SMaya Erez else 136574b6ac58SMaya Erez memset(cc->pn, 0, IEEE80211_GCMP_PN_LEN); 136674b6ac58SMaya Erez cc->key_set = true; 136774b6ac58SMaya Erez } 136874b6ac58SMaya Erez break; 136974b6ac58SMaya Erez case WMI_KEY_USE_RX_GROUP: 137074b6ac58SMaya Erez cc = &cs->group_crypto_rx.key_id[key_index]; 137174b6ac58SMaya Erez if (params->seq) 137274b6ac58SMaya Erez memcpy(cc->pn, params->seq, IEEE80211_GCMP_PN_LEN); 137374b6ac58SMaya Erez else 137474b6ac58SMaya Erez memset(cc->pn, 0, IEEE80211_GCMP_PN_LEN); 137574b6ac58SMaya Erez cc->key_set = true; 137674b6ac58SMaya Erez break; 137774b6ac58SMaya Erez default: 137874b6ac58SMaya Erez break; 137974b6ac58SMaya Erez } 138074b6ac58SMaya Erez } 138174b6ac58SMaya Erez 138274b6ac58SMaya Erez static void wil_del_rx_key(u8 key_index, enum wmi_key_usage key_usage, 138374b6ac58SMaya Erez struct wil_sta_info *cs) 138474b6ac58SMaya Erez { 138574b6ac58SMaya Erez struct wil_tid_crypto_rx_single *cc; 138674b6ac58SMaya Erez int tid; 138774b6ac58SMaya Erez 138874b6ac58SMaya Erez if (!cs) 138974b6ac58SMaya Erez return; 139074b6ac58SMaya Erez 139174b6ac58SMaya Erez switch (key_usage) { 139274b6ac58SMaya Erez case WMI_KEY_USE_PAIRWISE: 139374b6ac58SMaya Erez for (tid = 0; tid < WIL_STA_TID_NUM; tid++) { 139474b6ac58SMaya Erez cc = &cs->tid_crypto_rx[tid].key_id[key_index]; 139574b6ac58SMaya Erez cc->key_set = false; 139674b6ac58SMaya Erez } 139774b6ac58SMaya Erez break; 139874b6ac58SMaya Erez case WMI_KEY_USE_RX_GROUP: 139974b6ac58SMaya Erez cc = &cs->group_crypto_rx.key_id[key_index]; 140074b6ac58SMaya Erez cc->key_set = false; 140174b6ac58SMaya Erez break; 140274b6ac58SMaya Erez default: 140374b6ac58SMaya Erez break; 140474b6ac58SMaya Erez } 140558527421SVladimir Kondratiev } 140658527421SVladimir Kondratiev 14072be7d22fSVladimir Kondratiev static int wil_cfg80211_add_key(struct wiphy *wiphy, 14082be7d22fSVladimir Kondratiev struct net_device *ndev, 14092be7d22fSVladimir Kondratiev u8 key_index, bool pairwise, 14102be7d22fSVladimir Kondratiev const u8 *mac_addr, 14112be7d22fSVladimir Kondratiev struct key_params *params) 14122be7d22fSVladimir Kondratiev { 141358527421SVladimir Kondratiev int rc; 1414e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 14152be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1416e00243faSLior David struct wireless_dev *wdev = vif_to_wdev(vif); 1417e00243faSLior David enum wmi_key_usage key_usage = wil_detect_key_usage(wdev, pairwise); 1418e00243faSLior David struct wil_sta_info *cs = wil_find_sta_by_key_usage(wil, vif->mid, 1419e00243faSLior David key_usage, 142058527421SVladimir Kondratiev mac_addr); 14212be7d22fSVladimir Kondratiev 142274b6ac58SMaya Erez if (!params) { 142374b6ac58SMaya Erez wil_err(wil, "NULL params\n"); 142474b6ac58SMaya Erez return -EINVAL; 142574b6ac58SMaya Erez } 142674b6ac58SMaya Erez 1427af3db60aSLazar Alexei wil_dbg_misc(wil, "add_key: %pM %s[%d] PN %*phN\n", 142858527421SVladimir Kondratiev mac_addr, key_usage_str[key_usage], key_index, 142958527421SVladimir Kondratiev params->seq_len, params->seq); 1430db8adcbfSVladimir Kondratiev 143174b6ac58SMaya Erez if (IS_ERR(cs)) { 1432b9010f10SAhmad Masri /* in FT, sta info may not be available as add_key may be 1433b9010f10SAhmad Masri * sent by host before FW sends WMI_CONNECT_EVENT 1434b9010f10SAhmad Masri */ 1435b9010f10SAhmad Masri if (!test_bit(wil_vif_ft_roam, vif->status)) { 1436af3db60aSLazar Alexei wil_err(wil, "Not connected, %pM %s[%d] PN %*phN\n", 1437af3db60aSLazar Alexei mac_addr, key_usage_str[key_usage], key_index, 143858527421SVladimir Kondratiev params->seq_len, params->seq); 143958527421SVladimir Kondratiev return -EINVAL; 144058527421SVladimir Kondratiev } 1441b9010f10SAhmad Masri } 144258527421SVladimir Kondratiev 1443b9010f10SAhmad Masri if (!IS_ERR(cs)) 144474b6ac58SMaya Erez wil_del_rx_key(key_index, key_usage, cs); 144558527421SVladimir Kondratiev 144658527421SVladimir Kondratiev if (params->seq && params->seq_len != IEEE80211_GCMP_PN_LEN) { 144758527421SVladimir Kondratiev wil_err(wil, 1448af3db60aSLazar Alexei "Wrong PN len %d, %pM %s[%d] PN %*phN\n", 1449af3db60aSLazar Alexei params->seq_len, mac_addr, 145058527421SVladimir Kondratiev key_usage_str[key_usage], key_index, 145158527421SVladimir Kondratiev params->seq_len, params->seq); 145258527421SVladimir Kondratiev return -EINVAL; 145358527421SVladimir Kondratiev } 145458527421SVladimir Kondratiev 1455e00243faSLior David rc = wmi_add_cipher_key(vif, key_index, mac_addr, params->key_len, 1456230d8442SVladimir Kondratiev params->key, key_usage); 1457e41ab937SDedy Lansky if (!rc && !IS_ERR(cs)) { 1458e41ab937SDedy Lansky /* update local storage used for AP recovery */ 1459e41ab937SDedy Lansky if (key_usage == WMI_KEY_USE_TX_GROUP && params->key && 1460e41ab937SDedy Lansky params->key_len <= WMI_MAX_KEY_LEN) { 1461e41ab937SDedy Lansky vif->gtk_index = key_index; 1462e41ab937SDedy Lansky memcpy(vif->gtk, params->key, params->key_len); 1463e41ab937SDedy Lansky vif->gtk_len = params->key_len; 1464e41ab937SDedy Lansky } 1465b9010f10SAhmad Masri /* in FT set crypto will take place upon receiving 1466b9010f10SAhmad Masri * WMI_RING_EN_EVENTID event 1467b9010f10SAhmad Masri */ 146874b6ac58SMaya Erez wil_set_crypto_rx(key_index, key_usage, cs, params); 1469e41ab937SDedy Lansky } 147058527421SVladimir Kondratiev 147158527421SVladimir Kondratiev return rc; 14722be7d22fSVladimir Kondratiev } 14732be7d22fSVladimir Kondratiev 14742be7d22fSVladimir Kondratiev static int wil_cfg80211_del_key(struct wiphy *wiphy, 14752be7d22fSVladimir Kondratiev struct net_device *ndev, 14762be7d22fSVladimir Kondratiev u8 key_index, bool pairwise, 14772be7d22fSVladimir Kondratiev const u8 *mac_addr) 14782be7d22fSVladimir Kondratiev { 1479e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 14802be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1481e00243faSLior David struct wireless_dev *wdev = vif_to_wdev(vif); 1482e00243faSLior David enum wmi_key_usage key_usage = wil_detect_key_usage(wdev, pairwise); 1483e00243faSLior David struct wil_sta_info *cs = wil_find_sta_by_key_usage(wil, vif->mid, 1484e00243faSLior David key_usage, 148558527421SVladimir Kondratiev mac_addr); 14862be7d22fSVladimir Kondratiev 1487af3db60aSLazar Alexei wil_dbg_misc(wil, "del_key: %pM %s[%d]\n", mac_addr, 148858527421SVladimir Kondratiev key_usage_str[key_usage], key_index); 148958527421SVladimir Kondratiev 149074b6ac58SMaya Erez if (IS_ERR(cs)) 1491af3db60aSLazar Alexei wil_info(wil, "Not connected, %pM %s[%d]\n", 149258527421SVladimir Kondratiev mac_addr, key_usage_str[key_usage], key_index); 149358527421SVladimir Kondratiev 149474b6ac58SMaya Erez if (!IS_ERR_OR_NULL(cs)) 149574b6ac58SMaya Erez wil_del_rx_key(key_index, key_usage, cs); 1496db8adcbfSVladimir Kondratiev 1497e00243faSLior David return wmi_del_cipher_key(vif, key_index, mac_addr, key_usage); 14982be7d22fSVladimir Kondratiev } 14992be7d22fSVladimir Kondratiev 15002be7d22fSVladimir Kondratiev /* Need to be present or wiphy_new() will WARN */ 15012be7d22fSVladimir Kondratiev static int wil_cfg80211_set_default_key(struct wiphy *wiphy, 15022be7d22fSVladimir Kondratiev struct net_device *ndev, 15032be7d22fSVladimir Kondratiev u8 key_index, bool unicast, 15042be7d22fSVladimir Kondratiev bool multicast) 15052be7d22fSVladimir Kondratiev { 1506280ab987SLior David struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1507280ab987SLior David 1508af3db60aSLazar Alexei wil_dbg_misc(wil, "set_default_key: entered\n"); 15092be7d22fSVladimir Kondratiev return 0; 15102be7d22fSVladimir Kondratiev } 15112be7d22fSVladimir Kondratiev 15121647f12fSVladimir Kondratiev static int wil_remain_on_channel(struct wiphy *wiphy, 15131647f12fSVladimir Kondratiev struct wireless_dev *wdev, 15141647f12fSVladimir Kondratiev struct ieee80211_channel *chan, 15151647f12fSVladimir Kondratiev unsigned int duration, 15161647f12fSVladimir Kondratiev u64 *cookie) 15171647f12fSVladimir Kondratiev { 15181647f12fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 15191647f12fSVladimir Kondratiev int rc; 15201647f12fSVladimir Kondratiev 1521af3db60aSLazar Alexei wil_dbg_misc(wil, 1522af3db60aSLazar Alexei "remain_on_channel: center_freq=%d, duration=%d iftype=%d\n", 1523af3db60aSLazar Alexei chan->center_freq, duration, wdev->iftype); 15241647f12fSVladimir Kondratiev 1525bb6743f7SLior David rc = wil_p2p_listen(wil, wdev, duration, chan, cookie); 15261647f12fSVladimir Kondratiev return rc; 15271647f12fSVladimir Kondratiev } 15281647f12fSVladimir Kondratiev 15291647f12fSVladimir Kondratiev static int wil_cancel_remain_on_channel(struct wiphy *wiphy, 15301647f12fSVladimir Kondratiev struct wireless_dev *wdev, 15311647f12fSVladimir Kondratiev u64 cookie) 15321647f12fSVladimir Kondratiev { 15331647f12fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1534e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 15351647f12fSVladimir Kondratiev 1536af3db60aSLazar Alexei wil_dbg_misc(wil, "cancel_remain_on_channel\n"); 15371647f12fSVladimir Kondratiev 1538e00243faSLior David return wil_p2p_cancel_listen(vif, cookie); 15391647f12fSVladimir Kondratiev } 15401647f12fSVladimir Kondratiev 1541c100c883SLior David /** 1542c100c883SLior David * find a specific IE in a list of IEs 1543c100c883SLior David * return a pointer to the beginning of IE in the list 1544c100c883SLior David * or NULL if not found 1545c100c883SLior David */ 1546c100c883SLior David static const u8 *_wil_cfg80211_find_ie(const u8 *ies, u16 ies_len, const u8 *ie, 1547c100c883SLior David u16 ie_len) 1548c100c883SLior David { 1549c100c883SLior David struct ieee80211_vendor_ie *vie; 1550c100c883SLior David u32 oui; 1551c100c883SLior David 1552c100c883SLior David /* IE tag at offset 0, length at offset 1 */ 1553c100c883SLior David if (ie_len < 2 || 2 + ie[1] > ie_len) 1554c100c883SLior David return NULL; 1555c100c883SLior David 1556c100c883SLior David if (ie[0] != WLAN_EID_VENDOR_SPECIFIC) 1557c100c883SLior David return cfg80211_find_ie(ie[0], ies, ies_len); 1558c100c883SLior David 1559c100c883SLior David /* make sure there is room for 3 bytes OUI + 1 byte OUI type */ 1560c100c883SLior David if (ie[1] < 4) 1561c100c883SLior David return NULL; 1562c100c883SLior David vie = (struct ieee80211_vendor_ie *)ie; 1563c100c883SLior David oui = vie->oui[0] << 16 | vie->oui[1] << 8 | vie->oui[2]; 1564c100c883SLior David return cfg80211_find_vendor_ie(oui, vie->oui_type, ies, 1565c100c883SLior David ies_len); 1566c100c883SLior David } 1567c100c883SLior David 1568c100c883SLior David /** 1569c100c883SLior David * merge the IEs in two lists into a single list. 1570c100c883SLior David * do not include IEs from the second list which exist in the first list. 1571c100c883SLior David * add only vendor specific IEs from second list to keep 1572c100c883SLior David * the merged list sorted (since vendor-specific IE has the 1573c100c883SLior David * highest tag number) 1574c100c883SLior David * caller must free the allocated memory for merged IEs 1575c100c883SLior David */ 1576c100c883SLior David static int _wil_cfg80211_merge_extra_ies(const u8 *ies1, u16 ies1_len, 1577c100c883SLior David const u8 *ies2, u16 ies2_len, 1578c100c883SLior David u8 **merged_ies, u16 *merged_len) 1579c100c883SLior David { 1580c100c883SLior David u8 *buf, *dpos; 1581c100c883SLior David const u8 *spos; 1582c100c883SLior David 1583c100c883SLior David if (ies1_len == 0 && ies2_len == 0) { 1584c100c883SLior David *merged_ies = NULL; 1585c100c883SLior David *merged_len = 0; 1586c100c883SLior David return 0; 1587c100c883SLior David } 1588c100c883SLior David 1589c100c883SLior David buf = kmalloc(ies1_len + ies2_len, GFP_KERNEL); 1590c100c883SLior David if (!buf) 1591c100c883SLior David return -ENOMEM; 1592c100c883SLior David memcpy(buf, ies1, ies1_len); 1593c100c883SLior David dpos = buf + ies1_len; 1594c100c883SLior David spos = ies2; 1595c100c883SLior David while (spos + 1 < ies2 + ies2_len) { 1596c100c883SLior David /* IE tag at offset 0, length at offset 1 */ 1597c100c883SLior David u16 ielen = 2 + spos[1]; 1598c100c883SLior David 1599c100c883SLior David if (spos + ielen > ies2 + ies2_len) 1600c100c883SLior David break; 1601c100c883SLior David if (spos[0] == WLAN_EID_VENDOR_SPECIFIC && 1602c100c883SLior David !_wil_cfg80211_find_ie(ies1, ies1_len, spos, ielen)) { 1603c100c883SLior David memcpy(dpos, spos, ielen); 1604c100c883SLior David dpos += ielen; 1605c100c883SLior David } 1606c100c883SLior David spos += ielen; 1607c100c883SLior David } 1608c100c883SLior David 1609c100c883SLior David *merged_ies = buf; 1610c100c883SLior David *merged_len = dpos - buf; 1611c100c883SLior David return 0; 1612c100c883SLior David } 1613c100c883SLior David 1614ca959773SVladimir Kondratiev static void wil_print_bcon_data(struct cfg80211_beacon_data *b) 1615ca959773SVladimir Kondratiev { 16165eb443e9SDedy Lansky wil_hex_dump_misc("head ", DUMP_PREFIX_OFFSET, 16, 1, 16175eb443e9SDedy Lansky b->head, b->head_len, true); 16185eb443e9SDedy Lansky wil_hex_dump_misc("tail ", DUMP_PREFIX_OFFSET, 16, 1, 16195eb443e9SDedy Lansky b->tail, b->tail_len, true); 16205eb443e9SDedy Lansky wil_hex_dump_misc("BCON IE ", DUMP_PREFIX_OFFSET, 16, 1, 16215eb443e9SDedy Lansky b->beacon_ies, b->beacon_ies_len, true); 16225eb443e9SDedy Lansky wil_hex_dump_misc("PROBE ", DUMP_PREFIX_OFFSET, 16, 1, 16235eb443e9SDedy Lansky b->probe_resp, b->probe_resp_len, true); 16245eb443e9SDedy Lansky wil_hex_dump_misc("PROBE IE ", DUMP_PREFIX_OFFSET, 16, 1, 16255eb443e9SDedy Lansky b->proberesp_ies, b->proberesp_ies_len, true); 16265eb443e9SDedy Lansky wil_hex_dump_misc("ASSOC IE ", DUMP_PREFIX_OFFSET, 16, 1, 16275eb443e9SDedy Lansky b->assocresp_ies, b->assocresp_ies_len, true); 1628ca959773SVladimir Kondratiev } 1629ca959773SVladimir Kondratiev 163033190ebfSVladimir Kondratiev /* internal functions for device reset and starting AP */ 1631b9010f10SAhmad Masri static u8 * 1632b9010f10SAhmad Masri _wil_cfg80211_get_proberesp_ies(const u8 *proberesp, u16 proberesp_len, 1633b9010f10SAhmad Masri u16 *ies_len) 1634b9010f10SAhmad Masri { 1635b9010f10SAhmad Masri u8 *ies = NULL; 1636b9010f10SAhmad Masri 1637b9010f10SAhmad Masri if (proberesp) { 1638b9010f10SAhmad Masri struct ieee80211_mgmt *f = 1639b9010f10SAhmad Masri (struct ieee80211_mgmt *)proberesp; 1640b9010f10SAhmad Masri size_t hlen = offsetof(struct ieee80211_mgmt, 1641b9010f10SAhmad Masri u.probe_resp.variable); 1642b9010f10SAhmad Masri 1643b9010f10SAhmad Masri ies = f->u.probe_resp.variable; 1644b9010f10SAhmad Masri if (ies_len) 1645b9010f10SAhmad Masri *ies_len = proberesp_len - hlen; 1646b9010f10SAhmad Masri } 1647b9010f10SAhmad Masri 1648b9010f10SAhmad Masri return ies; 1649b9010f10SAhmad Masri } 1650b9010f10SAhmad Masri 1651e00243faSLior David static int _wil_cfg80211_set_ies(struct wil6210_vif *vif, 1652cab5abbfSVladimir Kondratiev struct cfg80211_beacon_data *bcon) 165333190ebfSVladimir Kondratiev { 165433190ebfSVladimir Kondratiev int rc; 1655c100c883SLior David u16 len = 0, proberesp_len = 0; 1656b9010f10SAhmad Masri u8 *ies = NULL, *proberesp; 165733190ebfSVladimir Kondratiev 1658e41ab937SDedy Lansky /* update local storage used for AP recovery */ 1659e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp, &vif->proberesp_len, bcon->probe_resp, 1660e41ab937SDedy Lansky bcon->probe_resp_len); 1661e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp_ies, &vif->proberesp_ies_len, 1662e41ab937SDedy Lansky bcon->proberesp_ies, bcon->proberesp_ies_len); 1663e41ab937SDedy Lansky wil_memdup_ie(&vif->assocresp_ies, &vif->assocresp_ies_len, 1664e41ab937SDedy Lansky bcon->assocresp_ies, bcon->assocresp_ies_len); 1665e41ab937SDedy Lansky 1666b9010f10SAhmad Masri proberesp = _wil_cfg80211_get_proberesp_ies(bcon->probe_resp, 1667b9010f10SAhmad Masri bcon->probe_resp_len, 1668b9010f10SAhmad Masri &proberesp_len); 1669c100c883SLior David rc = _wil_cfg80211_merge_extra_ies(proberesp, 1670c100c883SLior David proberesp_len, 1671c100c883SLior David bcon->proberesp_ies, 1672c100c883SLior David bcon->proberesp_ies_len, 1673c100c883SLior David &ies, &len); 1674c100c883SLior David 16755421bf0cSVladimir Kondratiev if (rc) 1676c100c883SLior David goto out; 167733190ebfSVladimir Kondratiev 1678e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_PROBE_RESP, len, ies); 1679c100c883SLior David if (rc) 1680c100c883SLior David goto out; 1681c100c883SLior David 1682c100c883SLior David if (bcon->assocresp_ies) 1683e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_ASSOC_RESP, 1684c100c883SLior David bcon->assocresp_ies_len, bcon->assocresp_ies); 1685c100c883SLior David else 1686e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_ASSOC_RESP, len, ies); 1687cab5abbfSVladimir Kondratiev #if 0 /* to use beacon IE's, remove this #if 0 */ 16885421bf0cSVladimir Kondratiev if (rc) 1689c100c883SLior David goto out; 16905421bf0cSVladimir Kondratiev 1691e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_BEACON, 1692e00243faSLior David bcon->tail_len, bcon->tail); 1693cab5abbfSVladimir Kondratiev #endif 1694c100c883SLior David out: 1695c100c883SLior David kfree(ies); 16965421bf0cSVladimir Kondratiev return rc; 169733190ebfSVladimir Kondratiev } 169833190ebfSVladimir Kondratiev 169933190ebfSVladimir Kondratiev static int _wil_cfg80211_start_ap(struct wiphy *wiphy, 170033190ebfSVladimir Kondratiev struct net_device *ndev, 170133190ebfSVladimir Kondratiev const u8 *ssid, size_t ssid_len, u32 privacy, 170233190ebfSVladimir Kondratiev int bi, u8 chan, 1703cab5abbfSVladimir Kondratiev struct cfg80211_beacon_data *bcon, 1704eabb03b4SLior David u8 hidden_ssid, u32 pbss) 170533190ebfSVladimir Kondratiev { 170633190ebfSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1707e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 170833190ebfSVladimir Kondratiev int rc; 170933190ebfSVladimir Kondratiev struct wireless_dev *wdev = ndev->ieee80211_ptr; 171033190ebfSVladimir Kondratiev u8 wmi_nettype = wil_iftype_nl2wmi(wdev->iftype); 1711b4944f2cSLior David u8 is_go = (wdev->iftype == NL80211_IFTYPE_P2P_GO); 1712b9010f10SAhmad Masri u16 proberesp_len = 0; 1713b9010f10SAhmad Masri u8 *proberesp; 1714b9010f10SAhmad Masri bool ft = false; 171533190ebfSVladimir Kondratiev 1716eabb03b4SLior David if (pbss) 1717eabb03b4SLior David wmi_nettype = WMI_NETTYPE_P2P; 1718eabb03b4SLior David 1719e00243faSLior David wil_dbg_misc(wil, "start_ap: mid=%d, is_go=%d\n", vif->mid, is_go); 1720b4944f2cSLior David if (is_go && !pbss) { 1721af3db60aSLazar Alexei wil_err(wil, "P2P GO must be in PBSS\n"); 1722b4944f2cSLior David return -ENOTSUPP; 1723b4944f2cSLior David } 1724b4944f2cSLior David 172533190ebfSVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 172633190ebfSVladimir Kondratiev 1727b9010f10SAhmad Masri proberesp = _wil_cfg80211_get_proberesp_ies(bcon->probe_resp, 1728b9010f10SAhmad Masri bcon->probe_resp_len, 1729b9010f10SAhmad Masri &proberesp_len); 1730b9010f10SAhmad Masri /* check that the probe response IEs has a MDE */ 1731b9010f10SAhmad Masri if ((proberesp && proberesp_len > 0 && 1732b9010f10SAhmad Masri cfg80211_find_ie(WLAN_EID_MOBILITY_DOMAIN, 1733b9010f10SAhmad Masri proberesp, 1734b9010f10SAhmad Masri proberesp_len))) 1735b9010f10SAhmad Masri ft = true; 1736b9010f10SAhmad Masri 1737b9010f10SAhmad Masri if (ft) { 1738b9010f10SAhmad Masri if (!test_bit(WMI_FW_CAPABILITY_FT_ROAMING, 1739b9010f10SAhmad Masri wil->fw_capabilities)) { 1740b9010f10SAhmad Masri wil_err(wil, "FW does not support FT roaming\n"); 1741b9010f10SAhmad Masri return -ENOTSUPP; 1742b9010f10SAhmad Masri } 1743b9010f10SAhmad Masri set_bit(wil_vif_ft_roam, vif->status); 1744b9010f10SAhmad Masri } 1745b9010f10SAhmad Masri 174633190ebfSVladimir Kondratiev mutex_lock(&wil->mutex); 174733190ebfSVladimir Kondratiev 17483ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, true, false)) { 174933190ebfSVladimir Kondratiev __wil_down(wil); 175033190ebfSVladimir Kondratiev rc = __wil_up(wil); 175133190ebfSVladimir Kondratiev if (rc) 175233190ebfSVladimir Kondratiev goto out; 17533ada9314SLior David } 175433190ebfSVladimir Kondratiev 1755e00243faSLior David rc = wmi_set_ssid(vif, ssid_len, ssid); 175633190ebfSVladimir Kondratiev if (rc) 175733190ebfSVladimir Kondratiev goto out; 175833190ebfSVladimir Kondratiev 1759e00243faSLior David rc = _wil_cfg80211_set_ies(vif, bcon); 176033190ebfSVladimir Kondratiev if (rc) 176133190ebfSVladimir Kondratiev goto out; 176233190ebfSVladimir Kondratiev 1763e00243faSLior David vif->privacy = privacy; 1764e00243faSLior David vif->channel = chan; 1765e00243faSLior David vif->hidden_ssid = hidden_ssid; 1766e00243faSLior David vif->pbss = pbss; 1767e41ab937SDedy Lansky vif->bi = bi; 1768e41ab937SDedy Lansky memcpy(vif->ssid, ssid, ssid_len); 1769e41ab937SDedy Lansky vif->ssid_len = ssid_len; 177033190ebfSVladimir Kondratiev 177133190ebfSVladimir Kondratiev netif_carrier_on(ndev); 17723ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, false, true)) 17739953a782SLior David wil6210_bus_request(wil, WIL_MAX_BUS_REQUEST_KBPS); 177433190ebfSVladimir Kondratiev 1775e00243faSLior David rc = wmi_pcp_start(vif, bi, wmi_nettype, chan, hidden_ssid, is_go); 177633190ebfSVladimir Kondratiev if (rc) 177733190ebfSVladimir Kondratiev goto err_pcp_start; 177833190ebfSVladimir Kondratiev 1779e00243faSLior David rc = wil_bcast_init(vif); 178033190ebfSVladimir Kondratiev if (rc) 178133190ebfSVladimir Kondratiev goto err_bcast; 178233190ebfSVladimir Kondratiev 178333190ebfSVladimir Kondratiev goto out; /* success */ 178433190ebfSVladimir Kondratiev 178533190ebfSVladimir Kondratiev err_bcast: 1786e00243faSLior David wmi_pcp_stop(vif); 178733190ebfSVladimir Kondratiev err_pcp_start: 178833190ebfSVladimir Kondratiev netif_carrier_off(ndev); 17893ada9314SLior David if (!wil_has_other_active_ifaces(wil, ndev, false, true)) 17909953a782SLior David wil6210_bus_request(wil, WIL_DEFAULT_BUS_REQUEST_KBPS); 179133190ebfSVladimir Kondratiev out: 179233190ebfSVladimir Kondratiev mutex_unlock(&wil->mutex); 179333190ebfSVladimir Kondratiev return rc; 179433190ebfSVladimir Kondratiev } 179533190ebfSVladimir Kondratiev 1796e41ab937SDedy Lansky void wil_cfg80211_ap_recovery(struct wil6210_priv *wil) 1797e41ab937SDedy Lansky { 1798e41ab937SDedy Lansky int rc, i; 1799e41ab937SDedy Lansky struct wiphy *wiphy = wil_to_wiphy(wil); 1800e41ab937SDedy Lansky 1801e41ab937SDedy Lansky for (i = 0; i < wil->max_vifs; i++) { 1802e41ab937SDedy Lansky struct wil6210_vif *vif = wil->vifs[i]; 1803e41ab937SDedy Lansky struct net_device *ndev; 1804e41ab937SDedy Lansky struct cfg80211_beacon_data bcon = {}; 1805e41ab937SDedy Lansky struct key_params key_params = {}; 1806e41ab937SDedy Lansky 1807e41ab937SDedy Lansky if (!vif || vif->ssid_len == 0) 1808e41ab937SDedy Lansky continue; 1809e41ab937SDedy Lansky 1810e41ab937SDedy Lansky ndev = vif_to_ndev(vif); 1811e41ab937SDedy Lansky bcon.proberesp_ies = vif->proberesp_ies; 1812e41ab937SDedy Lansky bcon.assocresp_ies = vif->assocresp_ies; 1813e41ab937SDedy Lansky bcon.probe_resp = vif->proberesp; 1814e41ab937SDedy Lansky bcon.proberesp_ies_len = vif->proberesp_ies_len; 1815e41ab937SDedy Lansky bcon.assocresp_ies_len = vif->assocresp_ies_len; 1816e41ab937SDedy Lansky bcon.probe_resp_len = vif->proberesp_len; 1817e41ab937SDedy Lansky 1818e41ab937SDedy Lansky wil_info(wil, 1819e41ab937SDedy Lansky "AP (vif %d) recovery: privacy %d, bi %d, channel %d, hidden %d, pbss %d\n", 1820e41ab937SDedy Lansky i, vif->privacy, vif->bi, vif->channel, 1821e41ab937SDedy Lansky vif->hidden_ssid, vif->pbss); 1822e41ab937SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 1823e41ab937SDedy Lansky vif->ssid, vif->ssid_len, true); 1824e41ab937SDedy Lansky rc = _wil_cfg80211_start_ap(wiphy, ndev, 1825e41ab937SDedy Lansky vif->ssid, vif->ssid_len, 1826e41ab937SDedy Lansky vif->privacy, vif->bi, 1827e41ab937SDedy Lansky vif->channel, &bcon, 1828e41ab937SDedy Lansky vif->hidden_ssid, vif->pbss); 1829e41ab937SDedy Lansky if (rc) { 1830e41ab937SDedy Lansky wil_err(wil, "vif %d recovery failed (%d)\n", i, rc); 1831e41ab937SDedy Lansky continue; 1832e41ab937SDedy Lansky } 1833e41ab937SDedy Lansky 1834e41ab937SDedy Lansky if (!vif->privacy || vif->gtk_len == 0) 1835e41ab937SDedy Lansky continue; 1836e41ab937SDedy Lansky 1837e41ab937SDedy Lansky key_params.key = vif->gtk; 1838e41ab937SDedy Lansky key_params.key_len = vif->gtk_len; 1839e41ab937SDedy Lansky key_params.seq_len = IEEE80211_GCMP_PN_LEN; 1840e41ab937SDedy Lansky rc = wil_cfg80211_add_key(wiphy, ndev, vif->gtk_index, false, 1841e41ab937SDedy Lansky NULL, &key_params); 1842e41ab937SDedy Lansky if (rc) 1843e41ab937SDedy Lansky wil_err(wil, "vif %d recovery add key failed (%d)\n", 1844e41ab937SDedy Lansky i, rc); 1845e41ab937SDedy Lansky } 1846e41ab937SDedy Lansky } 1847e41ab937SDedy Lansky 18481bd922fcSVladimir Kondratiev static int wil_cfg80211_change_beacon(struct wiphy *wiphy, 18491bd922fcSVladimir Kondratiev struct net_device *ndev, 18501bd922fcSVladimir Kondratiev struct cfg80211_beacon_data *bcon) 18511bd922fcSVladimir Kondratiev { 18521bd922fcSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1853e41ab937SDedy Lansky struct wireless_dev *wdev = ndev->ieee80211_ptr; 1854e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 18551bd922fcSVladimir Kondratiev int rc; 185633190ebfSVladimir Kondratiev u32 privacy = 0; 18571bd922fcSVladimir Kondratiev 1858e00243faSLior David wil_dbg_misc(wil, "change_beacon, mid=%d\n", vif->mid); 18591e7e5a0dSVladimir Kondratiev wil_print_bcon_data(bcon); 18601e7e5a0dSVladimir Kondratiev 1861c5a157e4SLior David if (bcon->tail && 1862c5a157e4SLior David cfg80211_find_ie(WLAN_EID_RSN, bcon->tail, 1863c5a157e4SLior David bcon->tail_len)) 186433190ebfSVladimir Kondratiev privacy = 1; 18651bd922fcSVladimir Kondratiev 1866e41ab937SDedy Lansky memcpy(vif->ssid, wdev->ssid, wdev->ssid_len); 1867e41ab937SDedy Lansky vif->ssid_len = wdev->ssid_len; 1868e41ab937SDedy Lansky 186933190ebfSVladimir Kondratiev /* in case privacy has changed, need to restart the AP */ 1870e00243faSLior David if (vif->privacy != privacy) { 187133190ebfSVladimir Kondratiev wil_dbg_misc(wil, "privacy changed %d=>%d. Restarting AP\n", 1872e00243faSLior David vif->privacy, privacy); 187333190ebfSVladimir Kondratiev 1874e41ab937SDedy Lansky rc = _wil_cfg80211_start_ap(wiphy, ndev, vif->ssid, 1875e41ab937SDedy Lansky vif->ssid_len, privacy, 187633190ebfSVladimir Kondratiev wdev->beacon_interval, 1877e00243faSLior David vif->channel, bcon, 1878e00243faSLior David vif->hidden_ssid, 1879e00243faSLior David vif->pbss); 188033190ebfSVladimir Kondratiev } else { 1881e00243faSLior David rc = _wil_cfg80211_set_ies(vif, bcon); 18821bd922fcSVladimir Kondratiev } 18831bd922fcSVladimir Kondratiev 188433190ebfSVladimir Kondratiev return rc; 18851bd922fcSVladimir Kondratiev } 18861bd922fcSVladimir Kondratiev 18872be7d22fSVladimir Kondratiev static int wil_cfg80211_start_ap(struct wiphy *wiphy, 18882be7d22fSVladimir Kondratiev struct net_device *ndev, 18892be7d22fSVladimir Kondratiev struct cfg80211_ap_settings *info) 18902be7d22fSVladimir Kondratiev { 189133190ebfSVladimir Kondratiev int rc; 18922be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 18932be7d22fSVladimir Kondratiev struct ieee80211_channel *channel = info->chandef.chan; 18942be7d22fSVladimir Kondratiev struct cfg80211_beacon_data *bcon = &info->beacon; 1895ca959773SVladimir Kondratiev struct cfg80211_crypto_settings *crypto = &info->crypto; 18968e52fe30SHamad Kadmany u8 hidden_ssid; 18972be7d22fSVladimir Kondratiev 1898af3db60aSLazar Alexei wil_dbg_misc(wil, "start_ap\n"); 1899ca959773SVladimir Kondratiev 19002be7d22fSVladimir Kondratiev if (!channel) { 19012be7d22fSVladimir Kondratiev wil_err(wil, "AP: No channel???\n"); 19022be7d22fSVladimir Kondratiev return -EINVAL; 19032be7d22fSVladimir Kondratiev } 19042be7d22fSVladimir Kondratiev 190533190ebfSVladimir Kondratiev switch (info->hidden_ssid) { 190633190ebfSVladimir Kondratiev case NL80211_HIDDEN_SSID_NOT_IN_USE: 190733190ebfSVladimir Kondratiev hidden_ssid = WMI_HIDDEN_SSID_DISABLED; 190833190ebfSVladimir Kondratiev break; 190933190ebfSVladimir Kondratiev 191033190ebfSVladimir Kondratiev case NL80211_HIDDEN_SSID_ZERO_LEN: 191133190ebfSVladimir Kondratiev hidden_ssid = WMI_HIDDEN_SSID_SEND_EMPTY; 191233190ebfSVladimir Kondratiev break; 191333190ebfSVladimir Kondratiev 191433190ebfSVladimir Kondratiev case NL80211_HIDDEN_SSID_ZERO_CONTENTS: 191533190ebfSVladimir Kondratiev hidden_ssid = WMI_HIDDEN_SSID_CLEAR; 191633190ebfSVladimir Kondratiev break; 191733190ebfSVladimir Kondratiev 191833190ebfSVladimir Kondratiev default: 191933190ebfSVladimir Kondratiev wil_err(wil, "AP: Invalid hidden SSID %d\n", info->hidden_ssid); 192033190ebfSVladimir Kondratiev return -EOPNOTSUPP; 192133190ebfSVladimir Kondratiev } 19227743882dSVladimir Kondratiev wil_dbg_misc(wil, "AP on Channel %d %d MHz, %s\n", channel->hw_value, 19232be7d22fSVladimir Kondratiev channel->center_freq, info->privacy ? "secure" : "open"); 1924ca959773SVladimir Kondratiev wil_dbg_misc(wil, "Privacy: %d auth_type %d\n", 1925ca959773SVladimir Kondratiev info->privacy, info->auth_type); 19268e52fe30SHamad Kadmany wil_dbg_misc(wil, "Hidden SSID mode: %d\n", 19278e52fe30SHamad Kadmany info->hidden_ssid); 1928ca959773SVladimir Kondratiev wil_dbg_misc(wil, "BI %d DTIM %d\n", info->beacon_interval, 1929ca959773SVladimir Kondratiev info->dtim_period); 1930eabb03b4SLior David wil_dbg_misc(wil, "PBSS %d\n", info->pbss); 19315eb443e9SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 19325eb443e9SDedy Lansky info->ssid, info->ssid_len, true); 1933ca959773SVladimir Kondratiev wil_print_bcon_data(bcon); 1934ca959773SVladimir Kondratiev wil_print_crypto(wil, crypto); 19352be7d22fSVladimir Kondratiev 193633190ebfSVladimir Kondratiev rc = _wil_cfg80211_start_ap(wiphy, ndev, 193733190ebfSVladimir Kondratiev info->ssid, info->ssid_len, info->privacy, 193833190ebfSVladimir Kondratiev info->beacon_interval, channel->hw_value, 1939eabb03b4SLior David bcon, hidden_ssid, info->pbss); 1940c33407a8SVladimir Kondratiev 19412be7d22fSVladimir Kondratiev return rc; 19422be7d22fSVladimir Kondratiev } 19432be7d22fSVladimir Kondratiev 19442be7d22fSVladimir Kondratiev static int wil_cfg80211_stop_ap(struct wiphy *wiphy, 19452be7d22fSVladimir Kondratiev struct net_device *ndev) 19462be7d22fSVladimir Kondratiev { 19472be7d22fSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1948e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(ndev); 19493ada9314SLior David bool last; 19502be7d22fSVladimir Kondratiev 19513ada9314SLior David wil_dbg_misc(wil, "stop_ap, mid=%d\n", vif->mid); 1952ca959773SVladimir Kondratiev 1953c5e96c91SDedy Lansky netif_carrier_off(ndev); 19543ada9314SLior David last = !wil_has_other_active_ifaces(wil, ndev, false, true); 19553ada9314SLior David if (last) { 19569953a782SLior David wil6210_bus_request(wil, WIL_DEFAULT_BUS_REQUEST_KBPS); 1957c33407a8SVladimir Kondratiev wil_set_recovery_state(wil, fw_recovery_idle); 1958646d402dSHamad Kadmany set_bit(wil_status_resetting, wil->status); 19593ada9314SLior David } 1960646d402dSHamad Kadmany 19619c3bde56SVladimir Kondratiev mutex_lock(&wil->mutex); 19629c3bde56SVladimir Kondratiev 1963e00243faSLior David wmi_pcp_stop(vif); 1964b9010f10SAhmad Masri clear_bit(wil_vif_ft_roam, vif->status); 1965e41ab937SDedy Lansky vif->ssid_len = 0; 1966e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp, &vif->proberesp_len, NULL, 0); 1967e41ab937SDedy Lansky wil_memdup_ie(&vif->proberesp_ies, &vif->proberesp_ies_len, NULL, 0); 1968e41ab937SDedy Lansky wil_memdup_ie(&vif->assocresp_ies, &vif->assocresp_ies_len, NULL, 0); 1969e41ab937SDedy Lansky memset(vif->gtk, 0, WMI_MAX_KEY_LEN); 1970e41ab937SDedy Lansky vif->gtk_len = 0; 19712be7d22fSVladimir Kondratiev 19723ada9314SLior David if (last) 197373d839aeSVladimir Kondratiev __wil_down(wil); 19743ada9314SLior David else 19753ada9314SLior David wil_bcast_fini(vif); 197673d839aeSVladimir Kondratiev 19779c3bde56SVladimir Kondratiev mutex_unlock(&wil->mutex); 197873d839aeSVladimir Kondratiev 197932a20d46SDedy Lansky return 0; 19802be7d22fSVladimir Kondratiev } 19812be7d22fSVladimir Kondratiev 1982849a564bSDedy Lansky static int wil_cfg80211_add_station(struct wiphy *wiphy, 1983849a564bSDedy Lansky struct net_device *dev, 1984849a564bSDedy Lansky const u8 *mac, 1985849a564bSDedy Lansky struct station_parameters *params) 1986849a564bSDedy Lansky { 1987e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 1988849a564bSDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 1989849a564bSDedy Lansky 1990b9010f10SAhmad Masri wil_dbg_misc(wil, "add station %pM aid %d mid %d mask 0x%x set 0x%x\n", 1991b9010f10SAhmad Masri mac, params->aid, vif->mid, 1992b9010f10SAhmad Masri params->sta_flags_mask, params->sta_flags_set); 1993849a564bSDedy Lansky 1994849a564bSDedy Lansky if (!disable_ap_sme) { 1995849a564bSDedy Lansky wil_err(wil, "not supported with AP SME enabled\n"); 1996849a564bSDedy Lansky return -EOPNOTSUPP; 1997849a564bSDedy Lansky } 1998849a564bSDedy Lansky 1999849a564bSDedy Lansky if (params->aid > WIL_MAX_DMG_AID) { 2000849a564bSDedy Lansky wil_err(wil, "invalid aid\n"); 2001849a564bSDedy Lansky return -EINVAL; 2002849a564bSDedy Lansky } 2003849a564bSDedy Lansky 2004e00243faSLior David return wmi_new_sta(vif, mac, params->aid); 2005849a564bSDedy Lansky } 2006849a564bSDedy Lansky 20074d55a0a1SVladimir Kondratiev static int wil_cfg80211_del_station(struct wiphy *wiphy, 200889c771e5SJouni Malinen struct net_device *dev, 200989c771e5SJouni Malinen struct station_del_parameters *params) 20104d55a0a1SVladimir Kondratiev { 2011e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 20124d55a0a1SVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2013097638a0SVladimir Kondratiev 2014e00243faSLior David wil_dbg_misc(wil, "del_station: %pM, reason=%d mid=%d\n", 2015e00243faSLior David params->mac, params->reason_code, vif->mid); 2016de9084efSVladimir Kondratiev 2017097638a0SVladimir Kondratiev mutex_lock(&wil->mutex); 2018e00243faSLior David wil6210_disconnect(vif, params->mac, params->reason_code, false); 2019097638a0SVladimir Kondratiev mutex_unlock(&wil->mutex); 2020097638a0SVladimir Kondratiev 20214d55a0a1SVladimir Kondratiev return 0; 20224d55a0a1SVladimir Kondratiev } 20234d55a0a1SVladimir Kondratiev 2024849a564bSDedy Lansky static int wil_cfg80211_change_station(struct wiphy *wiphy, 2025849a564bSDedy Lansky struct net_device *dev, 2026849a564bSDedy Lansky const u8 *mac, 2027849a564bSDedy Lansky struct station_parameters *params) 2028849a564bSDedy Lansky { 2029e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 2030849a564bSDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2031849a564bSDedy Lansky int authorize; 2032849a564bSDedy Lansky int cid, i; 203310590c6aSGidon Studinski struct wil_ring_tx_data *txdata = NULL; 2034849a564bSDedy Lansky 2035e00243faSLior David wil_dbg_misc(wil, "change station %pM mask 0x%x set 0x%x mid %d\n", 2036e00243faSLior David mac, params->sta_flags_mask, params->sta_flags_set, 2037e00243faSLior David vif->mid); 2038849a564bSDedy Lansky 2039849a564bSDedy Lansky if (!disable_ap_sme) { 2040849a564bSDedy Lansky wil_dbg_misc(wil, "not supported with AP SME enabled\n"); 2041849a564bSDedy Lansky return -EOPNOTSUPP; 2042849a564bSDedy Lansky } 2043849a564bSDedy Lansky 2044849a564bSDedy Lansky if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 2045849a564bSDedy Lansky return 0; 2046849a564bSDedy Lansky 2047e00243faSLior David cid = wil_find_cid(wil, vif->mid, mac); 2048849a564bSDedy Lansky if (cid < 0) { 2049849a564bSDedy Lansky wil_err(wil, "station not found\n"); 2050849a564bSDedy Lansky return -ENOLINK; 2051849a564bSDedy Lansky } 2052849a564bSDedy Lansky 205310590c6aSGidon Studinski for (i = 0; i < ARRAY_SIZE(wil->ring2cid_tid); i++) 205410590c6aSGidon Studinski if (wil->ring2cid_tid[i][0] == cid) { 205510590c6aSGidon Studinski txdata = &wil->ring_tx_data[i]; 2056849a564bSDedy Lansky break; 2057849a564bSDedy Lansky } 2058849a564bSDedy Lansky 2059849a564bSDedy Lansky if (!txdata) { 206010590c6aSGidon Studinski wil_err(wil, "ring data not found\n"); 2061849a564bSDedy Lansky return -ENOLINK; 2062849a564bSDedy Lansky } 2063849a564bSDedy Lansky 2064849a564bSDedy Lansky authorize = params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED); 2065849a564bSDedy Lansky txdata->dot1x_open = authorize ? 1 : 0; 206610590c6aSGidon Studinski wil_dbg_misc(wil, "cid %d ring %d authorize %d\n", cid, i, 2067849a564bSDedy Lansky txdata->dot1x_open); 2068849a564bSDedy Lansky 2069849a564bSDedy Lansky return 0; 2070849a564bSDedy Lansky } 2071849a564bSDedy Lansky 207240822a90SVladimir Kondratiev /* probe_client handling */ 207340822a90SVladimir Kondratiev static void wil_probe_client_handle(struct wil6210_priv *wil, 2074e00243faSLior David struct wil6210_vif *vif, 207540822a90SVladimir Kondratiev struct wil_probe_client_req *req) 207640822a90SVladimir Kondratiev { 2077e00243faSLior David struct net_device *ndev = vif_to_ndev(vif); 207840822a90SVladimir Kondratiev struct wil_sta_info *sta = &wil->sta[req->cid]; 207940822a90SVladimir Kondratiev /* assume STA is alive if it is still connected, 208040822a90SVladimir Kondratiev * else FW will disconnect it 208140822a90SVladimir Kondratiev */ 208240822a90SVladimir Kondratiev bool alive = (sta->status == wil_sta_connected); 208340822a90SVladimir Kondratiev 2084c4b50cd3SVenkateswara Naralasetty cfg80211_probe_status(ndev, sta->addr, req->cookie, alive, 2085c4b50cd3SVenkateswara Naralasetty 0, false, GFP_KERNEL); 208640822a90SVladimir Kondratiev } 208740822a90SVladimir Kondratiev 2088e00243faSLior David static struct list_head *next_probe_client(struct wil6210_vif *vif) 208940822a90SVladimir Kondratiev { 209040822a90SVladimir Kondratiev struct list_head *ret = NULL; 209140822a90SVladimir Kondratiev 2092e00243faSLior David mutex_lock(&vif->probe_client_mutex); 209340822a90SVladimir Kondratiev 2094e00243faSLior David if (!list_empty(&vif->probe_client_pending)) { 2095e00243faSLior David ret = vif->probe_client_pending.next; 209640822a90SVladimir Kondratiev list_del(ret); 209740822a90SVladimir Kondratiev } 209840822a90SVladimir Kondratiev 2099e00243faSLior David mutex_unlock(&vif->probe_client_mutex); 210040822a90SVladimir Kondratiev 210140822a90SVladimir Kondratiev return ret; 210240822a90SVladimir Kondratiev } 210340822a90SVladimir Kondratiev 210440822a90SVladimir Kondratiev void wil_probe_client_worker(struct work_struct *work) 210540822a90SVladimir Kondratiev { 2106e00243faSLior David struct wil6210_vif *vif = container_of(work, struct wil6210_vif, 210740822a90SVladimir Kondratiev probe_client_worker); 2108e00243faSLior David struct wil6210_priv *wil = vif_to_wil(vif); 210940822a90SVladimir Kondratiev struct wil_probe_client_req *req; 211040822a90SVladimir Kondratiev struct list_head *lh; 211140822a90SVladimir Kondratiev 2112e00243faSLior David while ((lh = next_probe_client(vif)) != NULL) { 211340822a90SVladimir Kondratiev req = list_entry(lh, struct wil_probe_client_req, list); 211440822a90SVladimir Kondratiev 2115e00243faSLior David wil_probe_client_handle(wil, vif, req); 211640822a90SVladimir Kondratiev kfree(req); 211740822a90SVladimir Kondratiev } 211840822a90SVladimir Kondratiev } 211940822a90SVladimir Kondratiev 2120e00243faSLior David void wil_probe_client_flush(struct wil6210_vif *vif) 212140822a90SVladimir Kondratiev { 212240822a90SVladimir Kondratiev struct wil_probe_client_req *req, *t; 2123e00243faSLior David struct wil6210_priv *wil = vif_to_wil(vif); 212440822a90SVladimir Kondratiev 2125af3db60aSLazar Alexei wil_dbg_misc(wil, "probe_client_flush\n"); 212640822a90SVladimir Kondratiev 2127e00243faSLior David mutex_lock(&vif->probe_client_mutex); 212840822a90SVladimir Kondratiev 2129e00243faSLior David list_for_each_entry_safe(req, t, &vif->probe_client_pending, list) { 213040822a90SVladimir Kondratiev list_del(&req->list); 213140822a90SVladimir Kondratiev kfree(req); 213240822a90SVladimir Kondratiev } 213340822a90SVladimir Kondratiev 2134e00243faSLior David mutex_unlock(&vif->probe_client_mutex); 213540822a90SVladimir Kondratiev } 213640822a90SVladimir Kondratiev 213740822a90SVladimir Kondratiev static int wil_cfg80211_probe_client(struct wiphy *wiphy, 213840822a90SVladimir Kondratiev struct net_device *dev, 213940822a90SVladimir Kondratiev const u8 *peer, u64 *cookie) 214040822a90SVladimir Kondratiev { 214140822a90SVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2142e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 214340822a90SVladimir Kondratiev struct wil_probe_client_req *req; 2144e00243faSLior David int cid = wil_find_cid(wil, vif->mid, peer); 214540822a90SVladimir Kondratiev 2146e00243faSLior David wil_dbg_misc(wil, "probe_client: %pM => CID %d MID %d\n", 2147e00243faSLior David peer, cid, vif->mid); 214840822a90SVladimir Kondratiev 214940822a90SVladimir Kondratiev if (cid < 0) 215040822a90SVladimir Kondratiev return -ENOLINK; 215140822a90SVladimir Kondratiev 215240822a90SVladimir Kondratiev req = kzalloc(sizeof(*req), GFP_KERNEL); 215340822a90SVladimir Kondratiev if (!req) 215440822a90SVladimir Kondratiev return -ENOMEM; 215540822a90SVladimir Kondratiev 215640822a90SVladimir Kondratiev req->cid = cid; 215740822a90SVladimir Kondratiev req->cookie = cid; 215840822a90SVladimir Kondratiev 2159e00243faSLior David mutex_lock(&vif->probe_client_mutex); 2160e00243faSLior David list_add_tail(&req->list, &vif->probe_client_pending); 2161e00243faSLior David mutex_unlock(&vif->probe_client_mutex); 216240822a90SVladimir Kondratiev 216340822a90SVladimir Kondratiev *cookie = req->cookie; 2164e00243faSLior David queue_work(wil->wq_service, &vif->probe_client_worker); 216540822a90SVladimir Kondratiev return 0; 216640822a90SVladimir Kondratiev } 216740822a90SVladimir Kondratiev 216802beaf1aSVladimir Kondratiev static int wil_cfg80211_change_bss(struct wiphy *wiphy, 216902beaf1aSVladimir Kondratiev struct net_device *dev, 217002beaf1aSVladimir Kondratiev struct bss_parameters *params) 217102beaf1aSVladimir Kondratiev { 217202beaf1aSVladimir Kondratiev struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2173e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 217402beaf1aSVladimir Kondratiev 217502beaf1aSVladimir Kondratiev if (params->ap_isolate >= 0) { 2176e00243faSLior David wil_dbg_misc(wil, "change_bss: ap_isolate MID %d, %d => %d\n", 2177e00243faSLior David vif->mid, vif->ap_isolate, params->ap_isolate); 2178e00243faSLior David vif->ap_isolate = params->ap_isolate; 217902beaf1aSVladimir Kondratiev } 218002beaf1aSVladimir Kondratiev 218102beaf1aSVladimir Kondratiev return 0; 218202beaf1aSVladimir Kondratiev } 218302beaf1aSVladimir Kondratiev 21842c207eb8SMaya Erez static int wil_cfg80211_set_power_mgmt(struct wiphy *wiphy, 21852c207eb8SMaya Erez struct net_device *dev, 21862c207eb8SMaya Erez bool enabled, int timeout) 21872c207eb8SMaya Erez { 21882c207eb8SMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 21892c207eb8SMaya Erez enum wmi_ps_profile_type ps_profile; 21902c207eb8SMaya Erez 21912c207eb8SMaya Erez wil_dbg_misc(wil, "enabled=%d, timeout=%d\n", 21922c207eb8SMaya Erez enabled, timeout); 21932c207eb8SMaya Erez 21942c207eb8SMaya Erez if (enabled) 21952c207eb8SMaya Erez ps_profile = WMI_PS_PROFILE_TYPE_DEFAULT; 21962c207eb8SMaya Erez else 21972c207eb8SMaya Erez ps_profile = WMI_PS_PROFILE_TYPE_PS_DISABLED; 21982c207eb8SMaya Erez 21998b068c03SLazar Alexei return wil_ps_update(wil, ps_profile); 22002c207eb8SMaya Erez } 22012c207eb8SMaya Erez 2202fe9ee51eSMaya Erez static int wil_cfg80211_suspend(struct wiphy *wiphy, 2203fe9ee51eSMaya Erez struct cfg80211_wowlan *wow) 2204fe9ee51eSMaya Erez { 2205fe9ee51eSMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2206fe9ee51eSMaya Erez int rc; 2207fe9ee51eSMaya Erez 2208fe9ee51eSMaya Erez /* Setting the wakeup trigger based on wow is TBD */ 2209fe9ee51eSMaya Erez 2210fe9ee51eSMaya Erez if (test_bit(wil_status_suspended, wil->status)) { 2211fe9ee51eSMaya Erez wil_dbg_pm(wil, "trying to suspend while suspended\n"); 2212fe9ee51eSMaya Erez return 0; 2213fe9ee51eSMaya Erez } 2214fe9ee51eSMaya Erez 2215fe9ee51eSMaya Erez rc = wil_can_suspend(wil, false); 2216fe9ee51eSMaya Erez if (rc) 2217fe9ee51eSMaya Erez goto out; 2218fe9ee51eSMaya Erez 2219fe9ee51eSMaya Erez wil_dbg_pm(wil, "suspending\n"); 2220fe9ee51eSMaya Erez 2221144a12a6SHamad Kadmany mutex_lock(&wil->mutex); 2222404bbb3cSLior David mutex_lock(&wil->vif_mutex); 2223144a12a6SHamad Kadmany wil_p2p_stop_radio_operations(wil); 22245bd60982SLior David wil_abort_scan_all_vifs(wil, true); 2225404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 2226144a12a6SHamad Kadmany mutex_unlock(&wil->mutex); 2227fe9ee51eSMaya Erez 2228fe9ee51eSMaya Erez out: 2229fe9ee51eSMaya Erez return rc; 2230fe9ee51eSMaya Erez } 2231fe9ee51eSMaya Erez 2232fe9ee51eSMaya Erez static int wil_cfg80211_resume(struct wiphy *wiphy) 2233fe9ee51eSMaya Erez { 2234fe9ee51eSMaya Erez struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2235fe9ee51eSMaya Erez 2236fe9ee51eSMaya Erez wil_dbg_pm(wil, "resuming\n"); 2237fe9ee51eSMaya Erez 2238fe9ee51eSMaya Erez return 0; 2239fe9ee51eSMaya Erez } 2240fe9ee51eSMaya Erez 2241a5dc6883SDedy Lansky static int 2242a5dc6883SDedy Lansky wil_cfg80211_sched_scan_start(struct wiphy *wiphy, 2243a5dc6883SDedy Lansky struct net_device *dev, 2244a5dc6883SDedy Lansky struct cfg80211_sched_scan_request *request) 2245a5dc6883SDedy Lansky { 2246a5dc6883SDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2247e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 2248a5dc6883SDedy Lansky int i, rc; 2249a5dc6883SDedy Lansky 2250e00243faSLior David if (vif->mid != 0) 2251e00243faSLior David return -EOPNOTSUPP; 2252e00243faSLior David 2253a5dc6883SDedy Lansky wil_dbg_misc(wil, 2254a5dc6883SDedy Lansky "sched scan start: n_ssids %d, ie_len %zu, flags 0x%x\n", 2255a5dc6883SDedy Lansky request->n_ssids, request->ie_len, request->flags); 2256a5dc6883SDedy Lansky for (i = 0; i < request->n_ssids; i++) { 2257a5dc6883SDedy Lansky wil_dbg_misc(wil, "SSID[%d]:", i); 2258a5dc6883SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 2259a5dc6883SDedy Lansky request->ssids[i].ssid, 2260a5dc6883SDedy Lansky request->ssids[i].ssid_len, true); 2261a5dc6883SDedy Lansky } 2262a5dc6883SDedy Lansky wil_dbg_misc(wil, "channels:"); 2263a5dc6883SDedy Lansky for (i = 0; i < request->n_channels; i++) 2264a5dc6883SDedy Lansky wil_dbg_misc(wil, " %d%s", request->channels[i]->hw_value, 2265a5dc6883SDedy Lansky i == request->n_channels - 1 ? "\n" : ""); 2266a5dc6883SDedy Lansky wil_dbg_misc(wil, "n_match_sets %d, min_rssi_thold %d, delay %d\n", 2267a5dc6883SDedy Lansky request->n_match_sets, request->min_rssi_thold, 2268a5dc6883SDedy Lansky request->delay); 2269a5dc6883SDedy Lansky for (i = 0; i < request->n_match_sets; i++) { 2270a5dc6883SDedy Lansky struct cfg80211_match_set *ms = &request->match_sets[i]; 2271a5dc6883SDedy Lansky 2272a5dc6883SDedy Lansky wil_dbg_misc(wil, "MATCHSET[%d]: rssi_thold %d\n", 2273a5dc6883SDedy Lansky i, ms->rssi_thold); 2274a5dc6883SDedy Lansky wil_hex_dump_misc("SSID ", DUMP_PREFIX_OFFSET, 16, 1, 2275a5dc6883SDedy Lansky ms->ssid.ssid, 2276a5dc6883SDedy Lansky ms->ssid.ssid_len, true); 2277a5dc6883SDedy Lansky } 2278a5dc6883SDedy Lansky wil_dbg_misc(wil, "n_scan_plans %d\n", request->n_scan_plans); 2279a5dc6883SDedy Lansky for (i = 0; i < request->n_scan_plans; i++) { 2280a5dc6883SDedy Lansky struct cfg80211_sched_scan_plan *sp = &request->scan_plans[i]; 2281a5dc6883SDedy Lansky 2282a5dc6883SDedy Lansky wil_dbg_misc(wil, "SCAN PLAN[%d]: interval %d iterations %d\n", 2283a5dc6883SDedy Lansky i, sp->interval, sp->iterations); 2284a5dc6883SDedy Lansky } 2285a5dc6883SDedy Lansky 2286e00243faSLior David rc = wmi_set_ie(vif, WMI_FRAME_PROBE_REQ, 2287e00243faSLior David request->ie_len, request->ie); 2288a5dc6883SDedy Lansky if (rc) 2289a5dc6883SDedy Lansky return rc; 2290a5dc6883SDedy Lansky return wmi_start_sched_scan(wil, request); 2291a5dc6883SDedy Lansky } 2292a5dc6883SDedy Lansky 2293a5dc6883SDedy Lansky static int 2294a5dc6883SDedy Lansky wil_cfg80211_sched_scan_stop(struct wiphy *wiphy, struct net_device *dev, 2295a5dc6883SDedy Lansky u64 reqid) 2296a5dc6883SDedy Lansky { 2297a5dc6883SDedy Lansky struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2298e00243faSLior David struct wil6210_vif *vif = ndev_to_vif(dev); 2299a5dc6883SDedy Lansky int rc; 2300a5dc6883SDedy Lansky 2301e00243faSLior David if (vif->mid != 0) 2302e00243faSLior David return -EOPNOTSUPP; 2303e00243faSLior David 2304a5dc6883SDedy Lansky rc = wmi_stop_sched_scan(wil); 2305a5dc6883SDedy Lansky /* device would return error if it thinks PNO is already stopped. 2306a5dc6883SDedy Lansky * ignore the return code so user space and driver gets back in-sync 2307a5dc6883SDedy Lansky */ 2308a5dc6883SDedy Lansky wil_dbg_misc(wil, "sched scan stopped (%d)\n", rc); 2309a5dc6883SDedy Lansky 2310a5dc6883SDedy Lansky return 0; 2311a5dc6883SDedy Lansky } 2312a5dc6883SDedy Lansky 2313b9010f10SAhmad Masri static int 2314b9010f10SAhmad Masri wil_cfg80211_update_ft_ies(struct wiphy *wiphy, struct net_device *dev, 2315b9010f10SAhmad Masri struct cfg80211_update_ft_ies_params *ftie) 2316b9010f10SAhmad Masri { 2317b9010f10SAhmad Masri struct wil6210_priv *wil = wiphy_to_wil(wiphy); 2318b9010f10SAhmad Masri struct wil6210_vif *vif = ndev_to_vif(dev); 2319b9010f10SAhmad Masri struct cfg80211_bss *bss; 2320b9010f10SAhmad Masri struct wmi_ft_reassoc_cmd reassoc; 2321b9010f10SAhmad Masri int rc = 0; 2322b9010f10SAhmad Masri 2323b9010f10SAhmad Masri wil_dbg_misc(wil, "update ft ies, mid=%d\n", vif->mid); 2324b9010f10SAhmad Masri wil_hex_dump_misc("FT IE ", DUMP_PREFIX_OFFSET, 16, 1, 2325b9010f10SAhmad Masri ftie->ie, ftie->ie_len, true); 2326b9010f10SAhmad Masri 2327b9010f10SAhmad Masri if (!test_bit(WMI_FW_CAPABILITY_FT_ROAMING, wil->fw_capabilities)) { 2328b9010f10SAhmad Masri wil_err(wil, "FW does not support FT roaming\n"); 2329b9010f10SAhmad Masri return -EOPNOTSUPP; 2330b9010f10SAhmad Masri } 2331b9010f10SAhmad Masri 2332b9010f10SAhmad Masri rc = wmi_update_ft_ies(vif, ftie->ie_len, ftie->ie); 2333b9010f10SAhmad Masri if (rc) 2334b9010f10SAhmad Masri return rc; 2335b9010f10SAhmad Masri 2336b9010f10SAhmad Masri if (!test_bit(wil_vif_ft_roam, vif->status)) 2337b9010f10SAhmad Masri /* vif is not roaming */ 2338b9010f10SAhmad Masri return 0; 2339b9010f10SAhmad Masri 2340b9010f10SAhmad Masri /* wil_vif_ft_roam is set. wil_cfg80211_update_ft_ies is used as 2341b9010f10SAhmad Masri * a trigger for reassoc 2342b9010f10SAhmad Masri */ 2343b9010f10SAhmad Masri 2344b9010f10SAhmad Masri bss = vif->bss; 2345b9010f10SAhmad Masri if (!bss) { 2346b9010f10SAhmad Masri wil_err(wil, "FT: bss is NULL\n"); 2347b9010f10SAhmad Masri return -EINVAL; 2348b9010f10SAhmad Masri } 2349b9010f10SAhmad Masri 2350b9010f10SAhmad Masri memset(&reassoc, 0, sizeof(reassoc)); 2351b9010f10SAhmad Masri ether_addr_copy(reassoc.bssid, bss->bssid); 2352b9010f10SAhmad Masri 2353b9010f10SAhmad Masri rc = wmi_send(wil, WMI_FT_REASSOC_CMDID, vif->mid, 2354b9010f10SAhmad Masri &reassoc, sizeof(reassoc)); 2355b9010f10SAhmad Masri if (rc) 2356b9010f10SAhmad Masri wil_err(wil, "FT: reassoc failed (%d)\n", rc); 2357b9010f10SAhmad Masri 2358b9010f10SAhmad Masri return rc; 2359b9010f10SAhmad Masri } 2360b9010f10SAhmad Masri 2361b59eb961SBhumika Goyal static const struct cfg80211_ops wil_cfg80211_ops = { 23624332cac1SLior David .add_virtual_intf = wil_cfg80211_add_iface, 23634332cac1SLior David .del_virtual_intf = wil_cfg80211_del_iface, 23642be7d22fSVladimir Kondratiev .scan = wil_cfg80211_scan, 2365035859a5SMaya Erez .abort_scan = wil_cfg80211_abort_scan, 23662be7d22fSVladimir Kondratiev .connect = wil_cfg80211_connect, 23672be7d22fSVladimir Kondratiev .disconnect = wil_cfg80211_disconnect, 23683fea18d0SLior David .set_wiphy_params = wil_cfg80211_set_wiphy_params, 23692be7d22fSVladimir Kondratiev .change_virtual_intf = wil_cfg80211_change_iface, 23702be7d22fSVladimir Kondratiev .get_station = wil_cfg80211_get_station, 2371ef28afdbSVladimir Kondratiev .dump_station = wil_cfg80211_dump_station, 23721647f12fSVladimir Kondratiev .remain_on_channel = wil_remain_on_channel, 23731647f12fSVladimir Kondratiev .cancel_remain_on_channel = wil_cancel_remain_on_channel, 23741647f12fSVladimir Kondratiev .mgmt_tx = wil_cfg80211_mgmt_tx, 23752be7d22fSVladimir Kondratiev .set_monitor_channel = wil_cfg80211_set_channel, 23762be7d22fSVladimir Kondratiev .add_key = wil_cfg80211_add_key, 23772be7d22fSVladimir Kondratiev .del_key = wil_cfg80211_del_key, 23782be7d22fSVladimir Kondratiev .set_default_key = wil_cfg80211_set_default_key, 23792be7d22fSVladimir Kondratiev /* AP mode */ 23801bd922fcSVladimir Kondratiev .change_beacon = wil_cfg80211_change_beacon, 23812be7d22fSVladimir Kondratiev .start_ap = wil_cfg80211_start_ap, 23822be7d22fSVladimir Kondratiev .stop_ap = wil_cfg80211_stop_ap, 2383849a564bSDedy Lansky .add_station = wil_cfg80211_add_station, 23844d55a0a1SVladimir Kondratiev .del_station = wil_cfg80211_del_station, 2385849a564bSDedy Lansky .change_station = wil_cfg80211_change_station, 238640822a90SVladimir Kondratiev .probe_client = wil_cfg80211_probe_client, 238702beaf1aSVladimir Kondratiev .change_bss = wil_cfg80211_change_bss, 23884332cac1SLior David /* P2P device */ 23894332cac1SLior David .start_p2p_device = wil_cfg80211_start_p2p_device, 23904332cac1SLior David .stop_p2p_device = wil_cfg80211_stop_p2p_device, 23912c207eb8SMaya Erez .set_power_mgmt = wil_cfg80211_set_power_mgmt, 2392fe9ee51eSMaya Erez .suspend = wil_cfg80211_suspend, 2393fe9ee51eSMaya Erez .resume = wil_cfg80211_resume, 2394a5dc6883SDedy Lansky .sched_scan_start = wil_cfg80211_sched_scan_start, 2395a5dc6883SDedy Lansky .sched_scan_stop = wil_cfg80211_sched_scan_stop, 2396b9010f10SAhmad Masri .update_ft_ies = wil_cfg80211_update_ft_ies, 23972be7d22fSVladimir Kondratiev }; 23982be7d22fSVladimir Kondratiev 23992be7d22fSVladimir Kondratiev static void wil_wiphy_init(struct wiphy *wiphy) 24002be7d22fSVladimir Kondratiev { 24018e52fe30SHamad Kadmany wiphy->max_scan_ssids = 1; 240277c91295SVladimir Kondratiev wiphy->max_scan_ie_len = WMI_MAX_IE_LEN; 2403e6d68341SDedy Lansky wiphy->max_remain_on_channel_duration = WIL_MAX_ROC_DURATION_MS; 24042be7d22fSVladimir Kondratiev wiphy->max_num_pmkids = 0 /* TODO: */; 24052be7d22fSVladimir Kondratiev wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 24062be7d22fSVladimir Kondratiev BIT(NL80211_IFTYPE_AP) | 2407e6d68341SDedy Lansky BIT(NL80211_IFTYPE_P2P_CLIENT) | 2408e6d68341SDedy Lansky BIT(NL80211_IFTYPE_P2P_GO) | 24094332cac1SLior David BIT(NL80211_IFTYPE_P2P_DEVICE) | 2410e6d68341SDedy Lansky BIT(NL80211_IFTYPE_MONITOR); 2411849a564bSDedy Lansky wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 24122c207eb8SMaya Erez WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD | 24132c207eb8SMaya Erez WIPHY_FLAG_PS_ON_BY_DEFAULT; 2414849a564bSDedy Lansky if (!disable_ap_sme) 2415849a564bSDedy Lansky wiphy->flags |= WIPHY_FLAG_HAVE_AP_SME; 24169cf10d62SVladimir Kondratiev dev_dbg(wiphy_dev(wiphy), "%s : flags = 0x%08x\n", 24172be7d22fSVladimir Kondratiev __func__, wiphy->flags); 24182be7d22fSVladimir Kondratiev wiphy->probe_resp_offload = 24192be7d22fSVladimir Kondratiev NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 24202be7d22fSVladimir Kondratiev NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 24212be7d22fSVladimir Kondratiev NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 24222be7d22fSVladimir Kondratiev 242357fbcce3SJohannes Berg wiphy->bands[NL80211_BAND_60GHZ] = &wil_band_60ghz; 24242be7d22fSVladimir Kondratiev 242530868f5dSDedy Lansky /* may change after reading FW capabilities */ 2426b8b33a3aSVladimir Kondratiev wiphy->signal_type = CFG80211_SIGNAL_TYPE_UNSPEC; 24272be7d22fSVladimir Kondratiev 24282be7d22fSVladimir Kondratiev wiphy->cipher_suites = wil_cipher_suites; 24292be7d22fSVladimir Kondratiev wiphy->n_cipher_suites = ARRAY_SIZE(wil_cipher_suites); 24302be7d22fSVladimir Kondratiev wiphy->mgmt_stypes = wil_mgmt_stypes; 2431713c8a29SVladimir Kondratiev wiphy->features |= NL80211_FEATURE_SK_TX_STATUS; 24320216a895SLior David 24330216a895SLior David wiphy->n_vendor_commands = ARRAY_SIZE(wil_nl80211_vendor_commands); 24340216a895SLior David wiphy->vendor_commands = wil_nl80211_vendor_commands; 2435d1fbf075SMaya Erez 2436d1fbf075SMaya Erez #ifdef CONFIG_PM 2437d1fbf075SMaya Erez wiphy->wowlan = &wil_wowlan_support; 2438d1fbf075SMaya Erez #endif 24392be7d22fSVladimir Kondratiev } 24402be7d22fSVladimir Kondratiev 24417bfe9e22SLior David int wil_cfg80211_iface_combinations_from_fw( 24427bfe9e22SLior David struct wil6210_priv *wil, const struct wil_fw_record_concurrency *conc) 24437bfe9e22SLior David { 24447bfe9e22SLior David struct wiphy *wiphy = wil_to_wiphy(wil); 24457bfe9e22SLior David u32 total_limits = 0; 24467bfe9e22SLior David u16 n_combos; 24477bfe9e22SLior David const struct wil_fw_concurrency_combo *combo; 24487bfe9e22SLior David const struct wil_fw_concurrency_limit *limit; 24497bfe9e22SLior David struct ieee80211_iface_combination *iface_combinations; 24507bfe9e22SLior David struct ieee80211_iface_limit *iface_limit; 24517bfe9e22SLior David int i, j; 24527bfe9e22SLior David 24537bfe9e22SLior David if (wiphy->iface_combinations) { 24547bfe9e22SLior David wil_dbg_misc(wil, "iface_combinations already set, skipping\n"); 24557bfe9e22SLior David return 0; 24567bfe9e22SLior David } 24577bfe9e22SLior David 24587bfe9e22SLior David combo = conc->combos; 24597bfe9e22SLior David n_combos = le16_to_cpu(conc->n_combos); 24607bfe9e22SLior David for (i = 0; i < n_combos; i++) { 24617bfe9e22SLior David total_limits += combo->n_limits; 24627bfe9e22SLior David limit = combo->limits + combo->n_limits; 24637bfe9e22SLior David combo = (struct wil_fw_concurrency_combo *)limit; 24647bfe9e22SLior David } 24657bfe9e22SLior David 24667bfe9e22SLior David iface_combinations = 24677bfe9e22SLior David kzalloc(n_combos * sizeof(struct ieee80211_iface_combination) + 24687bfe9e22SLior David total_limits * sizeof(struct ieee80211_iface_limit), 24697bfe9e22SLior David GFP_KERNEL); 24707bfe9e22SLior David if (!iface_combinations) 24717bfe9e22SLior David return -ENOMEM; 24727bfe9e22SLior David iface_limit = (struct ieee80211_iface_limit *)(iface_combinations + 24737bfe9e22SLior David n_combos); 24747bfe9e22SLior David combo = conc->combos; 24757bfe9e22SLior David for (i = 0; i < n_combos; i++) { 24767bfe9e22SLior David iface_combinations[i].max_interfaces = combo->max_interfaces; 24777bfe9e22SLior David iface_combinations[i].num_different_channels = 24787bfe9e22SLior David combo->n_diff_channels; 24797bfe9e22SLior David iface_combinations[i].beacon_int_infra_match = 24807bfe9e22SLior David combo->same_bi; 24817bfe9e22SLior David iface_combinations[i].n_limits = combo->n_limits; 24827bfe9e22SLior David wil_dbg_misc(wil, 24837bfe9e22SLior David "iface_combination %d: max_if %d, num_ch %d, bi_match %d\n", 24847bfe9e22SLior David i, iface_combinations[i].max_interfaces, 24857bfe9e22SLior David iface_combinations[i].num_different_channels, 24867bfe9e22SLior David iface_combinations[i].beacon_int_infra_match); 24877bfe9e22SLior David limit = combo->limits; 24887bfe9e22SLior David for (j = 0; j < combo->n_limits; j++) { 24897bfe9e22SLior David iface_limit[j].max = le16_to_cpu(limit[j].max); 24907bfe9e22SLior David iface_limit[j].types = le16_to_cpu(limit[j].types); 24917bfe9e22SLior David wil_dbg_misc(wil, 24927bfe9e22SLior David "limit %d: max %d types 0x%x\n", j, 24937bfe9e22SLior David iface_limit[j].max, iface_limit[j].types); 24947bfe9e22SLior David } 24957bfe9e22SLior David iface_combinations[i].limits = iface_limit; 24967bfe9e22SLior David iface_limit += combo->n_limits; 24977bfe9e22SLior David limit += combo->n_limits; 24987bfe9e22SLior David combo = (struct wil_fw_concurrency_combo *)limit; 24997bfe9e22SLior David } 25007bfe9e22SLior David 25014aebd3bdSLior David wil_dbg_misc(wil, "multiple VIFs supported, n_mids %d\n", conc->n_mids); 25024aebd3bdSLior David wil->max_vifs = conc->n_mids + 1; /* including main interface */ 25034aebd3bdSLior David if (wil->max_vifs > WIL_MAX_VIFS) { 25044aebd3bdSLior David wil_info(wil, "limited number of VIFs supported(%d, FW %d)\n", 25054aebd3bdSLior David WIL_MAX_VIFS, wil->max_vifs); 25064aebd3bdSLior David wil->max_vifs = WIL_MAX_VIFS; 25074aebd3bdSLior David } 25087bfe9e22SLior David wiphy->n_iface_combinations = n_combos; 25097bfe9e22SLior David wiphy->iface_combinations = iface_combinations; 25107bfe9e22SLior David return 0; 25117bfe9e22SLior David } 25127bfe9e22SLior David 25139f38f286SLior David struct wil6210_priv *wil_cfg80211_init(struct device *dev) 25142be7d22fSVladimir Kondratiev { 25159f38f286SLior David struct wiphy *wiphy; 25169f38f286SLior David struct wil6210_priv *wil; 25179f38f286SLior David struct ieee80211_channel *ch; 25182be7d22fSVladimir Kondratiev 25199cf10d62SVladimir Kondratiev dev_dbg(dev, "%s()\n", __func__); 25209cf10d62SVladimir Kondratiev 25219f38f286SLior David /* Note: the wireless_dev structure is no longer allocated here. 25229f38f286SLior David * Instead, it is allocated as part of the net_device structure 25239f38f286SLior David * for main interface and each VIF. 25249f38f286SLior David */ 25259f38f286SLior David wiphy = wiphy_new(&wil_cfg80211_ops, sizeof(struct wil6210_priv)); 25269f38f286SLior David if (!wiphy) 25272be7d22fSVladimir Kondratiev return ERR_PTR(-ENOMEM); 25282be7d22fSVladimir Kondratiev 25299f38f286SLior David set_wiphy_dev(wiphy, dev); 25309f38f286SLior David wil_wiphy_init(wiphy); 25319f38f286SLior David 25329f38f286SLior David wil = wiphy_to_wil(wiphy); 25339f38f286SLior David wil->wiphy = wiphy; 25349f38f286SLior David 25359f38f286SLior David /* default monitor channel */ 25369f38f286SLior David ch = wiphy->bands[NL80211_BAND_60GHZ]->channels; 25379f38f286SLior David cfg80211_chandef_create(&wil->monitor_chandef, ch, NL80211_CHAN_NO_HT); 25389f38f286SLior David 25399f38f286SLior David return wil; 25402be7d22fSVladimir Kondratiev } 25412be7d22fSVladimir Kondratiev 25429f38f286SLior David void wil_cfg80211_deinit(struct wil6210_priv *wil) 25432be7d22fSVladimir Kondratiev { 25449f38f286SLior David struct wiphy *wiphy = wil_to_wiphy(wil); 25452be7d22fSVladimir Kondratiev 25469cf10d62SVladimir Kondratiev dev_dbg(wil_to_dev(wil), "%s()\n", __func__); 25479cf10d62SVladimir Kondratiev 25489f38f286SLior David if (!wiphy) 25492be7d22fSVladimir Kondratiev return; 25502be7d22fSVladimir Kondratiev 25517bfe9e22SLior David kfree(wiphy->iface_combinations); 25527bfe9e22SLior David wiphy->iface_combinations = NULL; 25537bfe9e22SLior David 25549f38f286SLior David wiphy_free(wiphy); 25559f38f286SLior David /* do not access wil6210_priv after returning from here */ 25562be7d22fSVladimir Kondratiev } 25574332cac1SLior David 25584332cac1SLior David void wil_p2p_wdev_free(struct wil6210_priv *wil) 25594332cac1SLior David { 25604332cac1SLior David struct wireless_dev *p2p_wdev; 25614332cac1SLior David 2562404bbb3cSLior David mutex_lock(&wil->vif_mutex); 25634332cac1SLior David p2p_wdev = wil->p2p_wdev; 25644332cac1SLior David wil->p2p_wdev = NULL; 2565e00243faSLior David wil->radio_wdev = wil->main_ndev->ieee80211_ptr; 2566404bbb3cSLior David mutex_unlock(&wil->vif_mutex); 2567d35c2b6fSMaya Erez if (p2p_wdev) { 25684332cac1SLior David cfg80211_unregister_wdev(p2p_wdev); 25695bd60982SLior David kfree(p2p_wdev); 25704332cac1SLior David } 25714332cac1SLior David } 25720216a895SLior David 25730216a895SLior David static int wil_rf_sector_status_to_rc(u8 status) 25740216a895SLior David { 25750216a895SLior David switch (status) { 25760216a895SLior David case WMI_RF_SECTOR_STATUS_SUCCESS: 25770216a895SLior David return 0; 25780216a895SLior David case WMI_RF_SECTOR_STATUS_BAD_PARAMETERS_ERROR: 25790216a895SLior David return -EINVAL; 25800216a895SLior David case WMI_RF_SECTOR_STATUS_BUSY_ERROR: 25810216a895SLior David return -EAGAIN; 25820216a895SLior David case WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR: 25830216a895SLior David return -EOPNOTSUPP; 25840216a895SLior David default: 25850216a895SLior David return -EINVAL; 25860216a895SLior David } 25870216a895SLior David } 25880216a895SLior David 25890216a895SLior David static int wil_rf_sector_get_cfg(struct wiphy *wiphy, 25900216a895SLior David struct wireless_dev *wdev, 25910216a895SLior David const void *data, int data_len) 25920216a895SLior David { 25930216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2594e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 25950216a895SLior David int rc; 25960216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 25970216a895SLior David u16 sector_index; 25980216a895SLior David u8 sector_type; 25990216a895SLior David u32 rf_modules_vec; 26000216a895SLior David struct wmi_get_rf_sector_params_cmd cmd; 26010216a895SLior David struct { 26020216a895SLior David struct wmi_cmd_hdr wmi; 26030216a895SLior David struct wmi_get_rf_sector_params_done_event evt; 2604807b0860SAlexei Avshalom Lazar } __packed reply = { 2605807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2606807b0860SAlexei Avshalom Lazar }; 26070216a895SLior David struct sk_buff *msg; 26080216a895SLior David struct nlattr *nl_cfgs, *nl_cfg; 26090216a895SLior David u32 i; 26100216a895SLior David struct wmi_rf_sector_info *si; 26110216a895SLior David 26120216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 26130216a895SLior David return -EOPNOTSUPP; 26140216a895SLior David 26150216a895SLior David rc = nla_parse(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, data_len, 26160216a895SLior David wil_rf_sector_policy, NULL); 26170216a895SLior David if (rc) { 26180216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 26190216a895SLior David return rc; 26200216a895SLior David } 26210216a895SLior David 26220216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_INDEX] || 26230216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_TYPE] || 26240216a895SLior David !tb[QCA_ATTR_DMG_RF_MODULE_MASK]) { 26250216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 26260216a895SLior David return -EINVAL; 26270216a895SLior David } 26280216a895SLior David 26290216a895SLior David sector_index = nla_get_u16( 26300216a895SLior David tb[QCA_ATTR_DMG_RF_SECTOR_INDEX]); 26310216a895SLior David if (sector_index >= WIL_MAX_RF_SECTORS) { 26320216a895SLior David wil_err(wil, "Invalid sector index %d\n", sector_index); 26330216a895SLior David return -EINVAL; 26340216a895SLior David } 26350216a895SLior David 26360216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 26370216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 26380216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 26390216a895SLior David return -EINVAL; 26400216a895SLior David } 26410216a895SLior David 26420216a895SLior David rf_modules_vec = nla_get_u32( 26430216a895SLior David tb[QCA_ATTR_DMG_RF_MODULE_MASK]); 26440216a895SLior David if (rf_modules_vec >= BIT(WMI_MAX_RF_MODULES_NUM)) { 26450216a895SLior David wil_err(wil, "Invalid rf module mask 0x%x\n", rf_modules_vec); 26460216a895SLior David return -EINVAL; 26470216a895SLior David } 26480216a895SLior David 26490216a895SLior David cmd.sector_idx = cpu_to_le16(sector_index); 26500216a895SLior David cmd.sector_type = sector_type; 26510216a895SLior David cmd.rf_modules_vec = rf_modules_vec & 0xFF; 2652e00243faSLior David rc = wmi_call(wil, WMI_GET_RF_SECTOR_PARAMS_CMDID, vif->mid, 2653e00243faSLior David &cmd, sizeof(cmd), WMI_GET_RF_SECTOR_PARAMS_DONE_EVENTID, 26540216a895SLior David &reply, sizeof(reply), 26550216a895SLior David 500); 26560216a895SLior David if (rc) 26570216a895SLior David return rc; 26580216a895SLior David if (reply.evt.status) { 26590216a895SLior David wil_err(wil, "get rf sector cfg failed with status %d\n", 26600216a895SLior David reply.evt.status); 26610216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 26620216a895SLior David } 26630216a895SLior David 26640216a895SLior David msg = cfg80211_vendor_cmd_alloc_reply_skb( 26650216a895SLior David wiphy, 64 * WMI_MAX_RF_MODULES_NUM); 26660216a895SLior David if (!msg) 26670216a895SLior David return -ENOMEM; 26680216a895SLior David 26690216a895SLior David if (nla_put_u64_64bit(msg, QCA_ATTR_TSF, 26700216a895SLior David le64_to_cpu(reply.evt.tsf), 26710216a895SLior David QCA_ATTR_PAD)) 26720216a895SLior David goto nla_put_failure; 26730216a895SLior David 26740216a895SLior David nl_cfgs = nla_nest_start(msg, QCA_ATTR_DMG_RF_SECTOR_CFG); 26750216a895SLior David if (!nl_cfgs) 26760216a895SLior David goto nla_put_failure; 26770216a895SLior David for (i = 0; i < WMI_MAX_RF_MODULES_NUM; i++) { 26780216a895SLior David if (!(rf_modules_vec & BIT(i))) 26790216a895SLior David continue; 26800216a895SLior David nl_cfg = nla_nest_start(msg, i); 26810216a895SLior David if (!nl_cfg) 26820216a895SLior David goto nla_put_failure; 26830216a895SLior David si = &reply.evt.sectors_info[i]; 26840216a895SLior David if (nla_put_u8(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX, 26850216a895SLior David i) || 26860216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0, 26870216a895SLior David le32_to_cpu(si->etype0)) || 26880216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1, 26890216a895SLior David le32_to_cpu(si->etype1)) || 26900216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2, 26910216a895SLior David le32_to_cpu(si->etype2)) || 26920216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI, 26930216a895SLior David le32_to_cpu(si->psh_hi)) || 26940216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO, 26950216a895SLior David le32_to_cpu(si->psh_lo)) || 26960216a895SLior David nla_put_u32(msg, QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16, 26970216a895SLior David le32_to_cpu(si->dtype_swch_off))) 26980216a895SLior David goto nla_put_failure; 26990216a895SLior David nla_nest_end(msg, nl_cfg); 27000216a895SLior David } 27010216a895SLior David 27020216a895SLior David nla_nest_end(msg, nl_cfgs); 27030216a895SLior David rc = cfg80211_vendor_cmd_reply(msg); 27040216a895SLior David return rc; 27050216a895SLior David nla_put_failure: 27060216a895SLior David kfree_skb(msg); 27070216a895SLior David return -ENOBUFS; 27080216a895SLior David } 27090216a895SLior David 27100216a895SLior David static int wil_rf_sector_set_cfg(struct wiphy *wiphy, 27110216a895SLior David struct wireless_dev *wdev, 27120216a895SLior David const void *data, int data_len) 27130216a895SLior David { 27140216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2715e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 27160216a895SLior David int rc, tmp; 27170216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 27180216a895SLior David struct nlattr *tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_MAX + 1]; 27190216a895SLior David u16 sector_index, rf_module_index; 27200216a895SLior David u8 sector_type; 27210216a895SLior David u32 rf_modules_vec = 0; 27220216a895SLior David struct wmi_set_rf_sector_params_cmd cmd; 27230216a895SLior David struct { 27240216a895SLior David struct wmi_cmd_hdr wmi; 27250216a895SLior David struct wmi_set_rf_sector_params_done_event evt; 2726807b0860SAlexei Avshalom Lazar } __packed reply = { 2727807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2728807b0860SAlexei Avshalom Lazar }; 27290216a895SLior David struct nlattr *nl_cfg; 27300216a895SLior David struct wmi_rf_sector_info *si; 27310216a895SLior David 27320216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 27330216a895SLior David return -EOPNOTSUPP; 27340216a895SLior David 27350216a895SLior David rc = nla_parse(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, data_len, 27360216a895SLior David wil_rf_sector_policy, NULL); 27370216a895SLior David if (rc) { 27380216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 27390216a895SLior David return rc; 27400216a895SLior David } 27410216a895SLior David 27420216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_INDEX] || 27430216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_TYPE] || 27440216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_CFG]) { 27450216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 27460216a895SLior David return -EINVAL; 27470216a895SLior David } 27480216a895SLior David 27490216a895SLior David sector_index = nla_get_u16( 27500216a895SLior David tb[QCA_ATTR_DMG_RF_SECTOR_INDEX]); 27510216a895SLior David if (sector_index >= WIL_MAX_RF_SECTORS) { 27520216a895SLior David wil_err(wil, "Invalid sector index %d\n", sector_index); 27530216a895SLior David return -EINVAL; 27540216a895SLior David } 27550216a895SLior David 27560216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 27570216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 27580216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 27590216a895SLior David return -EINVAL; 27600216a895SLior David } 27610216a895SLior David 27620216a895SLior David memset(&cmd, 0, sizeof(cmd)); 27630216a895SLior David 27640216a895SLior David cmd.sector_idx = cpu_to_le16(sector_index); 27650216a895SLior David cmd.sector_type = sector_type; 27660216a895SLior David nla_for_each_nested(nl_cfg, tb[QCA_ATTR_DMG_RF_SECTOR_CFG], 27670216a895SLior David tmp) { 27680216a895SLior David rc = nla_parse_nested(tb2, QCA_ATTR_DMG_RF_SECTOR_CFG_MAX, 27690216a895SLior David nl_cfg, wil_rf_sector_cfg_policy, 27700216a895SLior David NULL); 27710216a895SLior David if (rc) { 27720216a895SLior David wil_err(wil, "invalid sector cfg\n"); 27730216a895SLior David return -EINVAL; 27740216a895SLior David } 27750216a895SLior David 27760216a895SLior David if (!tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX] || 27770216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0] || 27780216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1] || 27790216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2] || 27800216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI] || 27810216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO] || 27820216a895SLior David !tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16]) { 27830216a895SLior David wil_err(wil, "missing cfg params\n"); 27840216a895SLior David return -EINVAL; 27850216a895SLior David } 27860216a895SLior David 27870216a895SLior David rf_module_index = nla_get_u8( 27880216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_MODULE_INDEX]); 27890216a895SLior David if (rf_module_index >= WMI_MAX_RF_MODULES_NUM) { 27900216a895SLior David wil_err(wil, "invalid RF module index %d\n", 27910216a895SLior David rf_module_index); 27920216a895SLior David return -EINVAL; 27930216a895SLior David } 27940216a895SLior David rf_modules_vec |= BIT(rf_module_index); 27950216a895SLior David si = &cmd.sectors_info[rf_module_index]; 27960216a895SLior David si->etype0 = cpu_to_le32(nla_get_u32( 27970216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE0])); 27980216a895SLior David si->etype1 = cpu_to_le32(nla_get_u32( 27990216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE1])); 28000216a895SLior David si->etype2 = cpu_to_le32(nla_get_u32( 28010216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_ETYPE2])); 28020216a895SLior David si->psh_hi = cpu_to_le32(nla_get_u32( 28030216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_HI])); 28040216a895SLior David si->psh_lo = cpu_to_le32(nla_get_u32( 28050216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_PSH_LO])); 28060216a895SLior David si->dtype_swch_off = cpu_to_le32(nla_get_u32( 28070216a895SLior David tb2[QCA_ATTR_DMG_RF_SECTOR_CFG_DTYPE_X16])); 28080216a895SLior David } 28090216a895SLior David 28100216a895SLior David cmd.rf_modules_vec = rf_modules_vec & 0xFF; 2811e00243faSLior David rc = wmi_call(wil, WMI_SET_RF_SECTOR_PARAMS_CMDID, vif->mid, 2812e00243faSLior David &cmd, sizeof(cmd), WMI_SET_RF_SECTOR_PARAMS_DONE_EVENTID, 28130216a895SLior David &reply, sizeof(reply), 28140216a895SLior David 500); 28150216a895SLior David if (rc) 28160216a895SLior David return rc; 28170216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 28180216a895SLior David } 28190216a895SLior David 28200216a895SLior David static int wil_rf_sector_get_selected(struct wiphy *wiphy, 28210216a895SLior David struct wireless_dev *wdev, 28220216a895SLior David const void *data, int data_len) 28230216a895SLior David { 28240216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2825e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 28260216a895SLior David int rc; 28270216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 28280216a895SLior David u8 sector_type, mac_addr[ETH_ALEN]; 28290216a895SLior David int cid = 0; 28300216a895SLior David struct wmi_get_selected_rf_sector_index_cmd cmd; 28310216a895SLior David struct { 28320216a895SLior David struct wmi_cmd_hdr wmi; 28330216a895SLior David struct wmi_get_selected_rf_sector_index_done_event evt; 2834807b0860SAlexei Avshalom Lazar } __packed reply = { 2835807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2836807b0860SAlexei Avshalom Lazar }; 28370216a895SLior David struct sk_buff *msg; 28380216a895SLior David 28390216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 28400216a895SLior David return -EOPNOTSUPP; 28410216a895SLior David 28420216a895SLior David rc = nla_parse(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, data_len, 28430216a895SLior David wil_rf_sector_policy, NULL); 28440216a895SLior David if (rc) { 28450216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 28460216a895SLior David return rc; 28470216a895SLior David } 28480216a895SLior David 28490216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]) { 28500216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 28510216a895SLior David return -EINVAL; 28520216a895SLior David } 28530216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 28540216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 28550216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 28560216a895SLior David return -EINVAL; 28570216a895SLior David } 28580216a895SLior David 28590216a895SLior David if (tb[QCA_ATTR_MAC_ADDR]) { 28600216a895SLior David ether_addr_copy(mac_addr, nla_data(tb[QCA_ATTR_MAC_ADDR])); 2861e00243faSLior David cid = wil_find_cid(wil, vif->mid, mac_addr); 28620216a895SLior David if (cid < 0) { 28630216a895SLior David wil_err(wil, "invalid MAC address %pM\n", mac_addr); 28640216a895SLior David return -ENOENT; 28650216a895SLior David } 28660216a895SLior David } else { 28675bd60982SLior David if (test_bit(wil_vif_fwconnected, vif->status)) { 28680216a895SLior David wil_err(wil, "must specify MAC address when connected\n"); 28690216a895SLior David return -EINVAL; 28700216a895SLior David } 28710216a895SLior David } 28720216a895SLior David 28730216a895SLior David memset(&cmd, 0, sizeof(cmd)); 28740216a895SLior David cmd.cid = (u8)cid; 28750216a895SLior David cmd.sector_type = sector_type; 2876e00243faSLior David rc = wmi_call(wil, WMI_GET_SELECTED_RF_SECTOR_INDEX_CMDID, vif->mid, 28770216a895SLior David &cmd, sizeof(cmd), 28780216a895SLior David WMI_GET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID, 28790216a895SLior David &reply, sizeof(reply), 28800216a895SLior David 500); 28810216a895SLior David if (rc) 28820216a895SLior David return rc; 28830216a895SLior David if (reply.evt.status) { 28840216a895SLior David wil_err(wil, "get rf selected sector cfg failed with status %d\n", 28850216a895SLior David reply.evt.status); 28860216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 28870216a895SLior David } 28880216a895SLior David 28890216a895SLior David msg = cfg80211_vendor_cmd_alloc_reply_skb( 28900216a895SLior David wiphy, 64 * WMI_MAX_RF_MODULES_NUM); 28910216a895SLior David if (!msg) 28920216a895SLior David return -ENOMEM; 28930216a895SLior David 28940216a895SLior David if (nla_put_u64_64bit(msg, QCA_ATTR_TSF, 28950216a895SLior David le64_to_cpu(reply.evt.tsf), 28960216a895SLior David QCA_ATTR_PAD) || 28970216a895SLior David nla_put_u16(msg, QCA_ATTR_DMG_RF_SECTOR_INDEX, 28980216a895SLior David le16_to_cpu(reply.evt.sector_idx))) 28990216a895SLior David goto nla_put_failure; 29000216a895SLior David 29010216a895SLior David rc = cfg80211_vendor_cmd_reply(msg); 29020216a895SLior David return rc; 29030216a895SLior David nla_put_failure: 29040216a895SLior David kfree_skb(msg); 29050216a895SLior David return -ENOBUFS; 29060216a895SLior David } 29070216a895SLior David 29080216a895SLior David static int wil_rf_sector_wmi_set_selected(struct wil6210_priv *wil, 2909e00243faSLior David u8 mid, u16 sector_index, 29100216a895SLior David u8 sector_type, u8 cid) 29110216a895SLior David { 29120216a895SLior David struct wmi_set_selected_rf_sector_index_cmd cmd; 29130216a895SLior David struct { 29140216a895SLior David struct wmi_cmd_hdr wmi; 29150216a895SLior David struct wmi_set_selected_rf_sector_index_done_event evt; 2916807b0860SAlexei Avshalom Lazar } __packed reply = { 2917807b0860SAlexei Avshalom Lazar .evt = {.status = WMI_RF_SECTOR_STATUS_NOT_SUPPORTED_ERROR}, 2918807b0860SAlexei Avshalom Lazar }; 29190216a895SLior David int rc; 29200216a895SLior David 29210216a895SLior David memset(&cmd, 0, sizeof(cmd)); 29220216a895SLior David cmd.sector_idx = cpu_to_le16(sector_index); 29230216a895SLior David cmd.sector_type = sector_type; 29240216a895SLior David cmd.cid = (u8)cid; 2925e00243faSLior David rc = wmi_call(wil, WMI_SET_SELECTED_RF_SECTOR_INDEX_CMDID, mid, 29260216a895SLior David &cmd, sizeof(cmd), 29270216a895SLior David WMI_SET_SELECTED_RF_SECTOR_INDEX_DONE_EVENTID, 29280216a895SLior David &reply, sizeof(reply), 29290216a895SLior David 500); 29300216a895SLior David if (rc) 29310216a895SLior David return rc; 29320216a895SLior David return wil_rf_sector_status_to_rc(reply.evt.status); 29330216a895SLior David } 29340216a895SLior David 29350216a895SLior David static int wil_rf_sector_set_selected(struct wiphy *wiphy, 29360216a895SLior David struct wireless_dev *wdev, 29370216a895SLior David const void *data, int data_len) 29380216a895SLior David { 29390216a895SLior David struct wil6210_priv *wil = wdev_to_wil(wdev); 2940e00243faSLior David struct wil6210_vif *vif = wdev_to_vif(wil, wdev); 29410216a895SLior David int rc; 29420216a895SLior David struct nlattr *tb[QCA_ATTR_DMG_RF_SECTOR_MAX + 1]; 29430216a895SLior David u16 sector_index; 29440216a895SLior David u8 sector_type, mac_addr[ETH_ALEN], i; 29450216a895SLior David int cid = 0; 29460216a895SLior David 29470216a895SLior David if (!test_bit(WMI_FW_CAPABILITY_RF_SECTORS, wil->fw_capabilities)) 29480216a895SLior David return -EOPNOTSUPP; 29490216a895SLior David 29500216a895SLior David rc = nla_parse(tb, QCA_ATTR_DMG_RF_SECTOR_MAX, data, data_len, 29510216a895SLior David wil_rf_sector_policy, NULL); 29520216a895SLior David if (rc) { 29530216a895SLior David wil_err(wil, "Invalid rf sector ATTR\n"); 29540216a895SLior David return rc; 29550216a895SLior David } 29560216a895SLior David 29570216a895SLior David if (!tb[QCA_ATTR_DMG_RF_SECTOR_INDEX] || 29580216a895SLior David !tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]) { 29590216a895SLior David wil_err(wil, "Invalid rf sector spec\n"); 29600216a895SLior David return -EINVAL; 29610216a895SLior David } 29620216a895SLior David 29630216a895SLior David sector_index = nla_get_u16( 29640216a895SLior David tb[QCA_ATTR_DMG_RF_SECTOR_INDEX]); 29650216a895SLior David if (sector_index >= WIL_MAX_RF_SECTORS && 29660216a895SLior David sector_index != WMI_INVALID_RF_SECTOR_INDEX) { 29670216a895SLior David wil_err(wil, "Invalid sector index %d\n", sector_index); 29680216a895SLior David return -EINVAL; 29690216a895SLior David } 29700216a895SLior David 29710216a895SLior David sector_type = nla_get_u8(tb[QCA_ATTR_DMG_RF_SECTOR_TYPE]); 29720216a895SLior David if (sector_type >= QCA_ATTR_DMG_RF_SECTOR_TYPE_MAX) { 29730216a895SLior David wil_err(wil, "Invalid sector type %d\n", sector_type); 29740216a895SLior David return -EINVAL; 29750216a895SLior David } 29760216a895SLior David 29770216a895SLior David if (tb[QCA_ATTR_MAC_ADDR]) { 29780216a895SLior David ether_addr_copy(mac_addr, nla_data(tb[QCA_ATTR_MAC_ADDR])); 29790216a895SLior David if (!is_broadcast_ether_addr(mac_addr)) { 2980e00243faSLior David cid = wil_find_cid(wil, vif->mid, mac_addr); 29810216a895SLior David if (cid < 0) { 29820216a895SLior David wil_err(wil, "invalid MAC address %pM\n", 29830216a895SLior David mac_addr); 29840216a895SLior David return -ENOENT; 29850216a895SLior David } 29860216a895SLior David } else { 29870216a895SLior David if (sector_index != WMI_INVALID_RF_SECTOR_INDEX) { 29880216a895SLior David wil_err(wil, "broadcast MAC valid only with unlocking\n"); 29890216a895SLior David return -EINVAL; 29900216a895SLior David } 29910216a895SLior David cid = -1; 29920216a895SLior David } 29930216a895SLior David } else { 29945bd60982SLior David if (test_bit(wil_vif_fwconnected, vif->status)) { 29950216a895SLior David wil_err(wil, "must specify MAC address when connected\n"); 29960216a895SLior David return -EINVAL; 29970216a895SLior David } 29980216a895SLior David /* otherwise, using cid=0 for unassociated station */ 29990216a895SLior David } 30000216a895SLior David 30010216a895SLior David if (cid >= 0) { 3002e00243faSLior David rc = wil_rf_sector_wmi_set_selected(wil, vif->mid, sector_index, 30030216a895SLior David sector_type, cid); 30040216a895SLior David } else { 30050216a895SLior David /* unlock all cids */ 30060216a895SLior David rc = wil_rf_sector_wmi_set_selected( 3007e00243faSLior David wil, vif->mid, WMI_INVALID_RF_SECTOR_INDEX, 3008e00243faSLior David sector_type, WIL_CID_ALL); 30090216a895SLior David if (rc == -EINVAL) { 30100216a895SLior David for (i = 0; i < WIL6210_MAX_CID; i++) { 3011e00243faSLior David if (wil->sta[i].mid != vif->mid) 3012e00243faSLior David continue; 30130216a895SLior David rc = wil_rf_sector_wmi_set_selected( 3014e00243faSLior David wil, vif->mid, 3015e00243faSLior David WMI_INVALID_RF_SECTOR_INDEX, 30160216a895SLior David sector_type, i); 30170216a895SLior David /* the FW will silently ignore and return 30180216a895SLior David * success for unused cid, so abort the loop 30190216a895SLior David * on any other error 30200216a895SLior David */ 30210216a895SLior David if (rc) { 30220216a895SLior David wil_err(wil, "unlock cid %d failed with status %d\n", 30230216a895SLior David i, rc); 30240216a895SLior David break; 30250216a895SLior David } 30260216a895SLior David } 30270216a895SLior David } 30280216a895SLior David } 30290216a895SLior David 30300216a895SLior David return rc; 30310216a895SLior David } 3032