18e84c258SEugene Krasnikov /* 28e84c258SEugene Krasnikov * Copyright (c) 2013 Eugene Krasnikov <k.eugene.e@gmail.com> 38e84c258SEugene Krasnikov * 48e84c258SEugene Krasnikov * Permission to use, copy, modify, and/or distribute this software for any 58e84c258SEugene Krasnikov * purpose with or without fee is hereby granted, provided that the above 68e84c258SEugene Krasnikov * copyright notice and this permission notice appear in all copies. 78e84c258SEugene Krasnikov * 88e84c258SEugene Krasnikov * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 98e84c258SEugene Krasnikov * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 108e84c258SEugene Krasnikov * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY 118e84c258SEugene Krasnikov * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 128e84c258SEugene Krasnikov * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION 138e84c258SEugene Krasnikov * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN 148e84c258SEugene Krasnikov * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 158e84c258SEugene Krasnikov */ 168e84c258SEugene Krasnikov 178e84c258SEugene Krasnikov #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 188e84c258SEugene Krasnikov 198e84c258SEugene Krasnikov #include <linux/module.h> 204bda7fafSPontus Fuchs #include <linux/firmware.h> 218e84c258SEugene Krasnikov #include <linux/platform_device.h> 2205ddce49SBjorn Andersson #include <linux/of_address.h> 2305ddce49SBjorn Andersson #include <linux/of_device.h> 24f303a931SBjorn Andersson #include <linux/of_irq.h> 255052de8dSBjorn Andersson #include <linux/rpmsg.h> 26f303a931SBjorn Andersson #include <linux/soc/qcom/smem_state.h> 27f303a931SBjorn Andersson #include <linux/soc/qcom/wcnss_ctrl.h> 28c7a61af5SBryan O'Donoghue #include <net/ipv6.h> 298e84c258SEugene Krasnikov #include "wcn36xx.h" 3087f825e6SEyal Ilsar #include "testmode.h" 318e84c258SEugene Krasnikov 328e84c258SEugene Krasnikov unsigned int wcn36xx_dbg_mask; 338e84c258SEugene Krasnikov module_param_named(debug_mask, wcn36xx_dbg_mask, uint, 0644); 348e84c258SEugene Krasnikov MODULE_PARM_DESC(debug_mask, "Debugging mask"); 358e84c258SEugene Krasnikov 368e84c258SEugene Krasnikov #define CHAN2G(_freq, _idx) { \ 3757fbcce3SJohannes Berg .band = NL80211_BAND_2GHZ, \ 388e84c258SEugene Krasnikov .center_freq = (_freq), \ 398e84c258SEugene Krasnikov .hw_value = (_idx), \ 408e84c258SEugene Krasnikov .max_power = 25, \ 418e84c258SEugene Krasnikov } 428e84c258SEugene Krasnikov 43fc4d4008SBryan O'Donoghue #define CHAN5G(_freq, _idx, _phy_val) { \ 4457fbcce3SJohannes Berg .band = NL80211_BAND_5GHZ, \ 458e84c258SEugene Krasnikov .center_freq = (_freq), \ 46fc4d4008SBryan O'Donoghue .hw_value = (_phy_val) << HW_VALUE_PHY_SHIFT | HW_VALUE_CHANNEL(_idx), \ 478e84c258SEugene Krasnikov .max_power = 25, \ 488e84c258SEugene Krasnikov } 498e84c258SEugene Krasnikov 508e84c258SEugene Krasnikov /* The wcn firmware expects channel values to matching 518e84c258SEugene Krasnikov * their mnemonic values. So use these for .hw_value. */ 528e84c258SEugene Krasnikov static struct ieee80211_channel wcn_2ghz_channels[] = { 538e84c258SEugene Krasnikov CHAN2G(2412, 1), /* Channel 1 */ 548e84c258SEugene Krasnikov CHAN2G(2417, 2), /* Channel 2 */ 558e84c258SEugene Krasnikov CHAN2G(2422, 3), /* Channel 3 */ 568e84c258SEugene Krasnikov CHAN2G(2427, 4), /* Channel 4 */ 578e84c258SEugene Krasnikov CHAN2G(2432, 5), /* Channel 5 */ 588e84c258SEugene Krasnikov CHAN2G(2437, 6), /* Channel 6 */ 598e84c258SEugene Krasnikov CHAN2G(2442, 7), /* Channel 7 */ 608e84c258SEugene Krasnikov CHAN2G(2447, 8), /* Channel 8 */ 618e84c258SEugene Krasnikov CHAN2G(2452, 9), /* Channel 9 */ 628e84c258SEugene Krasnikov CHAN2G(2457, 10), /* Channel 10 */ 638e84c258SEugene Krasnikov CHAN2G(2462, 11), /* Channel 11 */ 648e84c258SEugene Krasnikov CHAN2G(2467, 12), /* Channel 12 */ 658e84c258SEugene Krasnikov CHAN2G(2472, 13), /* Channel 13 */ 668e84c258SEugene Krasnikov CHAN2G(2484, 14) /* Channel 14 */ 678e84c258SEugene Krasnikov 688e84c258SEugene Krasnikov }; 698e84c258SEugene Krasnikov 708e84c258SEugene Krasnikov static struct ieee80211_channel wcn_5ghz_channels[] = { 71fc4d4008SBryan O'Donoghue CHAN5G(5180, 36, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_LOW), 72fc4d4008SBryan O'Donoghue CHAN5G(5200, 40, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_LOW), 73fc4d4008SBryan O'Donoghue CHAN5G(5220, 44, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_HIGH), 74fc4d4008SBryan O'Donoghue CHAN5G(5240, 48, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_HIGH), 75fc4d4008SBryan O'Donoghue CHAN5G(5260, 52, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_LOW), 76fc4d4008SBryan O'Donoghue CHAN5G(5280, 56, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_LOW), 77fc4d4008SBryan O'Donoghue CHAN5G(5300, 60, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_HIGH), 78fc4d4008SBryan O'Donoghue CHAN5G(5320, 64, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_HIGH), 79fc4d4008SBryan O'Donoghue CHAN5G(5500, 100, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_LOW), 80fc4d4008SBryan O'Donoghue CHAN5G(5520, 104, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_LOW), 81fc4d4008SBryan O'Donoghue CHAN5G(5540, 108, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_HIGH), 82fc4d4008SBryan O'Donoghue CHAN5G(5560, 112, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_HIGH), 83fc4d4008SBryan O'Donoghue CHAN5G(5580, 116, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_LOW), 84fc4d4008SBryan O'Donoghue CHAN5G(5600, 120, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_LOW), 85fc4d4008SBryan O'Donoghue CHAN5G(5620, 124, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_HIGH), 86fc4d4008SBryan O'Donoghue CHAN5G(5640, 128, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_HIGH), 87fc4d4008SBryan O'Donoghue CHAN5G(5660, 132, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_LOW), 88c9a4f2ddSBenjamin Li CHAN5G(5680, 136, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_LOW), 89fc4d4008SBryan O'Donoghue CHAN5G(5700, 140, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_HIGH), 90c9a4f2ddSBenjamin Li CHAN5G(5720, 144, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_HIGH), 91fc4d4008SBryan O'Donoghue CHAN5G(5745, 149, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_LOW), 92fc4d4008SBryan O'Donoghue CHAN5G(5765, 153, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_LOW), 93fc4d4008SBryan O'Donoghue CHAN5G(5785, 157, PHY_QUADRUPLE_CHANNEL_20MHZ_LOW_40MHZ_HIGH), 94fc4d4008SBryan O'Donoghue CHAN5G(5805, 161, PHY_QUADRUPLE_CHANNEL_20MHZ_HIGH_40MHZ_HIGH), 95fc4d4008SBryan O'Donoghue CHAN5G(5825, 165, 0) 968e84c258SEugene Krasnikov }; 978e84c258SEugene Krasnikov 988e84c258SEugene Krasnikov #define RATE(_bitrate, _hw_rate, _flags) { \ 998e84c258SEugene Krasnikov .bitrate = (_bitrate), \ 1008e84c258SEugene Krasnikov .flags = (_flags), \ 1018e84c258SEugene Krasnikov .hw_value = (_hw_rate), \ 1028e84c258SEugene Krasnikov .hw_value_short = (_hw_rate) \ 1038e84c258SEugene Krasnikov } 1048e84c258SEugene Krasnikov 1058e84c258SEugene Krasnikov static struct ieee80211_rate wcn_2ghz_rates[] = { 1068e84c258SEugene Krasnikov RATE(10, HW_RATE_INDEX_1MBPS, 0), 1078e84c258SEugene Krasnikov RATE(20, HW_RATE_INDEX_2MBPS, IEEE80211_RATE_SHORT_PREAMBLE), 1088e84c258SEugene Krasnikov RATE(55, HW_RATE_INDEX_5_5MBPS, IEEE80211_RATE_SHORT_PREAMBLE), 1098e84c258SEugene Krasnikov RATE(110, HW_RATE_INDEX_11MBPS, IEEE80211_RATE_SHORT_PREAMBLE), 1108e84c258SEugene Krasnikov RATE(60, HW_RATE_INDEX_6MBPS, 0), 1118e84c258SEugene Krasnikov RATE(90, HW_RATE_INDEX_9MBPS, 0), 1128e84c258SEugene Krasnikov RATE(120, HW_RATE_INDEX_12MBPS, 0), 1138e84c258SEugene Krasnikov RATE(180, HW_RATE_INDEX_18MBPS, 0), 1148e84c258SEugene Krasnikov RATE(240, HW_RATE_INDEX_24MBPS, 0), 1158e84c258SEugene Krasnikov RATE(360, HW_RATE_INDEX_36MBPS, 0), 1168e84c258SEugene Krasnikov RATE(480, HW_RATE_INDEX_48MBPS, 0), 1178e84c258SEugene Krasnikov RATE(540, HW_RATE_INDEX_54MBPS, 0) 1188e84c258SEugene Krasnikov }; 1198e84c258SEugene Krasnikov 1208e84c258SEugene Krasnikov static struct ieee80211_rate wcn_5ghz_rates[] = { 1218e84c258SEugene Krasnikov RATE(60, HW_RATE_INDEX_6MBPS, 0), 1228e84c258SEugene Krasnikov RATE(90, HW_RATE_INDEX_9MBPS, 0), 1238e84c258SEugene Krasnikov RATE(120, HW_RATE_INDEX_12MBPS, 0), 1248e84c258SEugene Krasnikov RATE(180, HW_RATE_INDEX_18MBPS, 0), 1258e84c258SEugene Krasnikov RATE(240, HW_RATE_INDEX_24MBPS, 0), 1268e84c258SEugene Krasnikov RATE(360, HW_RATE_INDEX_36MBPS, 0), 1278e84c258SEugene Krasnikov RATE(480, HW_RATE_INDEX_48MBPS, 0), 1288e84c258SEugene Krasnikov RATE(540, HW_RATE_INDEX_54MBPS, 0) 1298e84c258SEugene Krasnikov }; 1308e84c258SEugene Krasnikov 1318e84c258SEugene Krasnikov static struct ieee80211_supported_band wcn_band_2ghz = { 1328e84c258SEugene Krasnikov .channels = wcn_2ghz_channels, 1338e84c258SEugene Krasnikov .n_channels = ARRAY_SIZE(wcn_2ghz_channels), 1348e84c258SEugene Krasnikov .bitrates = wcn_2ghz_rates, 1358e84c258SEugene Krasnikov .n_bitrates = ARRAY_SIZE(wcn_2ghz_rates), 1368e84c258SEugene Krasnikov .ht_cap = { 1378e84c258SEugene Krasnikov .cap = IEEE80211_HT_CAP_GRN_FLD | 1388e84c258SEugene Krasnikov IEEE80211_HT_CAP_SGI_20 | 1398e84c258SEugene Krasnikov IEEE80211_HT_CAP_DSSSCCK40 | 140960ae77fSLoic Poulain IEEE80211_HT_CAP_LSIG_TXOP_PROT | 141960ae77fSLoic Poulain IEEE80211_HT_CAP_SGI_40 | 142960ae77fSLoic Poulain IEEE80211_HT_CAP_SUP_WIDTH_20_40, 1438e84c258SEugene Krasnikov .ht_supported = true, 1448e84c258SEugene Krasnikov .ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K, 1458e84c258SEugene Krasnikov .ampdu_density = IEEE80211_HT_MPDU_DENSITY_16, 1468e84c258SEugene Krasnikov .mcs = { 1478e84c258SEugene Krasnikov .rx_mask = { 0xff, 0, 0, 0, 0, 0, 0, 0, 0, 0, }, 1488e84c258SEugene Krasnikov .rx_highest = cpu_to_le16(72), 1498e84c258SEugene Krasnikov .tx_params = IEEE80211_HT_MCS_TX_DEFINED, 1508e84c258SEugene Krasnikov } 1518e84c258SEugene Krasnikov } 1528e84c258SEugene Krasnikov }; 1538e84c258SEugene Krasnikov 1548e84c258SEugene Krasnikov static struct ieee80211_supported_band wcn_band_5ghz = { 1558e84c258SEugene Krasnikov .channels = wcn_5ghz_channels, 1568e84c258SEugene Krasnikov .n_channels = ARRAY_SIZE(wcn_5ghz_channels), 1578e84c258SEugene Krasnikov .bitrates = wcn_5ghz_rates, 1588e84c258SEugene Krasnikov .n_bitrates = ARRAY_SIZE(wcn_5ghz_rates), 1598e84c258SEugene Krasnikov .ht_cap = { 1608e84c258SEugene Krasnikov .cap = IEEE80211_HT_CAP_GRN_FLD | 1618e84c258SEugene Krasnikov IEEE80211_HT_CAP_SGI_20 | 1628e84c258SEugene Krasnikov IEEE80211_HT_CAP_DSSSCCK40 | 1638e84c258SEugene Krasnikov IEEE80211_HT_CAP_LSIG_TXOP_PROT | 1648e84c258SEugene Krasnikov IEEE80211_HT_CAP_SGI_40 | 1658e84c258SEugene Krasnikov IEEE80211_HT_CAP_SUP_WIDTH_20_40, 1668e84c258SEugene Krasnikov .ht_supported = true, 1678e84c258SEugene Krasnikov .ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K, 1688e84c258SEugene Krasnikov .ampdu_density = IEEE80211_HT_MPDU_DENSITY_16, 1698e84c258SEugene Krasnikov .mcs = { 1708e84c258SEugene Krasnikov .rx_mask = { 0xff, 0, 0, 0, 0, 0, 0, 0, 0, 0, }, 1713b9fb679SBryan O'Donoghue .rx_highest = cpu_to_le16(150), 1728e84c258SEugene Krasnikov .tx_params = IEEE80211_HT_MCS_TX_DEFINED, 1738e84c258SEugene Krasnikov } 1748e84c258SEugene Krasnikov } 1758e84c258SEugene Krasnikov }; 1768e84c258SEugene Krasnikov 1778e84c258SEugene Krasnikov #ifdef CONFIG_PM 1788e84c258SEugene Krasnikov 1798e84c258SEugene Krasnikov static const struct wiphy_wowlan_support wowlan_support = { 1801e2e8ee9SBryan O'Donoghue .flags = WIPHY_WOWLAN_ANY | 1811e2e8ee9SBryan O'Donoghue WIPHY_WOWLAN_MAGIC_PKT | 1821e2e8ee9SBryan O'Donoghue WIPHY_WOWLAN_SUPPORTS_GTK_REKEY 1838e84c258SEugene Krasnikov }; 1848e84c258SEugene Krasnikov 1858e84c258SEugene Krasnikov #endif 1868e84c258SEugene Krasnikov 1878e84c258SEugene Krasnikov static inline u8 get_sta_index(struct ieee80211_vif *vif, 1888e84c258SEugene Krasnikov struct wcn36xx_sta *sta_priv) 1898e84c258SEugene Krasnikov { 1908e84c258SEugene Krasnikov return NL80211_IFTYPE_STATION == vif->type ? 1918e84c258SEugene Krasnikov sta_priv->bss_sta_index : 1928e84c258SEugene Krasnikov sta_priv->sta_index; 1938e84c258SEugene Krasnikov } 1948e84c258SEugene Krasnikov 1952be6636aSPontus Fuchs static const char * const wcn36xx_caps_names[] = { 1962be6636aSPontus Fuchs "MCC", /* 0 */ 1972be6636aSPontus Fuchs "P2P", /* 1 */ 1982be6636aSPontus Fuchs "DOT11AC", /* 2 */ 1992be6636aSPontus Fuchs "SLM_SESSIONIZATION", /* 3 */ 2002be6636aSPontus Fuchs "DOT11AC_OPMODE", /* 4 */ 2012be6636aSPontus Fuchs "SAP32STA", /* 5 */ 2022be6636aSPontus Fuchs "TDLS", /* 6 */ 2032be6636aSPontus Fuchs "P2P_GO_NOA_DECOUPLE_INIT_SCAN",/* 7 */ 2042be6636aSPontus Fuchs "WLANACTIVE_OFFLOAD", /* 8 */ 2052be6636aSPontus Fuchs "BEACON_OFFLOAD", /* 9 */ 2062be6636aSPontus Fuchs "SCAN_OFFLOAD", /* 10 */ 2072be6636aSPontus Fuchs "ROAM_OFFLOAD", /* 11 */ 2082be6636aSPontus Fuchs "BCN_MISS_OFFLOAD", /* 12 */ 2092be6636aSPontus Fuchs "STA_POWERSAVE", /* 13 */ 2102be6636aSPontus Fuchs "STA_ADVANCED_PWRSAVE", /* 14 */ 2112be6636aSPontus Fuchs "AP_UAPSD", /* 15 */ 2122be6636aSPontus Fuchs "AP_DFS", /* 16 */ 2132be6636aSPontus Fuchs "BLOCKACK", /* 17 */ 2142be6636aSPontus Fuchs "PHY_ERR", /* 18 */ 2152be6636aSPontus Fuchs "BCN_FILTER", /* 19 */ 2162be6636aSPontus Fuchs "RTT", /* 20 */ 2172be6636aSPontus Fuchs "RATECTRL", /* 21 */ 218ffc03c33SBjorn Andersson "WOW", /* 22 */ 219ffc03c33SBjorn Andersson "WLAN_ROAM_SCAN_OFFLOAD", /* 23 */ 220ffc03c33SBjorn Andersson "SPECULATIVE_PS_POLL", /* 24 */ 221ffc03c33SBjorn Andersson "SCAN_SCH", /* 25 */ 222ffc03c33SBjorn Andersson "IBSS_HEARTBEAT_OFFLOAD", /* 26 */ 223ffc03c33SBjorn Andersson "WLAN_SCAN_OFFLOAD", /* 27 */ 224ffc03c33SBjorn Andersson "WLAN_PERIODIC_TX_PTRN", /* 28 */ 225ffc03c33SBjorn Andersson "ADVANCE_TDLS", /* 29 */ 226ffc03c33SBjorn Andersson "BATCH_SCAN", /* 30 */ 227ffc03c33SBjorn Andersson "FW_IN_TX_PATH", /* 31 */ 228ffc03c33SBjorn Andersson "EXTENDED_NSOFFLOAD_SLOT", /* 32 */ 229ffc03c33SBjorn Andersson "CH_SWITCH_V1", /* 33 */ 230ffc03c33SBjorn Andersson "HT40_OBSS_SCAN", /* 34 */ 231ffc03c33SBjorn Andersson "UPDATE_CHANNEL_LIST", /* 35 */ 232ffc03c33SBjorn Andersson "WLAN_MCADDR_FLT", /* 36 */ 233ffc03c33SBjorn Andersson "WLAN_CH144", /* 37 */ 234ffc03c33SBjorn Andersson "NAN", /* 38 */ 235ffc03c33SBjorn Andersson "TDLS_SCAN_COEXISTENCE", /* 39 */ 236ffc03c33SBjorn Andersson "LINK_LAYER_STATS_MEAS", /* 40 */ 237ffc03c33SBjorn Andersson "MU_MIMO", /* 41 */ 238ffc03c33SBjorn Andersson "EXTENDED_SCAN", /* 42 */ 239ffc03c33SBjorn Andersson "DYNAMIC_WMM_PS", /* 43 */ 240ffc03c33SBjorn Andersson "MAC_SPOOFED_SCAN", /* 44 */ 241ffc03c33SBjorn Andersson "BMU_ERROR_GENERIC_RECOVERY", /* 45 */ 242ffc03c33SBjorn Andersson "DISA", /* 46 */ 243ffc03c33SBjorn Andersson "FW_STATS", /* 47 */ 244ffc03c33SBjorn Andersson "WPS_PRBRSP_TMPL", /* 48 */ 245ffc03c33SBjorn Andersson "BCN_IE_FLT_DELTA", /* 49 */ 246ffc03c33SBjorn Andersson "TDLS_OFF_CHANNEL", /* 51 */ 247ffc03c33SBjorn Andersson "RTT3", /* 52 */ 248ffc03c33SBjorn Andersson "MGMT_FRAME_LOGGING", /* 53 */ 249ffc03c33SBjorn Andersson "ENHANCED_TXBD_COMPLETION", /* 54 */ 250ffc03c33SBjorn Andersson "LOGGING_ENHANCEMENT", /* 55 */ 251ffc03c33SBjorn Andersson "EXT_SCAN_ENHANCED", /* 56 */ 252ffc03c33SBjorn Andersson "MEMORY_DUMP_SUPPORTED", /* 57 */ 253ffc03c33SBjorn Andersson "PER_PKT_STATS_SUPPORTED", /* 58 */ 254ffc03c33SBjorn Andersson "EXT_LL_STAT", /* 60 */ 255ffc03c33SBjorn Andersson "WIFI_CONFIG", /* 61 */ 256ffc03c33SBjorn Andersson "ANTENNA_DIVERSITY_SELECTION", /* 62 */ 2572be6636aSPontus Fuchs }; 2582be6636aSPontus Fuchs 2592be6636aSPontus Fuchs static const char *wcn36xx_get_cap_name(enum place_holder_in_cap_bitmap x) 2602be6636aSPontus Fuchs { 2612be6636aSPontus Fuchs if (x >= ARRAY_SIZE(wcn36xx_caps_names)) 2622be6636aSPontus Fuchs return "UNKNOWN"; 2632be6636aSPontus Fuchs return wcn36xx_caps_names[x]; 2642be6636aSPontus Fuchs } 2652be6636aSPontus Fuchs 2662be6636aSPontus Fuchs static void wcn36xx_feat_caps_info(struct wcn36xx *wcn) 2672be6636aSPontus Fuchs { 2682be6636aSPontus Fuchs int i; 2692be6636aSPontus Fuchs 2702be6636aSPontus Fuchs for (i = 0; i < MAX_FEATURE_SUPPORTED; i++) { 2712be6636aSPontus Fuchs if (get_feat_caps(wcn->fw_feat_caps, i)) 2726b8a127bSRamon Fried wcn36xx_dbg(WCN36XX_DBG_MAC, "FW Cap %s\n", wcn36xx_get_cap_name(i)); 2732be6636aSPontus Fuchs } 2742be6636aSPontus Fuchs } 2752be6636aSPontus Fuchs 2768e84c258SEugene Krasnikov static int wcn36xx_start(struct ieee80211_hw *hw) 2778e84c258SEugene Krasnikov { 2788e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 2798e84c258SEugene Krasnikov int ret; 2808e84c258SEugene Krasnikov 2818e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac start\n"); 2828e84c258SEugene Krasnikov 2838e84c258SEugene Krasnikov /* SMD initialization */ 2848e84c258SEugene Krasnikov ret = wcn36xx_smd_open(wcn); 2858e84c258SEugene Krasnikov if (ret) { 2868e84c258SEugene Krasnikov wcn36xx_err("Failed to open smd channel: %d\n", ret); 2878e84c258SEugene Krasnikov goto out_err; 2888e84c258SEugene Krasnikov } 2898e84c258SEugene Krasnikov 2908e84c258SEugene Krasnikov /* Allocate memory pools for Mgmt BD headers and Data BD headers */ 2918e84c258SEugene Krasnikov ret = wcn36xx_dxe_allocate_mem_pools(wcn); 2928e84c258SEugene Krasnikov if (ret) { 2938e84c258SEugene Krasnikov wcn36xx_err("Failed to alloc DXE mempool: %d\n", ret); 2948e84c258SEugene Krasnikov goto out_smd_close; 2958e84c258SEugene Krasnikov } 2968e84c258SEugene Krasnikov 2978e84c258SEugene Krasnikov ret = wcn36xx_dxe_alloc_ctl_blks(wcn); 2988e84c258SEugene Krasnikov if (ret) { 2998e84c258SEugene Krasnikov wcn36xx_err("Failed to alloc DXE ctl blocks: %d\n", ret); 3008e84c258SEugene Krasnikov goto out_free_dxe_pool; 3018e84c258SEugene Krasnikov } 3028e84c258SEugene Krasnikov 3038e84c258SEugene Krasnikov ret = wcn36xx_smd_load_nv(wcn); 3048e84c258SEugene Krasnikov if (ret) { 3058e84c258SEugene Krasnikov wcn36xx_err("Failed to push NV to chip\n"); 306ef486675SBryan O'Donoghue goto out_free_dxe_ctl; 3078e84c258SEugene Krasnikov } 3088e84c258SEugene Krasnikov 3098e84c258SEugene Krasnikov ret = wcn36xx_smd_start(wcn); 3108e84c258SEugene Krasnikov if (ret) { 3118e84c258SEugene Krasnikov wcn36xx_err("Failed to start chip\n"); 312ef486675SBryan O'Donoghue goto out_free_dxe_ctl; 3138e84c258SEugene Krasnikov } 3148e84c258SEugene Krasnikov 315f2ed5d24SPontus Fuchs if (!wcn36xx_is_fw_version(wcn, 1, 2, 2, 24)) { 316f2ed5d24SPontus Fuchs ret = wcn36xx_smd_feature_caps_exchange(wcn); 317f2ed5d24SPontus Fuchs if (ret) 318f2ed5d24SPontus Fuchs wcn36xx_warn("Exchange feature caps failed\n"); 319f2ed5d24SPontus Fuchs else 320f2ed5d24SPontus Fuchs wcn36xx_feat_caps_info(wcn); 321f2ed5d24SPontus Fuchs } 322f2ed5d24SPontus Fuchs 3238e84c258SEugene Krasnikov /* DMA channel initialization */ 3248e84c258SEugene Krasnikov ret = wcn36xx_dxe_init(wcn); 3258e84c258SEugene Krasnikov if (ret) { 3268e84c258SEugene Krasnikov wcn36xx_err("DXE init failed\n"); 3278e84c258SEugene Krasnikov goto out_smd_stop; 3288e84c258SEugene Krasnikov } 3298e84c258SEugene Krasnikov 3308e84c258SEugene Krasnikov wcn36xx_debugfs_init(wcn); 3318e84c258SEugene Krasnikov 3328e84c258SEugene Krasnikov INIT_LIST_HEAD(&wcn->vif_list); 3334b12462aSBob Copeland spin_lock_init(&wcn->dxe_lock); 3344b12462aSBob Copeland 3358e84c258SEugene Krasnikov return 0; 3368e84c258SEugene Krasnikov 3378e84c258SEugene Krasnikov out_smd_stop: 3388e84c258SEugene Krasnikov wcn36xx_smd_stop(wcn); 3398e84c258SEugene Krasnikov out_free_dxe_ctl: 3408e84c258SEugene Krasnikov wcn36xx_dxe_free_ctl_blks(wcn); 3414aa2d31fSChristophe Jaillet out_free_dxe_pool: 3424aa2d31fSChristophe Jaillet wcn36xx_dxe_free_mem_pools(wcn); 3438e84c258SEugene Krasnikov out_smd_close: 3448e84c258SEugene Krasnikov wcn36xx_smd_close(wcn); 3458e84c258SEugene Krasnikov out_err: 3468e84c258SEugene Krasnikov return ret; 3478e84c258SEugene Krasnikov } 3488e84c258SEugene Krasnikov 3498e84c258SEugene Krasnikov static void wcn36xx_stop(struct ieee80211_hw *hw) 3508e84c258SEugene Krasnikov { 3518e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 3528e84c258SEugene Krasnikov 3538e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac stop\n"); 3548e84c258SEugene Krasnikov 35580c764d3SDaniel Mack mutex_lock(&wcn->scan_lock); 35680c764d3SDaniel Mack if (wcn->scan_req) { 35780c764d3SDaniel Mack struct cfg80211_scan_info scan_info = { 35880c764d3SDaniel Mack .aborted = true, 35980c764d3SDaniel Mack }; 36080c764d3SDaniel Mack 36180c764d3SDaniel Mack ieee80211_scan_completed(wcn->hw, &scan_info); 36280c764d3SDaniel Mack } 36380c764d3SDaniel Mack wcn->scan_req = NULL; 36480c764d3SDaniel Mack mutex_unlock(&wcn->scan_lock); 36580c764d3SDaniel Mack 3668e84c258SEugene Krasnikov wcn36xx_debugfs_exit(wcn); 3678e84c258SEugene Krasnikov wcn36xx_smd_stop(wcn); 3688e84c258SEugene Krasnikov wcn36xx_dxe_deinit(wcn); 3698e84c258SEugene Krasnikov wcn36xx_smd_close(wcn); 3708e84c258SEugene Krasnikov 3718e84c258SEugene Krasnikov wcn36xx_dxe_free_mem_pools(wcn); 3728e84c258SEugene Krasnikov wcn36xx_dxe_free_ctl_blks(wcn); 3738e84c258SEugene Krasnikov } 3748e84c258SEugene Krasnikov 3755973a294SLoic Poulain static void wcn36xx_change_ps(struct wcn36xx *wcn, bool enable) 3765973a294SLoic Poulain { 3775973a294SLoic Poulain struct ieee80211_vif *vif = NULL; 3785973a294SLoic Poulain struct wcn36xx_vif *tmp; 3795973a294SLoic Poulain 3805973a294SLoic Poulain list_for_each_entry(tmp, &wcn->vif_list, list) { 3815973a294SLoic Poulain vif = wcn36xx_priv_to_vif(tmp); 3825973a294SLoic Poulain if (enable && !wcn->sw_scan) { 3835973a294SLoic Poulain if (vif->bss_conf.ps) /* ps allowed ? */ 3845973a294SLoic Poulain wcn36xx_pmc_enter_bmps_state(wcn, vif); 3855973a294SLoic Poulain } else { 3865973a294SLoic Poulain wcn36xx_pmc_exit_bmps_state(wcn, vif); 3875973a294SLoic Poulain } 3885973a294SLoic Poulain } 3895973a294SLoic Poulain } 3905973a294SLoic Poulain 3915973a294SLoic Poulain static void wcn36xx_change_opchannel(struct wcn36xx *wcn, int ch) 3925973a294SLoic Poulain { 3935973a294SLoic Poulain struct ieee80211_vif *vif = NULL; 3945973a294SLoic Poulain struct wcn36xx_vif *tmp; 395*d6f27466SBryan O'Donoghue struct ieee80211_supported_band *band; 396*d6f27466SBryan O'Donoghue struct ieee80211_channel *channel; 397*d6f27466SBryan O'Donoghue int i, j; 398*d6f27466SBryan O'Donoghue 399*d6f27466SBryan O'Donoghue for (i = 0; i < ARRAY_SIZE(wcn->hw->wiphy->bands); i++) { 400*d6f27466SBryan O'Donoghue band = wcn->hw->wiphy->bands[i]; 401*d6f27466SBryan O'Donoghue if (!band) 402*d6f27466SBryan O'Donoghue break; 403*d6f27466SBryan O'Donoghue for (j = 0; j < band->n_channels; j++) { 404*d6f27466SBryan O'Donoghue if (HW_VALUE_CHANNEL(band->channels[j].hw_value) == ch) { 405*d6f27466SBryan O'Donoghue channel = &band->channels[j]; 406*d6f27466SBryan O'Donoghue break; 407*d6f27466SBryan O'Donoghue } 408*d6f27466SBryan O'Donoghue } 409*d6f27466SBryan O'Donoghue if (channel) 410*d6f27466SBryan O'Donoghue break; 411*d6f27466SBryan O'Donoghue } 412*d6f27466SBryan O'Donoghue 413*d6f27466SBryan O'Donoghue if (!channel) { 414*d6f27466SBryan O'Donoghue wcn36xx_err("Cannot tune to channel %d\n", ch); 415*d6f27466SBryan O'Donoghue return; 416*d6f27466SBryan O'Donoghue } 417*d6f27466SBryan O'Donoghue 418*d6f27466SBryan O'Donoghue wcn->band = band; 419*d6f27466SBryan O'Donoghue wcn->channel = channel; 4205973a294SLoic Poulain 4215973a294SLoic Poulain list_for_each_entry(tmp, &wcn->vif_list, list) { 4225973a294SLoic Poulain vif = wcn36xx_priv_to_vif(tmp); 4235973a294SLoic Poulain wcn36xx_smd_switch_channel(wcn, vif, ch); 4245973a294SLoic Poulain } 425*d6f27466SBryan O'Donoghue 426*d6f27466SBryan O'Donoghue return; 4275973a294SLoic Poulain } 4285973a294SLoic Poulain 4298e84c258SEugene Krasnikov static int wcn36xx_config(struct ieee80211_hw *hw, u32 changed) 4308e84c258SEugene Krasnikov { 4318e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 4328f1ba8b0SBenjamin Li int ret; 4338e84c258SEugene Krasnikov 4348e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac config changed 0x%08x\n", changed); 4358e84c258SEugene Krasnikov 43639efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 43739efc7ccSBjorn Andersson 4388e84c258SEugene Krasnikov if (changed & IEEE80211_CONF_CHANGE_CHANNEL) { 4398e84c258SEugene Krasnikov int ch = WCN36XX_HW_CHANNEL(wcn); 4408e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "wcn36xx_config channel switch=%d\n", 4418e84c258SEugene Krasnikov ch); 4425973a294SLoic Poulain 443d195d7aaSJoseph Gates if (wcn->sw_scan_opchannel == ch && wcn->sw_scan_channel) { 4445973a294SLoic Poulain /* If channel is the initial operating channel, we may 4455973a294SLoic Poulain * want to receive/transmit regular data packets, then 4465973a294SLoic Poulain * simply stop the scan session and exit PS mode. 4475973a294SLoic Poulain */ 4488f1ba8b0SBenjamin Li if (wcn->sw_scan_channel) 4498f1ba8b0SBenjamin Li wcn36xx_smd_end_scan(wcn, wcn->sw_scan_channel); 4508f1ba8b0SBenjamin Li if (wcn->sw_scan_init) { 4515973a294SLoic Poulain wcn36xx_smd_finish_scan(wcn, HAL_SYS_MODE_SCAN, 4525973a294SLoic Poulain wcn->sw_scan_vif); 4538f1ba8b0SBenjamin Li } 4545973a294SLoic Poulain } else if (wcn->sw_scan) { 4555973a294SLoic Poulain /* A scan is ongoing, do not change the operating 4565973a294SLoic Poulain * channel, but start a scan session on the channel. 4575973a294SLoic Poulain */ 4588f1ba8b0SBenjamin Li if (wcn->sw_scan_channel) 4598f1ba8b0SBenjamin Li wcn36xx_smd_end_scan(wcn, wcn->sw_scan_channel); 4608f1ba8b0SBenjamin Li if (!wcn->sw_scan_init) { 4618f1ba8b0SBenjamin Li /* This can fail if we are unable to notify the 4628f1ba8b0SBenjamin Li * operating channel. 4638f1ba8b0SBenjamin Li */ 4648f1ba8b0SBenjamin Li ret = wcn36xx_smd_init_scan(wcn, 4658f1ba8b0SBenjamin Li HAL_SYS_MODE_SCAN, 4665973a294SLoic Poulain wcn->sw_scan_vif); 4678f1ba8b0SBenjamin Li if (ret) { 4688f1ba8b0SBenjamin Li mutex_unlock(&wcn->conf_mutex); 4698f1ba8b0SBenjamin Li return -EIO; 4708f1ba8b0SBenjamin Li } 4718f1ba8b0SBenjamin Li } 4725973a294SLoic Poulain wcn36xx_smd_start_scan(wcn, ch); 4735973a294SLoic Poulain } else { 4745973a294SLoic Poulain wcn36xx_change_opchannel(wcn, ch); 4758e84c258SEugene Krasnikov } 4768e84c258SEugene Krasnikov } 4778e84c258SEugene Krasnikov 4785973a294SLoic Poulain if (changed & IEEE80211_CONF_CHANGE_PS) 4795973a294SLoic Poulain wcn36xx_change_ps(wcn, hw->conf.flags & IEEE80211_CONF_PS); 4800856655aSLoic Poulain 4810e159d2cSBryan O'Donoghue if (changed & IEEE80211_CONF_CHANGE_IDLE) { 4820e159d2cSBryan O'Donoghue if (hw->conf.flags & IEEE80211_CONF_IDLE) 4830e159d2cSBryan O'Donoghue wcn36xx_smd_enter_imps(wcn); 4840e159d2cSBryan O'Donoghue else 4850e159d2cSBryan O'Donoghue wcn36xx_smd_exit_imps(wcn); 4860e159d2cSBryan O'Donoghue } 4870e159d2cSBryan O'Donoghue 48839efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 48939efc7ccSBjorn Andersson 4908e84c258SEugene Krasnikov return 0; 4918e84c258SEugene Krasnikov } 4928e84c258SEugene Krasnikov 4938e84c258SEugene Krasnikov static void wcn36xx_configure_filter(struct ieee80211_hw *hw, 4948e84c258SEugene Krasnikov unsigned int changed, 4958e84c258SEugene Krasnikov unsigned int *total, u64 multicast) 4968e84c258SEugene Krasnikov { 49720a779edSPontus Fuchs struct wcn36xx_hal_rcv_flt_mc_addr_list_type *fp; 49820a779edSPontus Fuchs struct wcn36xx *wcn = hw->priv; 49920a779edSPontus Fuchs struct wcn36xx_vif *tmp; 50020a779edSPontus Fuchs struct ieee80211_vif *vif = NULL; 50120a779edSPontus Fuchs 5028e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac configure filter\n"); 5038e84c258SEugene Krasnikov 50439efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 50539efc7ccSBjorn Andersson 50620a779edSPontus Fuchs *total &= FIF_ALLMULTI; 50720a779edSPontus Fuchs 50820a779edSPontus Fuchs fp = (void *)(unsigned long)multicast; 50920a779edSPontus Fuchs list_for_each_entry(tmp, &wcn->vif_list, list) { 51020a779edSPontus Fuchs vif = wcn36xx_priv_to_vif(tmp); 51120a779edSPontus Fuchs 51220a779edSPontus Fuchs /* FW handles MC filtering only when connected as STA */ 51320a779edSPontus Fuchs if (*total & FIF_ALLMULTI) 51420a779edSPontus Fuchs wcn36xx_smd_set_mc_list(wcn, vif, NULL); 51520a779edSPontus Fuchs else if (NL80211_IFTYPE_STATION == vif->type && tmp->sta_assoc) 51620a779edSPontus Fuchs wcn36xx_smd_set_mc_list(wcn, vif, fp); 51720a779edSPontus Fuchs } 51839efc7ccSBjorn Andersson 51939efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 52020a779edSPontus Fuchs kfree(fp); 52120a779edSPontus Fuchs } 52220a779edSPontus Fuchs 52320a779edSPontus Fuchs static u64 wcn36xx_prepare_multicast(struct ieee80211_hw *hw, 52420a779edSPontus Fuchs struct netdev_hw_addr_list *mc_list) 52520a779edSPontus Fuchs { 52620a779edSPontus Fuchs struct wcn36xx_hal_rcv_flt_mc_addr_list_type *fp; 52720a779edSPontus Fuchs struct netdev_hw_addr *ha; 52820a779edSPontus Fuchs 52920a779edSPontus Fuchs wcn36xx_dbg(WCN36XX_DBG_MAC, "mac prepare multicast list\n"); 53020a779edSPontus Fuchs fp = kzalloc(sizeof(*fp), GFP_ATOMIC); 53120a779edSPontus Fuchs if (!fp) { 53220a779edSPontus Fuchs wcn36xx_err("Out of memory setting filters.\n"); 53320a779edSPontus Fuchs return 0; 53420a779edSPontus Fuchs } 53520a779edSPontus Fuchs 53620a779edSPontus Fuchs fp->mc_addr_count = 0; 53720a779edSPontus Fuchs /* update multicast filtering parameters */ 53820a779edSPontus Fuchs if (netdev_hw_addr_list_count(mc_list) <= 53920a779edSPontus Fuchs WCN36XX_HAL_MAX_NUM_MULTICAST_ADDRESS) { 54020a779edSPontus Fuchs netdev_hw_addr_list_for_each(ha, mc_list) { 54120a779edSPontus Fuchs memcpy(fp->mc_addr[fp->mc_addr_count], 54220a779edSPontus Fuchs ha->addr, ETH_ALEN); 54320a779edSPontus Fuchs fp->mc_addr_count++; 54420a779edSPontus Fuchs } 54520a779edSPontus Fuchs } 54620a779edSPontus Fuchs 54720a779edSPontus Fuchs return (u64)(unsigned long)fp; 5488e84c258SEugene Krasnikov } 5498e84c258SEugene Krasnikov 5508e84c258SEugene Krasnikov static void wcn36xx_tx(struct ieee80211_hw *hw, 5518e84c258SEugene Krasnikov struct ieee80211_tx_control *control, 5528e84c258SEugene Krasnikov struct sk_buff *skb) 5538e84c258SEugene Krasnikov { 5548e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 5558e84c258SEugene Krasnikov struct wcn36xx_sta *sta_priv = NULL; 5568e84c258SEugene Krasnikov 5578e84c258SEugene Krasnikov if (control->sta) 558a92e4696SPontus Fuchs sta_priv = wcn36xx_sta_to_priv(control->sta); 5598e84c258SEugene Krasnikov 5608e84c258SEugene Krasnikov if (wcn36xx_start_tx(wcn, sta_priv, skb)) 5618e84c258SEugene Krasnikov ieee80211_free_txskb(wcn->hw, skb); 5628e84c258SEugene Krasnikov } 5638e84c258SEugene Krasnikov 5648e84c258SEugene Krasnikov static int wcn36xx_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, 5658e84c258SEugene Krasnikov struct ieee80211_vif *vif, 5668e84c258SEugene Krasnikov struct ieee80211_sta *sta, 5678e84c258SEugene Krasnikov struct ieee80211_key_conf *key_conf) 5688e84c258SEugene Krasnikov { 5698e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 570ce75877fSPontus Fuchs struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 571216da128SLoic Poulain struct wcn36xx_sta *sta_priv = sta ? wcn36xx_sta_to_priv(sta) : NULL; 5728e84c258SEugene Krasnikov int ret = 0; 5738e84c258SEugene Krasnikov u8 key[WLAN_MAX_KEY_LEN]; 5748e84c258SEugene Krasnikov 5758e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac80211 set key\n"); 5768e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "Key: cmd=0x%x algo:0x%x, id:%d, len:%d flags 0x%x\n", 5778e84c258SEugene Krasnikov cmd, key_conf->cipher, key_conf->keyidx, 5788e84c258SEugene Krasnikov key_conf->keylen, key_conf->flags); 5798e84c258SEugene Krasnikov wcn36xx_dbg_dump(WCN36XX_DBG_MAC, "KEY: ", 5808e84c258SEugene Krasnikov key_conf->key, 5818e84c258SEugene Krasnikov key_conf->keylen); 5828e84c258SEugene Krasnikov 58339efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 58439efc7ccSBjorn Andersson 5858e84c258SEugene Krasnikov switch (key_conf->cipher) { 5868e84c258SEugene Krasnikov case WLAN_CIPHER_SUITE_WEP40: 5878e84c258SEugene Krasnikov vif_priv->encrypt_type = WCN36XX_HAL_ED_WEP40; 5888e84c258SEugene Krasnikov break; 5898e84c258SEugene Krasnikov case WLAN_CIPHER_SUITE_WEP104: 59010db60b9SLoic Poulain vif_priv->encrypt_type = WCN36XX_HAL_ED_WEP104; 5918e84c258SEugene Krasnikov break; 5928e84c258SEugene Krasnikov case WLAN_CIPHER_SUITE_CCMP: 5938e84c258SEugene Krasnikov vif_priv->encrypt_type = WCN36XX_HAL_ED_CCMP; 5948e84c258SEugene Krasnikov break; 5958e84c258SEugene Krasnikov case WLAN_CIPHER_SUITE_TKIP: 5968e84c258SEugene Krasnikov vif_priv->encrypt_type = WCN36XX_HAL_ED_TKIP; 5978e84c258SEugene Krasnikov break; 5988e84c258SEugene Krasnikov default: 5998e84c258SEugene Krasnikov wcn36xx_err("Unsupported key type 0x%x\n", 6008e84c258SEugene Krasnikov key_conf->cipher); 6018e84c258SEugene Krasnikov ret = -EOPNOTSUPP; 6028e84c258SEugene Krasnikov goto out; 6038e84c258SEugene Krasnikov } 6048e84c258SEugene Krasnikov 6058e84c258SEugene Krasnikov switch (cmd) { 6068e84c258SEugene Krasnikov case SET_KEY: 6078e84c258SEugene Krasnikov if (WCN36XX_HAL_ED_TKIP == vif_priv->encrypt_type) { 6088e84c258SEugene Krasnikov /* 6098e84c258SEugene Krasnikov * Supplicant is sending key in the wrong order: 6108e84c258SEugene Krasnikov * Temporal Key (16 b) - TX MIC (8 b) - RX MIC (8 b) 6118e84c258SEugene Krasnikov * but HW expects it to be in the order as described in 6128e84c258SEugene Krasnikov * IEEE 802.11 spec (see chapter 11.7) like this: 6138e84c258SEugene Krasnikov * Temporal Key (16 b) - RX MIC (8 b) - TX MIC (8 b) 6148e84c258SEugene Krasnikov */ 6158e84c258SEugene Krasnikov memcpy(key, key_conf->key, 16); 6168e84c258SEugene Krasnikov memcpy(key + 16, key_conf->key + 24, 8); 6178e84c258SEugene Krasnikov memcpy(key + 24, key_conf->key + 16, 8); 6188e84c258SEugene Krasnikov } else { 6198e84c258SEugene Krasnikov memcpy(key, key_conf->key, key_conf->keylen); 6208e84c258SEugene Krasnikov } 6218e84c258SEugene Krasnikov 6228e84c258SEugene Krasnikov if (IEEE80211_KEY_FLAG_PAIRWISE & key_conf->flags) { 6238e84c258SEugene Krasnikov sta_priv->is_data_encrypted = true; 6248e84c258SEugene Krasnikov /* Reconfigure bss with encrypt_type */ 625701668d3SBryan O'Donoghue if (NL80211_IFTYPE_STATION == vif->type) { 6268e84c258SEugene Krasnikov wcn36xx_smd_config_bss(wcn, 6278e84c258SEugene Krasnikov vif, 6288e84c258SEugene Krasnikov sta, 6298e84c258SEugene Krasnikov sta->addr, 6308e84c258SEugene Krasnikov true); 631701668d3SBryan O'Donoghue wcn36xx_smd_config_sta(wcn, vif, sta); 632701668d3SBryan O'Donoghue } 6338e84c258SEugene Krasnikov 6348e84c258SEugene Krasnikov wcn36xx_smd_set_stakey(wcn, 6358e84c258SEugene Krasnikov vif_priv->encrypt_type, 6368e84c258SEugene Krasnikov key_conf->keyidx, 6378e84c258SEugene Krasnikov key_conf->keylen, 6388e84c258SEugene Krasnikov key, 6398e84c258SEugene Krasnikov get_sta_index(vif, sta_priv)); 6408e84c258SEugene Krasnikov } else { 6418e84c258SEugene Krasnikov wcn36xx_smd_set_bsskey(wcn, 6428e84c258SEugene Krasnikov vif_priv->encrypt_type, 6430fc8bb50SDaniel Mack vif_priv->bss_index, 6448e84c258SEugene Krasnikov key_conf->keyidx, 6458e84c258SEugene Krasnikov key_conf->keylen, 6468e84c258SEugene Krasnikov key); 647e3160542SLoic Poulain 6488e84c258SEugene Krasnikov if ((WLAN_CIPHER_SUITE_WEP40 == key_conf->cipher) || 6498e84c258SEugene Krasnikov (WLAN_CIPHER_SUITE_WEP104 == key_conf->cipher)) { 650216da128SLoic Poulain list_for_each_entry(sta_priv, 651216da128SLoic Poulain &vif_priv->sta_list, list) { 6528e84c258SEugene Krasnikov sta_priv->is_data_encrypted = true; 6538e84c258SEugene Krasnikov wcn36xx_smd_set_stakey(wcn, 6548e84c258SEugene Krasnikov vif_priv->encrypt_type, 6558e84c258SEugene Krasnikov key_conf->keyidx, 6568e84c258SEugene Krasnikov key_conf->keylen, 6578e84c258SEugene Krasnikov key, 6588e84c258SEugene Krasnikov get_sta_index(vif, sta_priv)); 6598e84c258SEugene Krasnikov } 6608e84c258SEugene Krasnikov } 661216da128SLoic Poulain } 6628e84c258SEugene Krasnikov break; 6638e84c258SEugene Krasnikov case DISABLE_KEY: 6648e84c258SEugene Krasnikov if (!(IEEE80211_KEY_FLAG_PAIRWISE & key_conf->flags)) { 6650fc8bb50SDaniel Mack if (vif_priv->bss_index != WCN36XX_HAL_BSS_INVALID_IDX) 6668e84c258SEugene Krasnikov wcn36xx_smd_remove_bsskey(wcn, 6678e84c258SEugene Krasnikov vif_priv->encrypt_type, 6680fc8bb50SDaniel Mack vif_priv->bss_index, 6698e84c258SEugene Krasnikov key_conf->keyidx); 6700fc8bb50SDaniel Mack 6710fc8bb50SDaniel Mack vif_priv->encrypt_type = WCN36XX_HAL_ED_NONE; 6728e84c258SEugene Krasnikov } else { 6738e84c258SEugene Krasnikov sta_priv->is_data_encrypted = false; 6748e84c258SEugene Krasnikov /* do not remove key if disassociated */ 6758e84c258SEugene Krasnikov if (sta_priv->aid) 6768e84c258SEugene Krasnikov wcn36xx_smd_remove_stakey(wcn, 6778e84c258SEugene Krasnikov vif_priv->encrypt_type, 6788e84c258SEugene Krasnikov key_conf->keyidx, 6798e84c258SEugene Krasnikov get_sta_index(vif, sta_priv)); 6808e84c258SEugene Krasnikov } 6818e84c258SEugene Krasnikov break; 6828e84c258SEugene Krasnikov default: 6838e84c258SEugene Krasnikov wcn36xx_err("Unsupported key cmd 0x%x\n", cmd); 6848e84c258SEugene Krasnikov ret = -EOPNOTSUPP; 6858e84c258SEugene Krasnikov goto out; 6868e84c258SEugene Krasnikov } 6878e84c258SEugene Krasnikov 6888e84c258SEugene Krasnikov out: 68939efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 69039efc7ccSBjorn Andersson 6918e84c258SEugene Krasnikov return ret; 6928e84c258SEugene Krasnikov } 6938e84c258SEugene Krasnikov 69488603903SBjorn Andersson static int wcn36xx_hw_scan(struct ieee80211_hw *hw, 69588603903SBjorn Andersson struct ieee80211_vif *vif, 69688603903SBjorn Andersson struct ieee80211_scan_request *hw_req) 6978e84c258SEugene Krasnikov { 6988e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 6995973a294SLoic Poulain 7005973a294SLoic Poulain if (!get_feat_caps(wcn->fw_feat_caps, SCAN_OFFLOAD)) { 7015973a294SLoic Poulain /* fallback to mac80211 software scan */ 7025973a294SLoic Poulain return 1; 7035973a294SLoic Poulain } 7045973a294SLoic Poulain 7052371b15fSLoic Poulain /* Firmware scan offload is limited to 48 channels, fallback to 7062371b15fSLoic Poulain * software driven scanning otherwise. 7075973a294SLoic Poulain */ 7082371b15fSLoic Poulain if (hw_req->req.n_channels > 48) { 7092371b15fSLoic Poulain wcn36xx_warn("Offload scan aborted, n_channels=%u", 7102371b15fSLoic Poulain hw_req->req.n_channels); 7115973a294SLoic Poulain return 1; 7125973a294SLoic Poulain } 7135973a294SLoic Poulain 71488603903SBjorn Andersson mutex_lock(&wcn->scan_lock); 71588603903SBjorn Andersson if (wcn->scan_req) { 71688603903SBjorn Andersson mutex_unlock(&wcn->scan_lock); 71788603903SBjorn Andersson return -EBUSY; 71888603903SBjorn Andersson } 71903c95dbeSBjorn Andersson 72003c95dbeSBjorn Andersson wcn->scan_aborted = false; 72188603903SBjorn Andersson wcn->scan_req = &hw_req->req; 7222f3bef4bSLoic Poulain 72388603903SBjorn Andersson mutex_unlock(&wcn->scan_lock); 72488603903SBjorn Andersson 725d707f812SLoic Poulain wcn36xx_smd_update_channel_list(wcn, &hw_req->req); 7262f3bef4bSLoic Poulain return wcn36xx_smd_start_hw_scan(wcn, vif, &hw_req->req); 7272f3bef4bSLoic Poulain } 7282f3bef4bSLoic Poulain 72903c95dbeSBjorn Andersson static void wcn36xx_cancel_hw_scan(struct ieee80211_hw *hw, 73003c95dbeSBjorn Andersson struct ieee80211_vif *vif) 73103c95dbeSBjorn Andersson { 73203c95dbeSBjorn Andersson struct wcn36xx *wcn = hw->priv; 73303c95dbeSBjorn Andersson 73403c95dbeSBjorn Andersson mutex_lock(&wcn->scan_lock); 73503c95dbeSBjorn Andersson wcn->scan_aborted = true; 73603c95dbeSBjorn Andersson mutex_unlock(&wcn->scan_lock); 73703c95dbeSBjorn Andersson 73889722f57SDaniel Mack if (get_feat_caps(wcn->fw_feat_caps, SCAN_OFFLOAD)) { 73989722f57SDaniel Mack /* ieee80211_scan_completed will be called on FW scan 74089722f57SDaniel Mack * indication */ 7419bfd05e3SLoic Poulain wcn36xx_smd_stop_hw_scan(wcn); 74289722f57SDaniel Mack } 74303c95dbeSBjorn Andersson } 74403c95dbeSBjorn Andersson 7455973a294SLoic Poulain static void wcn36xx_sw_scan_start(struct ieee80211_hw *hw, 7465973a294SLoic Poulain struct ieee80211_vif *vif, 7475973a294SLoic Poulain const u8 *mac_addr) 7485973a294SLoic Poulain { 7495973a294SLoic Poulain struct wcn36xx *wcn = hw->priv; 7505973a294SLoic Poulain struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 7515973a294SLoic Poulain 752df008741SBenjamin Li wcn36xx_dbg(WCN36XX_DBG_MAC, "sw_scan_start"); 753df008741SBenjamin Li 7545973a294SLoic Poulain wcn->sw_scan = true; 7555973a294SLoic Poulain wcn->sw_scan_vif = vif; 756d195d7aaSJoseph Gates wcn->sw_scan_channel = 0; 7575973a294SLoic Poulain if (vif_priv->sta_assoc) 7585973a294SLoic Poulain wcn->sw_scan_opchannel = WCN36XX_HW_CHANNEL(wcn); 7595973a294SLoic Poulain else 7605973a294SLoic Poulain wcn->sw_scan_opchannel = 0; 7615973a294SLoic Poulain } 7625973a294SLoic Poulain 7635973a294SLoic Poulain static void wcn36xx_sw_scan_complete(struct ieee80211_hw *hw, 7645973a294SLoic Poulain struct ieee80211_vif *vif) 7655973a294SLoic Poulain { 7665973a294SLoic Poulain struct wcn36xx *wcn = hw->priv; 7675973a294SLoic Poulain 768df008741SBenjamin Li wcn36xx_dbg(WCN36XX_DBG_MAC, "sw_scan_complete"); 769df008741SBenjamin Li 7705973a294SLoic Poulain /* ensure that any scan session is finished */ 7718f1ba8b0SBenjamin Li if (wcn->sw_scan_channel) 7728f1ba8b0SBenjamin Li wcn36xx_smd_end_scan(wcn, wcn->sw_scan_channel); 7738f1ba8b0SBenjamin Li if (wcn->sw_scan_init) { 7748f1ba8b0SBenjamin Li wcn36xx_smd_finish_scan(wcn, HAL_SYS_MODE_SCAN, 7758f1ba8b0SBenjamin Li wcn->sw_scan_vif); 7768f1ba8b0SBenjamin Li } 7775973a294SLoic Poulain wcn->sw_scan = false; 7785973a294SLoic Poulain wcn->sw_scan_opchannel = 0; 7795973a294SLoic Poulain } 7805973a294SLoic Poulain 7818e84c258SEugene Krasnikov static void wcn36xx_update_allowed_rates(struct ieee80211_sta *sta, 78257fbcce3SJohannes Berg enum nl80211_band band) 7838e84c258SEugene Krasnikov { 7848e84c258SEugene Krasnikov int i, size; 7858e84c258SEugene Krasnikov u16 *rates_table; 786a92e4696SPontus Fuchs struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(sta); 7878e84c258SEugene Krasnikov u32 rates = sta->supp_rates[band]; 7888e84c258SEugene Krasnikov 7898e84c258SEugene Krasnikov memset(&sta_priv->supported_rates, 0, 7908e84c258SEugene Krasnikov sizeof(sta_priv->supported_rates)); 7918e84c258SEugene Krasnikov sta_priv->supported_rates.op_rate_mode = STA_11n; 7928e84c258SEugene Krasnikov 7938e84c258SEugene Krasnikov size = ARRAY_SIZE(sta_priv->supported_rates.dsss_rates); 7948e84c258SEugene Krasnikov rates_table = sta_priv->supported_rates.dsss_rates; 79557fbcce3SJohannes Berg if (band == NL80211_BAND_2GHZ) { 7968e84c258SEugene Krasnikov for (i = 0; i < size; i++) { 7978e84c258SEugene Krasnikov if (rates & 0x01) { 7988e84c258SEugene Krasnikov rates_table[i] = wcn_2ghz_rates[i].hw_value; 7998e84c258SEugene Krasnikov rates = rates >> 1; 8008e84c258SEugene Krasnikov } 8018e84c258SEugene Krasnikov } 8028e84c258SEugene Krasnikov } 8038e84c258SEugene Krasnikov 8048e84c258SEugene Krasnikov size = ARRAY_SIZE(sta_priv->supported_rates.ofdm_rates); 8058e84c258SEugene Krasnikov rates_table = sta_priv->supported_rates.ofdm_rates; 8068e84c258SEugene Krasnikov for (i = 0; i < size; i++) { 8078e84c258SEugene Krasnikov if (rates & 0x01) { 8088e84c258SEugene Krasnikov rates_table[i] = wcn_5ghz_rates[i].hw_value; 8098e84c258SEugene Krasnikov rates = rates >> 1; 8108e84c258SEugene Krasnikov } 8118e84c258SEugene Krasnikov } 8128e84c258SEugene Krasnikov 8138e84c258SEugene Krasnikov if (sta->ht_cap.ht_supported) { 8148e84c258SEugene Krasnikov BUILD_BUG_ON(sizeof(sta->ht_cap.mcs.rx_mask) > 8158e84c258SEugene Krasnikov sizeof(sta_priv->supported_rates.supported_mcs_set)); 8168e84c258SEugene Krasnikov memcpy(sta_priv->supported_rates.supported_mcs_set, 8178e84c258SEugene Krasnikov sta->ht_cap.mcs.rx_mask, 8188e84c258SEugene Krasnikov sizeof(sta->ht_cap.mcs.rx_mask)); 8198e84c258SEugene Krasnikov } 82087d3f1f3SBryan O'Donoghue 82187d3f1f3SBryan O'Donoghue if (sta->vht_cap.vht_supported) { 82287d3f1f3SBryan O'Donoghue sta_priv->supported_rates.op_rate_mode = STA_11ac; 82387d3f1f3SBryan O'Donoghue sta_priv->supported_rates.vht_rx_mcs_map = 82487d3f1f3SBryan O'Donoghue sta->vht_cap.vht_mcs.rx_mcs_map; 82587d3f1f3SBryan O'Donoghue sta_priv->supported_rates.vht_tx_mcs_map = 82687d3f1f3SBryan O'Donoghue sta->vht_cap.vht_mcs.tx_mcs_map; 82787d3f1f3SBryan O'Donoghue } 8288e84c258SEugene Krasnikov } 82921409151SBryan O'Donoghue 8308e84c258SEugene Krasnikov void wcn36xx_set_default_rates(struct wcn36xx_hal_supported_rates *rates) 8318e84c258SEugene Krasnikov { 8328e84c258SEugene Krasnikov u16 ofdm_rates[WCN36XX_HAL_NUM_OFDM_RATES] = { 8338e84c258SEugene Krasnikov HW_RATE_INDEX_6MBPS, 8348e84c258SEugene Krasnikov HW_RATE_INDEX_9MBPS, 8358e84c258SEugene Krasnikov HW_RATE_INDEX_12MBPS, 8368e84c258SEugene Krasnikov HW_RATE_INDEX_18MBPS, 8378e84c258SEugene Krasnikov HW_RATE_INDEX_24MBPS, 8388e84c258SEugene Krasnikov HW_RATE_INDEX_36MBPS, 8398e84c258SEugene Krasnikov HW_RATE_INDEX_48MBPS, 8408e84c258SEugene Krasnikov HW_RATE_INDEX_54MBPS 8418e84c258SEugene Krasnikov }; 8428e84c258SEugene Krasnikov u16 dsss_rates[WCN36XX_HAL_NUM_DSSS_RATES] = { 8438e84c258SEugene Krasnikov HW_RATE_INDEX_1MBPS, 8448e84c258SEugene Krasnikov HW_RATE_INDEX_2MBPS, 8458e84c258SEugene Krasnikov HW_RATE_INDEX_5_5MBPS, 8468e84c258SEugene Krasnikov HW_RATE_INDEX_11MBPS 8478e84c258SEugene Krasnikov }; 8488e84c258SEugene Krasnikov 8498e84c258SEugene Krasnikov rates->op_rate_mode = STA_11n; 8508e84c258SEugene Krasnikov memcpy(rates->dsss_rates, dsss_rates, 8518e84c258SEugene Krasnikov sizeof(*dsss_rates) * WCN36XX_HAL_NUM_DSSS_RATES); 8528e84c258SEugene Krasnikov memcpy(rates->ofdm_rates, ofdm_rates, 8538e84c258SEugene Krasnikov sizeof(*ofdm_rates) * WCN36XX_HAL_NUM_OFDM_RATES); 8548e84c258SEugene Krasnikov rates->supported_mcs_set[0] = 0xFF; 8558e84c258SEugene Krasnikov } 856c84515bdSBryan O'Donoghue 857c84515bdSBryan O'Donoghue void wcn36xx_set_default_rates_v1(struct wcn36xx_hal_supported_rates_v1 *rates) 858c84515bdSBryan O'Donoghue { 859c84515bdSBryan O'Donoghue rates->op_rate_mode = STA_11ac; 860c84515bdSBryan O'Donoghue rates->vht_rx_mcs_map = IEEE80211_VHT_MCS_SUPPORT_0_9; 861c84515bdSBryan O'Donoghue rates->vht_tx_mcs_map = IEEE80211_VHT_MCS_SUPPORT_0_9; 862c84515bdSBryan O'Donoghue } 863c84515bdSBryan O'Donoghue 8648e84c258SEugene Krasnikov static void wcn36xx_bss_info_changed(struct ieee80211_hw *hw, 8658e84c258SEugene Krasnikov struct ieee80211_vif *vif, 8668e84c258SEugene Krasnikov struct ieee80211_bss_conf *bss_conf, 8678e84c258SEugene Krasnikov u32 changed) 8688e84c258SEugene Krasnikov { 8698e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 8708e84c258SEugene Krasnikov struct sk_buff *skb = NULL; 8718e84c258SEugene Krasnikov u16 tim_off, tim_len; 8728e84c258SEugene Krasnikov enum wcn36xx_hal_link_state link_state; 873ce75877fSPontus Fuchs struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 8748e84c258SEugene Krasnikov 8758e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac bss info changed vif %p changed 0x%08x\n", 8768e84c258SEugene Krasnikov vif, changed); 8778e84c258SEugene Krasnikov 87839efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 87939efc7ccSBjorn Andersson 8808e84c258SEugene Krasnikov if (changed & BSS_CHANGED_BEACON_INFO) { 8818e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, 8828e84c258SEugene Krasnikov "mac bss changed dtim period %d\n", 8838e84c258SEugene Krasnikov bss_conf->dtim_period); 8848e84c258SEugene Krasnikov 8858e84c258SEugene Krasnikov vif_priv->dtim_period = bss_conf->dtim_period; 8868e84c258SEugene Krasnikov } 8878e84c258SEugene Krasnikov 8888e84c258SEugene Krasnikov if (changed & BSS_CHANGED_BSSID) { 8898e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac bss changed_bssid %pM\n", 8908e84c258SEugene Krasnikov bss_conf->bssid); 8918e84c258SEugene Krasnikov 8928e84c258SEugene Krasnikov if (!is_zero_ether_addr(bss_conf->bssid)) { 8938e84c258SEugene Krasnikov vif_priv->is_joining = true; 89490023c03SPontus Fuchs vif_priv->bss_index = WCN36XX_HAL_BSS_INVALID_IDX; 8952a46c829SDaniel Mack wcn36xx_smd_set_link_st(wcn, bss_conf->bssid, vif->addr, 8962a46c829SDaniel Mack WCN36XX_HAL_LINK_PREASSOC_STATE); 8978e84c258SEugene Krasnikov wcn36xx_smd_join(wcn, bss_conf->bssid, 8988e84c258SEugene Krasnikov vif->addr, WCN36XX_HW_CHANNEL(wcn)); 8998e84c258SEugene Krasnikov wcn36xx_smd_config_bss(wcn, vif, NULL, 9008e84c258SEugene Krasnikov bss_conf->bssid, false); 9018e84c258SEugene Krasnikov } else { 9028e84c258SEugene Krasnikov vif_priv->is_joining = false; 9038e84c258SEugene Krasnikov wcn36xx_smd_delete_bss(wcn, vif); 9042a46c829SDaniel Mack wcn36xx_smd_set_link_st(wcn, bss_conf->bssid, vif->addr, 9052a46c829SDaniel Mack WCN36XX_HAL_LINK_IDLE_STATE); 9062716a8acSPontus Fuchs vif_priv->encrypt_type = WCN36XX_HAL_ED_NONE; 9078e84c258SEugene Krasnikov } 9088e84c258SEugene Krasnikov } 9098e84c258SEugene Krasnikov 9108e84c258SEugene Krasnikov if (changed & BSS_CHANGED_SSID) { 9118e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, 9128e84c258SEugene Krasnikov "mac bss changed ssid\n"); 9138e84c258SEugene Krasnikov wcn36xx_dbg_dump(WCN36XX_DBG_MAC, "ssid ", 9148e84c258SEugene Krasnikov bss_conf->ssid, bss_conf->ssid_len); 9158e84c258SEugene Krasnikov 9168e84c258SEugene Krasnikov vif_priv->ssid.length = bss_conf->ssid_len; 9178e84c258SEugene Krasnikov memcpy(&vif_priv->ssid.ssid, 9188e84c258SEugene Krasnikov bss_conf->ssid, 9198e84c258SEugene Krasnikov bss_conf->ssid_len); 9208e84c258SEugene Krasnikov } 9218e84c258SEugene Krasnikov 9228e84c258SEugene Krasnikov if (changed & BSS_CHANGED_ASSOC) { 9238e84c258SEugene Krasnikov vif_priv->is_joining = false; 9248e84c258SEugene Krasnikov if (bss_conf->assoc) { 9258e84c258SEugene Krasnikov struct ieee80211_sta *sta; 9268e84c258SEugene Krasnikov struct wcn36xx_sta *sta_priv; 9278e84c258SEugene Krasnikov 9288e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, 9298e84c258SEugene Krasnikov "mac assoc bss %pM vif %pM AID=%d\n", 9308e84c258SEugene Krasnikov bss_conf->bssid, 9318e84c258SEugene Krasnikov vif->addr, 9328e84c258SEugene Krasnikov bss_conf->aid); 9338e84c258SEugene Krasnikov 934043ce546SPontus Fuchs vif_priv->sta_assoc = true; 93539efc7ccSBjorn Andersson 93639efc7ccSBjorn Andersson /* 93739efc7ccSBjorn Andersson * Holding conf_mutex ensures mutal exclusion with 93839efc7ccSBjorn Andersson * wcn36xx_sta_remove() and as such ensures that sta 93939efc7ccSBjorn Andersson * won't be freed while we're operating on it. As such 94039efc7ccSBjorn Andersson * we do not need to hold the rcu_read_lock(). 94139efc7ccSBjorn Andersson */ 9428e84c258SEugene Krasnikov sta = ieee80211_find_sta(vif, bss_conf->bssid); 9438e84c258SEugene Krasnikov if (!sta) { 9448e84c258SEugene Krasnikov wcn36xx_err("sta %pM is not found\n", 9458e84c258SEugene Krasnikov bss_conf->bssid); 9468e84c258SEugene Krasnikov goto out; 9478e84c258SEugene Krasnikov } 948a92e4696SPontus Fuchs sta_priv = wcn36xx_sta_to_priv(sta); 9498e84c258SEugene Krasnikov 9508e84c258SEugene Krasnikov wcn36xx_update_allowed_rates(sta, WCN36XX_BAND(wcn)); 9518e84c258SEugene Krasnikov 9528e84c258SEugene Krasnikov wcn36xx_smd_set_link_st(wcn, bss_conf->bssid, 9538e84c258SEugene Krasnikov vif->addr, 9548e84c258SEugene Krasnikov WCN36XX_HAL_LINK_POSTASSOC_STATE); 9558e84c258SEugene Krasnikov wcn36xx_smd_config_bss(wcn, vif, sta, 9568e84c258SEugene Krasnikov bss_conf->bssid, 9578e84c258SEugene Krasnikov true); 9588e84c258SEugene Krasnikov sta_priv->aid = bss_conf->aid; 9598e84c258SEugene Krasnikov /* 9608e84c258SEugene Krasnikov * config_sta must be called from because this is the 9618e84c258SEugene Krasnikov * place where AID is available. 9628e84c258SEugene Krasnikov */ 9638e84c258SEugene Krasnikov wcn36xx_smd_config_sta(wcn, vif, sta); 964bebd87eeSBryan O'Donoghue if (vif->type == NL80211_IFTYPE_STATION) 965bebd87eeSBryan O'Donoghue wcn36xx_smd_add_beacon_filter(wcn, vif); 9665336fad9SBryan O'Donoghue wcn36xx_enable_keep_alive_null_packet(wcn, vif); 9678e84c258SEugene Krasnikov } else { 9688e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, 9698e84c258SEugene Krasnikov "disassociated bss %pM vif %pM AID=%d\n", 9708e84c258SEugene Krasnikov bss_conf->bssid, 9718e84c258SEugene Krasnikov vif->addr, 9728e84c258SEugene Krasnikov bss_conf->aid); 973043ce546SPontus Fuchs vif_priv->sta_assoc = false; 9748e84c258SEugene Krasnikov wcn36xx_smd_set_link_st(wcn, 9758e84c258SEugene Krasnikov bss_conf->bssid, 9768e84c258SEugene Krasnikov vif->addr, 9778e84c258SEugene Krasnikov WCN36XX_HAL_LINK_IDLE_STATE); 9788e84c258SEugene Krasnikov } 9798e84c258SEugene Krasnikov } 9808e84c258SEugene Krasnikov 9818e84c258SEugene Krasnikov if (changed & BSS_CHANGED_AP_PROBE_RESP) { 9828e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac bss changed ap probe resp\n"); 9838e84c258SEugene Krasnikov skb = ieee80211_proberesp_get(hw, vif); 9848e84c258SEugene Krasnikov if (!skb) { 9858e84c258SEugene Krasnikov wcn36xx_err("failed to alloc probereq skb\n"); 9868e84c258SEugene Krasnikov goto out; 9878e84c258SEugene Krasnikov } 9888e84c258SEugene Krasnikov 9898e84c258SEugene Krasnikov wcn36xx_smd_update_proberesp_tmpl(wcn, vif, skb); 9908e84c258SEugene Krasnikov dev_kfree_skb(skb); 9918e84c258SEugene Krasnikov } 9928e84c258SEugene Krasnikov 993b3e3f871SChun-Yeow Yeoh if (changed & BSS_CHANGED_BEACON_ENABLED || 994b3e3f871SChun-Yeow Yeoh changed & BSS_CHANGED_BEACON) { 9958e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, 9968e84c258SEugene Krasnikov "mac bss changed beacon enabled %d\n", 9978e84c258SEugene Krasnikov bss_conf->enable_beacon); 9988e84c258SEugene Krasnikov 9998e84c258SEugene Krasnikov if (bss_conf->enable_beacon) { 1000908628dbSPontus Fuchs vif_priv->dtim_period = bss_conf->dtim_period; 100190023c03SPontus Fuchs vif_priv->bss_index = WCN36XX_HAL_BSS_INVALID_IDX; 10028e84c258SEugene Krasnikov wcn36xx_smd_config_bss(wcn, vif, NULL, 10038e84c258SEugene Krasnikov vif->addr, false); 10048e84c258SEugene Krasnikov skb = ieee80211_beacon_get_tim(hw, vif, &tim_off, 10058e84c258SEugene Krasnikov &tim_len); 10068e84c258SEugene Krasnikov if (!skb) { 10078e84c258SEugene Krasnikov wcn36xx_err("failed to alloc beacon skb\n"); 10088e84c258SEugene Krasnikov goto out; 10098e84c258SEugene Krasnikov } 10108e84c258SEugene Krasnikov wcn36xx_smd_send_beacon(wcn, vif, skb, tim_off, 0); 10118e84c258SEugene Krasnikov dev_kfree_skb(skb); 10128e84c258SEugene Krasnikov 10138e84c258SEugene Krasnikov if (vif->type == NL80211_IFTYPE_ADHOC || 10148e84c258SEugene Krasnikov vif->type == NL80211_IFTYPE_MESH_POINT) 10158e84c258SEugene Krasnikov link_state = WCN36XX_HAL_LINK_IBSS_STATE; 10168e84c258SEugene Krasnikov else 10178e84c258SEugene Krasnikov link_state = WCN36XX_HAL_LINK_AP_STATE; 10188e84c258SEugene Krasnikov 10198e84c258SEugene Krasnikov wcn36xx_smd_set_link_st(wcn, vif->addr, vif->addr, 10208e84c258SEugene Krasnikov link_state); 10218e84c258SEugene Krasnikov } else { 10225443918dSBjorn Andersson wcn36xx_smd_delete_bss(wcn, vif); 10238e84c258SEugene Krasnikov wcn36xx_smd_set_link_st(wcn, vif->addr, vif->addr, 10248e84c258SEugene Krasnikov WCN36XX_HAL_LINK_IDLE_STATE); 10258e84c258SEugene Krasnikov } 10268e84c258SEugene Krasnikov } 10278e84c258SEugene Krasnikov out: 102839efc7ccSBjorn Andersson 102939efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 10308e84c258SEugene Krasnikov } 10318e84c258SEugene Krasnikov 10328e84c258SEugene Krasnikov /* this is required when using IEEE80211_HW_HAS_RATE_CONTROL */ 10338e84c258SEugene Krasnikov static int wcn36xx_set_rts_threshold(struct ieee80211_hw *hw, u32 value) 10348e84c258SEugene Krasnikov { 10358e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 10368e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac set RTS threshold %d\n", value); 10378e84c258SEugene Krasnikov 103839efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 10398e84c258SEugene Krasnikov wcn36xx_smd_update_cfg(wcn, WCN36XX_HAL_CFG_RTS_THRESHOLD, value); 104039efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 104139efc7ccSBjorn Andersson 10428e84c258SEugene Krasnikov return 0; 10438e84c258SEugene Krasnikov } 10448e84c258SEugene Krasnikov 10458e84c258SEugene Krasnikov static void wcn36xx_remove_interface(struct ieee80211_hw *hw, 10468e84c258SEugene Krasnikov struct ieee80211_vif *vif) 10478e84c258SEugene Krasnikov { 10488e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 1049ce75877fSPontus Fuchs struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 10508e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac remove interface vif %p\n", vif); 10518e84c258SEugene Krasnikov 105239efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 105339efc7ccSBjorn Andersson 10548e84c258SEugene Krasnikov list_del(&vif_priv->list); 10558e84c258SEugene Krasnikov wcn36xx_smd_delete_sta_self(wcn, vif->addr); 105639efc7ccSBjorn Andersson 105739efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 10588e84c258SEugene Krasnikov } 10598e84c258SEugene Krasnikov 10608e84c258SEugene Krasnikov static int wcn36xx_add_interface(struct ieee80211_hw *hw, 10618e84c258SEugene Krasnikov struct ieee80211_vif *vif) 10628e84c258SEugene Krasnikov { 10638e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 1064ce75877fSPontus Fuchs struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 10658e84c258SEugene Krasnikov 10668e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac add interface vif %p type %d\n", 10678e84c258SEugene Krasnikov vif, vif->type); 10688e84c258SEugene Krasnikov 10698e84c258SEugene Krasnikov if (!(NL80211_IFTYPE_STATION == vif->type || 10708e84c258SEugene Krasnikov NL80211_IFTYPE_AP == vif->type || 10718e84c258SEugene Krasnikov NL80211_IFTYPE_ADHOC == vif->type || 10728e84c258SEugene Krasnikov NL80211_IFTYPE_MESH_POINT == vif->type)) { 10738e84c258SEugene Krasnikov wcn36xx_warn("Unsupported interface type requested: %d\n", 10748e84c258SEugene Krasnikov vif->type); 10758e84c258SEugene Krasnikov return -EOPNOTSUPP; 10768e84c258SEugene Krasnikov } 10778e84c258SEugene Krasnikov 107839efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 107939efc7ccSBjorn Andersson 10802edfcf2bSDaniel Mack vif_priv->bss_index = WCN36XX_HAL_BSS_INVALID_IDX; 1081e3160542SLoic Poulain INIT_LIST_HEAD(&vif_priv->sta_list); 10828e84c258SEugene Krasnikov list_add(&vif_priv->list, &wcn->vif_list); 10838e84c258SEugene Krasnikov wcn36xx_smd_add_sta_self(wcn, vif); 10848e84c258SEugene Krasnikov 108539efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 108639efc7ccSBjorn Andersson 10878e84c258SEugene Krasnikov return 0; 10888e84c258SEugene Krasnikov } 10898e84c258SEugene Krasnikov 10908e84c258SEugene Krasnikov static int wcn36xx_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 10918e84c258SEugene Krasnikov struct ieee80211_sta *sta) 10928e84c258SEugene Krasnikov { 10938e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 1094ce75877fSPontus Fuchs struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 1095a92e4696SPontus Fuchs struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(sta); 10968e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac sta add vif %p sta %pM\n", 10978e84c258SEugene Krasnikov vif, sta->addr); 10988e84c258SEugene Krasnikov 109939efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 110039efc7ccSBjorn Andersson 1101e26dc173SBob Copeland spin_lock_init(&sta_priv->ampdu_lock); 11028e84c258SEugene Krasnikov sta_priv->vif = vif_priv; 1103e3160542SLoic Poulain list_add(&sta_priv->list, &vif_priv->sta_list); 1104e3160542SLoic Poulain 11058e84c258SEugene Krasnikov /* 11068e84c258SEugene Krasnikov * For STA mode HW will be configured on BSS_CHANGED_ASSOC because 11078e84c258SEugene Krasnikov * at this stage AID is not available yet. 11088e84c258SEugene Krasnikov */ 11098e84c258SEugene Krasnikov if (NL80211_IFTYPE_STATION != vif->type) { 11108e84c258SEugene Krasnikov wcn36xx_update_allowed_rates(sta, WCN36XX_BAND(wcn)); 11118e84c258SEugene Krasnikov sta_priv->aid = sta->aid; 11128e84c258SEugene Krasnikov wcn36xx_smd_config_sta(wcn, vif, sta); 11138e84c258SEugene Krasnikov } 111439efc7ccSBjorn Andersson 111539efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 111639efc7ccSBjorn Andersson 11178e84c258SEugene Krasnikov return 0; 11188e84c258SEugene Krasnikov } 11198e84c258SEugene Krasnikov 11208e84c258SEugene Krasnikov static int wcn36xx_sta_remove(struct ieee80211_hw *hw, 11218e84c258SEugene Krasnikov struct ieee80211_vif *vif, 11228e84c258SEugene Krasnikov struct ieee80211_sta *sta) 11238e84c258SEugene Krasnikov { 11248e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 1125a92e4696SPontus Fuchs struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(sta); 11268e84c258SEugene Krasnikov 11278e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac sta remove vif %p sta %pM index %d\n", 11288e84c258SEugene Krasnikov vif, sta->addr, sta_priv->sta_index); 11298e84c258SEugene Krasnikov 113039efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 113139efc7ccSBjorn Andersson 1132e3160542SLoic Poulain list_del(&sta_priv->list); 11338e84c258SEugene Krasnikov wcn36xx_smd_delete_sta(wcn, sta_priv->sta_index); 11348e84c258SEugene Krasnikov sta_priv->vif = NULL; 113539efc7ccSBjorn Andersson 113639efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 113739efc7ccSBjorn Andersson 11388e84c258SEugene Krasnikov return 0; 11398e84c258SEugene Krasnikov } 11408e84c258SEugene Krasnikov 11418e84c258SEugene Krasnikov #ifdef CONFIG_PM 11428e84c258SEugene Krasnikov 1143f2f49601SBryan O'Donoghue static struct ieee80211_vif *wcn36xx_get_first_assoc_vif(struct wcn36xx *wcn) 1144f2f49601SBryan O'Donoghue { 1145f2f49601SBryan O'Donoghue struct wcn36xx_vif *vif_priv = NULL; 1146f2f49601SBryan O'Donoghue struct ieee80211_vif *vif = NULL; 1147f2f49601SBryan O'Donoghue 1148f2f49601SBryan O'Donoghue list_for_each_entry(vif_priv, &wcn->vif_list, list) { 1149f2f49601SBryan O'Donoghue if (vif_priv->sta_assoc) { 1150f2f49601SBryan O'Donoghue vif = wcn36xx_priv_to_vif(vif_priv); 1151f2f49601SBryan O'Donoghue break; 1152f2f49601SBryan O'Donoghue } 1153f2f49601SBryan O'Donoghue } 1154f2f49601SBryan O'Donoghue return vif; 1155f2f49601SBryan O'Donoghue } 1156f2f49601SBryan O'Donoghue 11578e84c258SEugene Krasnikov static int wcn36xx_suspend(struct ieee80211_hw *hw, struct cfg80211_wowlan *wow) 11588e84c258SEugene Krasnikov { 11598e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 1160f2f49601SBryan O'Donoghue struct ieee80211_vif *vif = NULL; 1161f2f49601SBryan O'Donoghue int ret = 0; 11628e84c258SEugene Krasnikov 11638e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac suspend\n"); 11648e84c258SEugene Krasnikov 1165f2f49601SBryan O'Donoghue mutex_lock(&wcn->conf_mutex); 1166ba4e9673SBryan O'Donoghue 11675478c41fSBryan O'Donoghue vif = wcn36xx_get_first_assoc_vif(wcn); 11685478c41fSBryan O'Donoghue if (vif) { 11695478c41fSBryan O'Donoghue ret = wcn36xx_smd_arp_offload(wcn, vif, true); 11705478c41fSBryan O'Donoghue if (ret) 11715478c41fSBryan O'Donoghue goto out; 11721456223cSBryan O'Donoghue ret = wcn36xx_smd_ipv6_ns_offload(wcn, vif, true); 11731456223cSBryan O'Donoghue if (ret) 11741456223cSBryan O'Donoghue goto out; 11756693f767SBryan O'Donoghue ret = wcn36xx_smd_gtk_offload(wcn, vif, true); 11766693f767SBryan O'Donoghue if (ret) 11776693f767SBryan O'Donoghue goto out; 11785478c41fSBryan O'Donoghue ret = wcn36xx_smd_set_power_params(wcn, true); 117960f0078bSBryan O'Donoghue if (ret) 118060f0078bSBryan O'Donoghue goto out; 118160f0078bSBryan O'Donoghue ret = wcn36xx_smd_wlan_host_suspend_ind(wcn); 11825478c41fSBryan O'Donoghue } 1183df069780SLoic Poulain 1184df069780SLoic Poulain /* Disable IRQ, we don't want to handle any packet before mac80211 is 1185df069780SLoic Poulain * resumed and ready to receive packets. 1186df069780SLoic Poulain */ 1187df069780SLoic Poulain disable_irq(wcn->tx_irq); 1188df069780SLoic Poulain disable_irq(wcn->rx_irq); 1189df069780SLoic Poulain 11905478c41fSBryan O'Donoghue out: 11915478c41fSBryan O'Donoghue mutex_unlock(&wcn->conf_mutex); 1192ba4e9673SBryan O'Donoghue return ret; 11938e84c258SEugene Krasnikov } 11948e84c258SEugene Krasnikov 11958e84c258SEugene Krasnikov static int wcn36xx_resume(struct ieee80211_hw *hw) 11968e84c258SEugene Krasnikov { 11978e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 1198f2f49601SBryan O'Donoghue struct ieee80211_vif *vif = NULL; 11998e84c258SEugene Krasnikov 12008e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac resume\n"); 12018e84c258SEugene Krasnikov 1202f2f49601SBryan O'Donoghue mutex_lock(&wcn->conf_mutex); 1203f2f49601SBryan O'Donoghue vif = wcn36xx_get_first_assoc_vif(wcn); 12045478c41fSBryan O'Donoghue if (vif) { 1205ebe7c1a6SBryan O'Donoghue wcn36xx_smd_host_resume(wcn); 12068e84c258SEugene Krasnikov wcn36xx_smd_set_power_params(wcn, false); 1207bedf1169SBryan O'Donoghue wcn36xx_smd_gtk_offload_get_info(wcn, vif); 12086693f767SBryan O'Donoghue wcn36xx_smd_gtk_offload(wcn, vif, false); 12091456223cSBryan O'Donoghue wcn36xx_smd_ipv6_ns_offload(wcn, vif, false); 12105478c41fSBryan O'Donoghue wcn36xx_smd_arp_offload(wcn, vif, false); 12115478c41fSBryan O'Donoghue } 1212df069780SLoic Poulain 1213df069780SLoic Poulain enable_irq(wcn->tx_irq); 1214df069780SLoic Poulain enable_irq(wcn->rx_irq); 1215df069780SLoic Poulain 1216f2f49601SBryan O'Donoghue mutex_unlock(&wcn->conf_mutex); 1217f2f49601SBryan O'Donoghue 12188e84c258SEugene Krasnikov return 0; 12198e84c258SEugene Krasnikov } 12208e84c258SEugene Krasnikov 12218974e591SBryan O'Donoghue static void wcn36xx_set_rekey_data(struct ieee80211_hw *hw, 12228974e591SBryan O'Donoghue struct ieee80211_vif *vif, 12238974e591SBryan O'Donoghue struct cfg80211_gtk_rekey_data *data) 12248974e591SBryan O'Donoghue { 12258974e591SBryan O'Donoghue struct wcn36xx *wcn = hw->priv; 12268974e591SBryan O'Donoghue struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 12278974e591SBryan O'Donoghue 12288974e591SBryan O'Donoghue mutex_lock(&wcn->conf_mutex); 12298974e591SBryan O'Donoghue 12308974e591SBryan O'Donoghue memcpy(vif_priv->rekey_data.kek, data->kek, NL80211_KEK_LEN); 12318974e591SBryan O'Donoghue memcpy(vif_priv->rekey_data.kck, data->kck, NL80211_KCK_LEN); 12328974e591SBryan O'Donoghue vif_priv->rekey_data.replay_ctr = 12338974e591SBryan O'Donoghue cpu_to_le64(be64_to_cpup((__be64 *)data->replay_ctr)); 12348974e591SBryan O'Donoghue vif_priv->rekey_data.valid = true; 12358974e591SBryan O'Donoghue 12368974e591SBryan O'Donoghue mutex_unlock(&wcn->conf_mutex); 12378974e591SBryan O'Donoghue } 12388974e591SBryan O'Donoghue 12398e84c258SEugene Krasnikov #endif 12408e84c258SEugene Krasnikov 12418e84c258SEugene Krasnikov static int wcn36xx_ampdu_action(struct ieee80211_hw *hw, 12428e84c258SEugene Krasnikov struct ieee80211_vif *vif, 124350ea05efSSara Sharon struct ieee80211_ampdu_params *params) 12448e84c258SEugene Krasnikov { 12458e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 1246a92e4696SPontus Fuchs struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(params->sta); 124750ea05efSSara Sharon struct ieee80211_sta *sta = params->sta; 124850ea05efSSara Sharon enum ieee80211_ampdu_mlme_action action = params->action; 124950ea05efSSara Sharon u16 tid = params->tid; 125050ea05efSSara Sharon u16 *ssn = ¶ms->ssn; 12512ce113deSJohannes Berg int ret = 0; 125223cddeb5SLoic Poulain int session; 12538e84c258SEugene Krasnikov 12548e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "mac ampdu action action %d tid %d\n", 12558e84c258SEugene Krasnikov action, tid); 12568e84c258SEugene Krasnikov 125739efc7ccSBjorn Andersson mutex_lock(&wcn->conf_mutex); 125839efc7ccSBjorn Andersson 12598e84c258SEugene Krasnikov switch (action) { 12608e84c258SEugene Krasnikov case IEEE80211_AMPDU_RX_START: 12618e84c258SEugene Krasnikov sta_priv->tid = tid; 1262ffe835aaSLoic Poulain session = wcn36xx_smd_add_ba_session(wcn, sta, tid, ssn, 0, 12638e84c258SEugene Krasnikov get_sta_index(vif, sta_priv)); 126423cddeb5SLoic Poulain if (session < 0) { 126523cddeb5SLoic Poulain ret = session; 126623cddeb5SLoic Poulain goto out; 126723cddeb5SLoic Poulain } 1268ffe835aaSLoic Poulain wcn36xx_smd_add_ba(wcn, session); 12698e84c258SEugene Krasnikov break; 12708e84c258SEugene Krasnikov case IEEE80211_AMPDU_RX_STOP: 127184da2a84SLoic Poulain wcn36xx_smd_del_ba(wcn, tid, 0, get_sta_index(vif, sta_priv)); 12728e84c258SEugene Krasnikov break; 12738e84c258SEugene Krasnikov case IEEE80211_AMPDU_TX_START: 1274e26dc173SBob Copeland spin_lock_bh(&sta_priv->ampdu_lock); 1275e26dc173SBob Copeland sta_priv->ampdu_state[tid] = WCN36XX_AMPDU_START; 1276e26dc173SBob Copeland spin_unlock_bh(&sta_priv->ampdu_lock); 1277e26dc173SBob Copeland 127823cddeb5SLoic Poulain /* Replace the mac80211 ssn with the firmware one */ 127923cddeb5SLoic Poulain wcn36xx_dbg(WCN36XX_DBG_MAC, "mac ampdu ssn = %u\n", *ssn); 128023cddeb5SLoic Poulain wcn36xx_smd_trigger_ba(wcn, get_sta_index(vif, sta_priv), tid, ssn); 128123cddeb5SLoic Poulain wcn36xx_dbg(WCN36XX_DBG_MAC, "mac ampdu fw-ssn = %u\n", *ssn); 128223cddeb5SLoic Poulain 128323cddeb5SLoic Poulain /* Start BA session */ 128423cddeb5SLoic Poulain session = wcn36xx_smd_add_ba_session(wcn, sta, tid, ssn, 1, 128523cddeb5SLoic Poulain get_sta_index(vif, sta_priv)); 128623cddeb5SLoic Poulain if (session < 0) { 128723cddeb5SLoic Poulain ret = session; 128823cddeb5SLoic Poulain goto out; 128923cddeb5SLoic Poulain } 12902ce113deSJohannes Berg ret = IEEE80211_AMPDU_TX_START_IMMEDIATE; 12918e84c258SEugene Krasnikov break; 12928e84c258SEugene Krasnikov case IEEE80211_AMPDU_TX_OPERATIONAL: 1293e26dc173SBob Copeland spin_lock_bh(&sta_priv->ampdu_lock); 1294e26dc173SBob Copeland sta_priv->ampdu_state[tid] = WCN36XX_AMPDU_OPERATIONAL; 1295e26dc173SBob Copeland spin_unlock_bh(&sta_priv->ampdu_lock); 1296e26dc173SBob Copeland 12978e84c258SEugene Krasnikov break; 12988e84c258SEugene Krasnikov case IEEE80211_AMPDU_TX_STOP_FLUSH: 12998e84c258SEugene Krasnikov case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: 13008e84c258SEugene Krasnikov case IEEE80211_AMPDU_TX_STOP_CONT: 1301e26dc173SBob Copeland spin_lock_bh(&sta_priv->ampdu_lock); 1302e26dc173SBob Copeland sta_priv->ampdu_state[tid] = WCN36XX_AMPDU_NONE; 1303e26dc173SBob Copeland spin_unlock_bh(&sta_priv->ampdu_lock); 1304e26dc173SBob Copeland 130584da2a84SLoic Poulain wcn36xx_smd_del_ba(wcn, tid, 1, get_sta_index(vif, sta_priv)); 13068e84c258SEugene Krasnikov ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); 13078e84c258SEugene Krasnikov break; 13088e84c258SEugene Krasnikov default: 13098e84c258SEugene Krasnikov wcn36xx_err("Unknown AMPDU action\n"); 13108e84c258SEugene Krasnikov } 13118e84c258SEugene Krasnikov 131223cddeb5SLoic Poulain out: 131339efc7ccSBjorn Andersson mutex_unlock(&wcn->conf_mutex); 131439efc7ccSBjorn Andersson 13152ce113deSJohannes Berg return ret; 13168e84c258SEugene Krasnikov } 13178e84c258SEugene Krasnikov 1318c7a61af5SBryan O'Donoghue #if IS_ENABLED(CONFIG_IPV6) 1319c7a61af5SBryan O'Donoghue static void wcn36xx_ipv6_addr_change(struct ieee80211_hw *hw, 1320c7a61af5SBryan O'Donoghue struct ieee80211_vif *vif, 1321c7a61af5SBryan O'Donoghue struct inet6_dev *idev) 1322c7a61af5SBryan O'Donoghue { 1323c7a61af5SBryan O'Donoghue struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif); 1324c7a61af5SBryan O'Donoghue struct inet6_ifaddr *ifa; 1325c7a61af5SBryan O'Donoghue int idx = 0; 1326c7a61af5SBryan O'Donoghue 1327c7a61af5SBryan O'Donoghue memset(vif_priv->tentative_addrs, 0, sizeof(vif_priv->tentative_addrs)); 1328c7a61af5SBryan O'Donoghue 1329c7a61af5SBryan O'Donoghue read_lock_bh(&idev->lock); 1330c7a61af5SBryan O'Donoghue list_for_each_entry(ifa, &idev->addr_list, if_list) { 1331c7a61af5SBryan O'Donoghue vif_priv->target_ipv6_addrs[idx] = ifa->addr; 1332c7a61af5SBryan O'Donoghue if (ifa->flags & IFA_F_TENTATIVE) 1333c7a61af5SBryan O'Donoghue __set_bit(idx, vif_priv->tentative_addrs); 1334c7a61af5SBryan O'Donoghue idx++; 1335c7a61af5SBryan O'Donoghue if (idx >= WCN36XX_HAL_IPV6_OFFLOAD_ADDR_MAX) 1336c7a61af5SBryan O'Donoghue break; 1337c7a61af5SBryan O'Donoghue wcn36xx_dbg(WCN36XX_DBG_MAC, "%pI6 %s\n", &ifa->addr, 1338c7a61af5SBryan O'Donoghue (ifa->flags & IFA_F_TENTATIVE) ? "tentative" : NULL); 1339c7a61af5SBryan O'Donoghue } 1340c7a61af5SBryan O'Donoghue read_unlock_bh(&idev->lock); 1341c7a61af5SBryan O'Donoghue 1342c7a61af5SBryan O'Donoghue vif_priv->num_target_ipv6_addrs = idx; 1343c7a61af5SBryan O'Donoghue } 1344c7a61af5SBryan O'Donoghue #endif 1345c7a61af5SBryan O'Donoghue 1346f02e1cc2SBenjamin Li static void wcn36xx_flush(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 1347f02e1cc2SBenjamin Li u32 queues, bool drop) 1348f02e1cc2SBenjamin Li { 1349f02e1cc2SBenjamin Li struct wcn36xx *wcn = hw->priv; 1350f02e1cc2SBenjamin Li 1351f02e1cc2SBenjamin Li if (wcn36xx_dxe_tx_flush(wcn)) { 1352f02e1cc2SBenjamin Li wcn36xx_err("Failed to flush hardware tx queues\n"); 1353f02e1cc2SBenjamin Li } 1354f02e1cc2SBenjamin Li } 1355f02e1cc2SBenjamin Li 13568e84c258SEugene Krasnikov static const struct ieee80211_ops wcn36xx_ops = { 13578e84c258SEugene Krasnikov .start = wcn36xx_start, 13588e84c258SEugene Krasnikov .stop = wcn36xx_stop, 13598e84c258SEugene Krasnikov .add_interface = wcn36xx_add_interface, 13608e84c258SEugene Krasnikov .remove_interface = wcn36xx_remove_interface, 13618e84c258SEugene Krasnikov #ifdef CONFIG_PM 13628e84c258SEugene Krasnikov .suspend = wcn36xx_suspend, 13638e84c258SEugene Krasnikov .resume = wcn36xx_resume, 13648974e591SBryan O'Donoghue .set_rekey_data = wcn36xx_set_rekey_data, 13658e84c258SEugene Krasnikov #endif 13668e84c258SEugene Krasnikov .config = wcn36xx_config, 136720a779edSPontus Fuchs .prepare_multicast = wcn36xx_prepare_multicast, 13688e84c258SEugene Krasnikov .configure_filter = wcn36xx_configure_filter, 13698e84c258SEugene Krasnikov .tx = wcn36xx_tx, 13708e84c258SEugene Krasnikov .set_key = wcn36xx_set_key, 137188603903SBjorn Andersson .hw_scan = wcn36xx_hw_scan, 137203c95dbeSBjorn Andersson .cancel_hw_scan = wcn36xx_cancel_hw_scan, 13735973a294SLoic Poulain .sw_scan_start = wcn36xx_sw_scan_start, 13745973a294SLoic Poulain .sw_scan_complete = wcn36xx_sw_scan_complete, 13758e84c258SEugene Krasnikov .bss_info_changed = wcn36xx_bss_info_changed, 13768e84c258SEugene Krasnikov .set_rts_threshold = wcn36xx_set_rts_threshold, 13778e84c258SEugene Krasnikov .sta_add = wcn36xx_sta_add, 13788e84c258SEugene Krasnikov .sta_remove = wcn36xx_sta_remove, 13798e84c258SEugene Krasnikov .ampdu_action = wcn36xx_ampdu_action, 1380c7a61af5SBryan O'Donoghue #if IS_ENABLED(CONFIG_IPV6) 1381c7a61af5SBryan O'Donoghue .ipv6_addr_change = wcn36xx_ipv6_addr_change, 1382c7a61af5SBryan O'Donoghue #endif 1383f02e1cc2SBenjamin Li .flush = wcn36xx_flush, 138487f825e6SEyal Ilsar 138587f825e6SEyal Ilsar CFG80211_TESTMODE_CMD(wcn36xx_tm_cmd) 13868e84c258SEugene Krasnikov }; 13878e84c258SEugene Krasnikov 1388b421d04eSBryan O'Donoghue static void 1389b421d04eSBryan O'Donoghue wcn36xx_set_ieee80211_vht_caps(struct ieee80211_sta_vht_cap *vht_cap) 1390b421d04eSBryan O'Donoghue { 1391b421d04eSBryan O'Donoghue vht_cap->vht_supported = true; 1392b421d04eSBryan O'Donoghue 1393b421d04eSBryan O'Donoghue vht_cap->cap = (IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_3895 | 1394b421d04eSBryan O'Donoghue IEEE80211_VHT_CAP_SHORT_GI_80 | 1395b421d04eSBryan O'Donoghue IEEE80211_VHT_CAP_RXSTBC_1 | 1396b421d04eSBryan O'Donoghue IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE | 1397b421d04eSBryan O'Donoghue IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE | 1398b421d04eSBryan O'Donoghue 3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT | 1399b421d04eSBryan O'Donoghue 7 << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT); 1400b421d04eSBryan O'Donoghue 1401b421d04eSBryan O'Donoghue vht_cap->vht_mcs.rx_mcs_map = 1402b421d04eSBryan O'Donoghue cpu_to_le16(IEEE80211_VHT_MCS_SUPPORT_0_9 | 1403b421d04eSBryan O'Donoghue IEEE80211_VHT_MCS_NOT_SUPPORTED << 2 | 1404b421d04eSBryan O'Donoghue IEEE80211_VHT_MCS_NOT_SUPPORTED << 4 | 1405b421d04eSBryan O'Donoghue IEEE80211_VHT_MCS_NOT_SUPPORTED << 6 | 1406b421d04eSBryan O'Donoghue IEEE80211_VHT_MCS_NOT_SUPPORTED << 8 | 1407b421d04eSBryan O'Donoghue IEEE80211_VHT_MCS_NOT_SUPPORTED << 10 | 1408b421d04eSBryan O'Donoghue IEEE80211_VHT_MCS_NOT_SUPPORTED << 12 | 1409b421d04eSBryan O'Donoghue IEEE80211_VHT_MCS_NOT_SUPPORTED << 14); 1410b421d04eSBryan O'Donoghue 1411b421d04eSBryan O'Donoghue vht_cap->vht_mcs.rx_highest = cpu_to_le16(433); 1412b421d04eSBryan O'Donoghue vht_cap->vht_mcs.tx_highest = vht_cap->vht_mcs.rx_highest; 1413b421d04eSBryan O'Donoghue 1414b421d04eSBryan O'Donoghue vht_cap->vht_mcs.tx_mcs_map = vht_cap->vht_mcs.rx_mcs_map; 1415b421d04eSBryan O'Donoghue } 1416b421d04eSBryan O'Donoghue 14178e84c258SEugene Krasnikov static int wcn36xx_init_ieee80211(struct wcn36xx *wcn) 14188e84c258SEugene Krasnikov { 14198e84c258SEugene Krasnikov static const u32 cipher_suites[] = { 14208e84c258SEugene Krasnikov WLAN_CIPHER_SUITE_WEP40, 14218e84c258SEugene Krasnikov WLAN_CIPHER_SUITE_WEP104, 14228e84c258SEugene Krasnikov WLAN_CIPHER_SUITE_TKIP, 14238e84c258SEugene Krasnikov WLAN_CIPHER_SUITE_CCMP, 14248e84c258SEugene Krasnikov }; 14258e84c258SEugene Krasnikov 142630686bf7SJohannes Berg ieee80211_hw_set(wcn->hw, TIMING_BEACON_ONLY); 142730686bf7SJohannes Berg ieee80211_hw_set(wcn->hw, AMPDU_AGGREGATION); 142830686bf7SJohannes Berg ieee80211_hw_set(wcn->hw, SUPPORTS_PS); 142930686bf7SJohannes Berg ieee80211_hw_set(wcn->hw, SIGNAL_DBM); 143030686bf7SJohannes Berg ieee80211_hw_set(wcn->hw, HAS_RATE_CONTROL); 143188603903SBjorn Andersson ieee80211_hw_set(wcn->hw, SINGLE_SCAN_ON_ALL_BANDS); 1432fdf21cc3SLoic Poulain ieee80211_hw_set(wcn->hw, REPORTS_TX_ACK_STATUS); 14338e84c258SEugene Krasnikov 14348e84c258SEugene Krasnikov wcn->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 14358e84c258SEugene Krasnikov BIT(NL80211_IFTYPE_AP) | 14368e84c258SEugene Krasnikov BIT(NL80211_IFTYPE_ADHOC) | 14378e84c258SEugene Krasnikov BIT(NL80211_IFTYPE_MESH_POINT); 14388e84c258SEugene Krasnikov 143957fbcce3SJohannes Berg wcn->hw->wiphy->bands[NL80211_BAND_2GHZ] = &wcn_band_2ghz; 1440fd52bdaeSLoic Poulain if (wcn->rf_id != RF_IRIS_WCN3620) 144157fbcce3SJohannes Berg wcn->hw->wiphy->bands[NL80211_BAND_5GHZ] = &wcn_band_5ghz; 14428e84c258SEugene Krasnikov 1443b421d04eSBryan O'Donoghue if (wcn->rf_id == RF_IRIS_WCN3680) 1444b421d04eSBryan O'Donoghue wcn36xx_set_ieee80211_vht_caps(&wcn_band_5ghz.vht_cap); 1445b421d04eSBryan O'Donoghue 144688603903SBjorn Andersson wcn->hw->wiphy->max_scan_ssids = WCN36XX_MAX_SCAN_SSIDS; 144788603903SBjorn Andersson wcn->hw->wiphy->max_scan_ie_len = WCN36XX_MAX_SCAN_IE_LEN; 144888603903SBjorn Andersson 14498e84c258SEugene Krasnikov wcn->hw->wiphy->cipher_suites = cipher_suites; 14508e84c258SEugene Krasnikov wcn->hw->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 14518e84c258SEugene Krasnikov 14528e84c258SEugene Krasnikov #ifdef CONFIG_PM 14538e84c258SEugene Krasnikov wcn->hw->wiphy->wowlan = &wowlan_support; 14548e84c258SEugene Krasnikov #endif 14558e84c258SEugene Krasnikov 14568e84c258SEugene Krasnikov wcn->hw->max_listen_interval = 200; 14578e84c258SEugene Krasnikov 14588e84c258SEugene Krasnikov wcn->hw->queues = 4; 14598e84c258SEugene Krasnikov 14608e84c258SEugene Krasnikov SET_IEEE80211_DEV(wcn->hw, wcn->dev); 14618e84c258SEugene Krasnikov 14628e84c258SEugene Krasnikov wcn->hw->sta_data_size = sizeof(struct wcn36xx_sta); 14638e84c258SEugene Krasnikov wcn->hw->vif_data_size = sizeof(struct wcn36xx_vif); 14648e84c258SEugene Krasnikov 1465ae44b502SAndrew Zaborowski wiphy_ext_feature_set(wcn->hw->wiphy, 1466ae44b502SAndrew Zaborowski NL80211_EXT_FEATURE_CQM_RSSI_LIST); 1467ae44b502SAndrew Zaborowski 1468f0eea277SDaniel Mack return 0; 14698e84c258SEugene Krasnikov } 14708e84c258SEugene Krasnikov 14718e84c258SEugene Krasnikov static int wcn36xx_platform_get_resources(struct wcn36xx *wcn, 14728e84c258SEugene Krasnikov struct platform_device *pdev) 14738e84c258SEugene Krasnikov { 147405ddce49SBjorn Andersson struct device_node *mmio_node; 1475fd52bdaeSLoic Poulain struct device_node *iris_node; 147605ddce49SBjorn Andersson int index; 147705ddce49SBjorn Andersson int ret; 147805ddce49SBjorn Andersson 14798e84c258SEugene Krasnikov /* Set TX IRQ */ 1480d17efe4fSLad Prabhakar ret = platform_get_irq_byname(pdev, "tx"); 1481d17efe4fSLad Prabhakar if (ret < 0) 1482d17efe4fSLad Prabhakar return ret; 1483d17efe4fSLad Prabhakar wcn->tx_irq = ret; 14848e84c258SEugene Krasnikov 14858e84c258SEugene Krasnikov /* Set RX IRQ */ 1486d17efe4fSLad Prabhakar ret = platform_get_irq_byname(pdev, "rx"); 1487d17efe4fSLad Prabhakar if (ret < 0) 1488d17efe4fSLad Prabhakar return ret; 1489d17efe4fSLad Prabhakar wcn->rx_irq = ret; 14908e84c258SEugene Krasnikov 1491f303a931SBjorn Andersson /* Acquire SMSM tx enable handle */ 1492f303a931SBjorn Andersson wcn->tx_enable_state = qcom_smem_state_get(&pdev->dev, 1493f303a931SBjorn Andersson "tx-enable", &wcn->tx_enable_state_bit); 1494f303a931SBjorn Andersson if (IS_ERR(wcn->tx_enable_state)) { 1495f303a931SBjorn Andersson wcn36xx_err("failed to get tx-enable state\n"); 1496f303a931SBjorn Andersson return PTR_ERR(wcn->tx_enable_state); 1497f303a931SBjorn Andersson } 1498f303a931SBjorn Andersson 1499f303a931SBjorn Andersson /* Acquire SMSM tx rings empty handle */ 1500f303a931SBjorn Andersson wcn->tx_rings_empty_state = qcom_smem_state_get(&pdev->dev, 1501f303a931SBjorn Andersson "tx-rings-empty", &wcn->tx_rings_empty_state_bit); 1502f303a931SBjorn Andersson if (IS_ERR(wcn->tx_rings_empty_state)) { 1503f303a931SBjorn Andersson wcn36xx_err("failed to get tx-rings-empty state\n"); 1504f303a931SBjorn Andersson return PTR_ERR(wcn->tx_rings_empty_state); 1505f303a931SBjorn Andersson } 1506f303a931SBjorn Andersson 150705ddce49SBjorn Andersson mmio_node = of_parse_phandle(pdev->dev.parent->of_node, "qcom,mmio", 0); 150805ddce49SBjorn Andersson if (!mmio_node) { 150905ddce49SBjorn Andersson wcn36xx_err("failed to acquire qcom,mmio reference\n"); 151005ddce49SBjorn Andersson return -EINVAL; 15118e84c258SEugene Krasnikov } 151205ddce49SBjorn Andersson 15136f10b4e1SBjorn Andersson wcn->is_pronto = !!of_device_is_compatible(mmio_node, "qcom,pronto"); 15146f10b4e1SBjorn Andersson 151505ddce49SBjorn Andersson /* Map the CCU memory */ 151605ddce49SBjorn Andersson index = of_property_match_string(mmio_node, "reg-names", "ccu"); 151705ddce49SBjorn Andersson wcn->ccu_base = of_iomap(mmio_node, index); 151805ddce49SBjorn Andersson if (!wcn->ccu_base) { 151905ddce49SBjorn Andersson wcn36xx_err("failed to map ccu memory\n"); 152005ddce49SBjorn Andersson ret = -ENOMEM; 152105ddce49SBjorn Andersson goto put_mmio_node; 15228e84c258SEugene Krasnikov } 152305ddce49SBjorn Andersson 152405ddce49SBjorn Andersson /* Map the DXE memory */ 152505ddce49SBjorn Andersson index = of_property_match_string(mmio_node, "reg-names", "dxe"); 152605ddce49SBjorn Andersson wcn->dxe_base = of_iomap(mmio_node, index); 152705ddce49SBjorn Andersson if (!wcn->dxe_base) { 152805ddce49SBjorn Andersson wcn36xx_err("failed to map dxe memory\n"); 152905ddce49SBjorn Andersson ret = -ENOMEM; 153005ddce49SBjorn Andersson goto unmap_ccu; 153105ddce49SBjorn Andersson } 153205ddce49SBjorn Andersson 1533fd52bdaeSLoic Poulain /* External RF module */ 15341967c128SJohan Hovold iris_node = of_get_child_by_name(mmio_node, "iris"); 1535fd52bdaeSLoic Poulain if (iris_node) { 1536fd52bdaeSLoic Poulain if (of_device_is_compatible(iris_node, "qcom,wcn3620")) 1537fd52bdaeSLoic Poulain wcn->rf_id = RF_IRIS_WCN3620; 15388490987bSBryan O'Donoghue if (of_device_is_compatible(iris_node, "qcom,wcn3680")) 15398490987bSBryan O'Donoghue wcn->rf_id = RF_IRIS_WCN3680; 1540fd52bdaeSLoic Poulain of_node_put(iris_node); 1541fd52bdaeSLoic Poulain } 1542fd52bdaeSLoic Poulain 154305ddce49SBjorn Andersson of_node_put(mmio_node); 15448e84c258SEugene Krasnikov return 0; 154505ddce49SBjorn Andersson 154605ddce49SBjorn Andersson unmap_ccu: 154705ddce49SBjorn Andersson iounmap(wcn->ccu_base); 154805ddce49SBjorn Andersson put_mmio_node: 154905ddce49SBjorn Andersson of_node_put(mmio_node); 155005ddce49SBjorn Andersson return ret; 15518e84c258SEugene Krasnikov } 15528e84c258SEugene Krasnikov 15538e84c258SEugene Krasnikov static int wcn36xx_probe(struct platform_device *pdev) 15548e84c258SEugene Krasnikov { 15558e84c258SEugene Krasnikov struct ieee80211_hw *hw; 15568e84c258SEugene Krasnikov struct wcn36xx *wcn; 1557f303a931SBjorn Andersson void *wcnss; 15588e84c258SEugene Krasnikov int ret; 1559f303a931SBjorn Andersson const u8 *addr; 15608e84c258SEugene Krasnikov 15618e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "platform probe\n"); 15628e84c258SEugene Krasnikov 1563f303a931SBjorn Andersson wcnss = dev_get_drvdata(pdev->dev.parent); 1564f303a931SBjorn Andersson 15658e84c258SEugene Krasnikov hw = ieee80211_alloc_hw(sizeof(struct wcn36xx), &wcn36xx_ops); 15668e84c258SEugene Krasnikov if (!hw) { 15678e84c258SEugene Krasnikov wcn36xx_err("failed to alloc hw\n"); 15688e84c258SEugene Krasnikov ret = -ENOMEM; 15698e84c258SEugene Krasnikov goto out_err; 15708e84c258SEugene Krasnikov } 15718e84c258SEugene Krasnikov platform_set_drvdata(pdev, hw); 15728e84c258SEugene Krasnikov wcn = hw->priv; 15738e84c258SEugene Krasnikov wcn->hw = hw; 15748e84c258SEugene Krasnikov wcn->dev = &pdev->dev; 15756b8a127bSRamon Fried wcn->first_boot = true; 157639efc7ccSBjorn Andersson mutex_init(&wcn->conf_mutex); 15778e84c258SEugene Krasnikov mutex_init(&wcn->hal_mutex); 157888603903SBjorn Andersson mutex_init(&wcn->scan_lock); 1579a224b47aSLoic Poulain __skb_queue_head_init(&wcn->amsdu); 158088603903SBjorn Andersson 1581ef486675SBryan O'Donoghue wcn->hal_buf = devm_kmalloc(wcn->dev, WCN36XX_HAL_BUF_SIZE, GFP_KERNEL); 1582ef486675SBryan O'Donoghue if (!wcn->hal_buf) { 1583ef486675SBryan O'Donoghue ret = -ENOMEM; 1584ef486675SBryan O'Donoghue goto out_wq; 1585ef486675SBryan O'Donoghue } 1586ef486675SBryan O'Donoghue 158757e06e0eSDaniel Mack ret = dma_set_mask_and_coherent(wcn->dev, DMA_BIT_MASK(32)); 158857e06e0eSDaniel Mack if (ret < 0) { 158957e06e0eSDaniel Mack wcn36xx_err("failed to set DMA mask: %d\n", ret); 159057e06e0eSDaniel Mack goto out_wq; 159157e06e0eSDaniel Mack } 159257e06e0eSDaniel Mack 1593b7f96d5cSBjorn Andersson wcn->nv_file = WLAN_NV_FILE; 1594b7f96d5cSBjorn Andersson ret = of_property_read_string(wcn->dev->parent->of_node, "firmware-name", &wcn->nv_file); 1595b7f96d5cSBjorn Andersson if (ret < 0 && ret != -EINVAL) { 1596b7f96d5cSBjorn Andersson wcn36xx_err("failed to read \"firmware-name\" property: %d\n", ret); 1597b7f96d5cSBjorn Andersson goto out_wq; 1598b7f96d5cSBjorn Andersson } 1599b7f96d5cSBjorn Andersson 16005052de8dSBjorn Andersson wcn->smd_channel = qcom_wcnss_open_channel(wcnss, "WLAN_CTRL", wcn36xx_smd_rsp_process, hw); 1601f303a931SBjorn Andersson if (IS_ERR(wcn->smd_channel)) { 1602f303a931SBjorn Andersson wcn36xx_err("failed to open WLAN_CTRL channel\n"); 1603f303a931SBjorn Andersson ret = PTR_ERR(wcn->smd_channel); 1604f303a931SBjorn Andersson goto out_wq; 1605f303a931SBjorn Andersson } 1606f303a931SBjorn Andersson 1607f303a931SBjorn Andersson addr = of_get_property(pdev->dev.of_node, "local-mac-address", &ret); 1608f303a931SBjorn Andersson if (addr && ret != ETH_ALEN) { 1609f303a931SBjorn Andersson wcn36xx_err("invalid local-mac-address\n"); 1610f303a931SBjorn Andersson ret = -EINVAL; 1611a86308fcSChristophe JAILLET goto out_destroy_ept; 1612f303a931SBjorn Andersson } else if (addr) { 16138e84c258SEugene Krasnikov wcn36xx_info("mac address: %pM\n", addr); 16148e84c258SEugene Krasnikov SET_IEEE80211_PERM_ADDR(wcn->hw, addr); 16158e84c258SEugene Krasnikov } 16168e84c258SEugene Krasnikov 16178e84c258SEugene Krasnikov ret = wcn36xx_platform_get_resources(wcn, pdev); 16188e84c258SEugene Krasnikov if (ret) 1619a86308fcSChristophe JAILLET goto out_destroy_ept; 16208e84c258SEugene Krasnikov 16218e84c258SEugene Krasnikov wcn36xx_init_ieee80211(wcn); 16228e84c258SEugene Krasnikov ret = ieee80211_register_hw(wcn->hw); 16238e84c258SEugene Krasnikov if (ret) 16248e84c258SEugene Krasnikov goto out_unmap; 16258e84c258SEugene Krasnikov 16268e84c258SEugene Krasnikov return 0; 16278e84c258SEugene Krasnikov 16288e84c258SEugene Krasnikov out_unmap: 162905ddce49SBjorn Andersson iounmap(wcn->ccu_base); 163005ddce49SBjorn Andersson iounmap(wcn->dxe_base); 1631a86308fcSChristophe JAILLET out_destroy_ept: 1632a86308fcSChristophe JAILLET rpmsg_destroy_ept(wcn->smd_channel); 16338e84c258SEugene Krasnikov out_wq: 16348e84c258SEugene Krasnikov ieee80211_free_hw(hw); 16358e84c258SEugene Krasnikov out_err: 16368e84c258SEugene Krasnikov return ret; 16378e84c258SEugene Krasnikov } 1638f303a931SBjorn Andersson 16398e84c258SEugene Krasnikov static int wcn36xx_remove(struct platform_device *pdev) 16408e84c258SEugene Krasnikov { 16418e84c258SEugene Krasnikov struct ieee80211_hw *hw = platform_get_drvdata(pdev); 16428e84c258SEugene Krasnikov struct wcn36xx *wcn = hw->priv; 16438e84c258SEugene Krasnikov wcn36xx_dbg(WCN36XX_DBG_MAC, "platform remove\n"); 16448e84c258SEugene Krasnikov 16454bda7fafSPontus Fuchs release_firmware(wcn->nv); 16468e84c258SEugene Krasnikov 16478e84c258SEugene Krasnikov ieee80211_unregister_hw(hw); 1648f303a931SBjorn Andersson 1649f303a931SBjorn Andersson qcom_smem_state_put(wcn->tx_enable_state); 1650f303a931SBjorn Andersson qcom_smem_state_put(wcn->tx_rings_empty_state); 1651f303a931SBjorn Andersson 1652efad8396SBjorn Andersson rpmsg_destroy_ept(wcn->smd_channel); 1653efad8396SBjorn Andersson 165405ddce49SBjorn Andersson iounmap(wcn->dxe_base); 165505ddce49SBjorn Andersson iounmap(wcn->ccu_base); 1656d5362888SBjorn Andersson 1657a224b47aSLoic Poulain __skb_queue_purge(&wcn->amsdu); 1658a224b47aSLoic Poulain 1659d5362888SBjorn Andersson mutex_destroy(&wcn->hal_mutex); 16608e84c258SEugene Krasnikov ieee80211_free_hw(hw); 16618e84c258SEugene Krasnikov 16628e84c258SEugene Krasnikov return 0; 16638e84c258SEugene Krasnikov } 1664f303a931SBjorn Andersson 1665f303a931SBjorn Andersson static const struct of_device_id wcn36xx_of_match[] = { 1666f303a931SBjorn Andersson { .compatible = "qcom,wcnss-wlan" }, 16678e84c258SEugene Krasnikov {} 16688e84c258SEugene Krasnikov }; 1669f303a931SBjorn Andersson MODULE_DEVICE_TABLE(of, wcn36xx_of_match); 16708e84c258SEugene Krasnikov 16718e84c258SEugene Krasnikov static struct platform_driver wcn36xx_driver = { 16728e84c258SEugene Krasnikov .probe = wcn36xx_probe, 16738e84c258SEugene Krasnikov .remove = wcn36xx_remove, 16748e84c258SEugene Krasnikov .driver = { 16758e84c258SEugene Krasnikov .name = "wcn36xx", 1676f303a931SBjorn Andersson .of_match_table = wcn36xx_of_match, 16778e84c258SEugene Krasnikov }, 16788e84c258SEugene Krasnikov }; 16798e84c258SEugene Krasnikov 1680f303a931SBjorn Andersson module_platform_driver(wcn36xx_driver); 16818e84c258SEugene Krasnikov 16828e84c258SEugene Krasnikov MODULE_LICENSE("Dual BSD/GPL"); 16838e84c258SEugene Krasnikov MODULE_AUTHOR("Eugene Krasnikov k.eugene.e@gmail.com"); 16848e84c258SEugene Krasnikov MODULE_FIRMWARE(WLAN_NV_FILE); 1685