diff options
Diffstat (limited to 'drivers/net/wireless/ath/wcn36xx/main.c')
| -rw-r--r-- | drivers/net/wireless/ath/wcn36xx/main.c | 1036 |
1 files changed, 1036 insertions, 0 deletions
diff --git a/drivers/net/wireless/ath/wcn36xx/main.c b/drivers/net/wireless/ath/wcn36xx/main.c new file mode 100644 index 000000000000..7839b31e4826 --- /dev/null +++ b/drivers/net/wireless/ath/wcn36xx/main.c | |||
| @@ -0,0 +1,1036 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2013 Eugene Krasnikov <k.eugene.e@gmail.com> | ||
| 3 | * | ||
| 4 | * Permission to use, copy, modify, and/or distribute this software for any | ||
| 5 | * purpose with or without fee is hereby granted, provided that the above | ||
| 6 | * copyright notice and this permission notice appear in all copies. | ||
| 7 | * | ||
| 8 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | ||
| 9 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | ||
| 10 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY | ||
| 11 | * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | ||
| 12 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION | ||
| 13 | * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN | ||
| 14 | * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | ||
| 15 | */ | ||
| 16 | |||
| 17 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
| 18 | |||
| 19 | #include <linux/module.h> | ||
| 20 | #include <linux/platform_device.h> | ||
| 21 | #include "wcn36xx.h" | ||
| 22 | |||
| 23 | unsigned int wcn36xx_dbg_mask; | ||
| 24 | module_param_named(debug_mask, wcn36xx_dbg_mask, uint, 0644); | ||
| 25 | MODULE_PARM_DESC(debug_mask, "Debugging mask"); | ||
| 26 | |||
| 27 | #define CHAN2G(_freq, _idx) { \ | ||
| 28 | .band = IEEE80211_BAND_2GHZ, \ | ||
| 29 | .center_freq = (_freq), \ | ||
| 30 | .hw_value = (_idx), \ | ||
| 31 | .max_power = 25, \ | ||
| 32 | } | ||
| 33 | |||
| 34 | #define CHAN5G(_freq, _idx) { \ | ||
| 35 | .band = IEEE80211_BAND_5GHZ, \ | ||
| 36 | .center_freq = (_freq), \ | ||
| 37 | .hw_value = (_idx), \ | ||
| 38 | .max_power = 25, \ | ||
| 39 | } | ||
| 40 | |||
| 41 | /* The wcn firmware expects channel values to matching | ||
| 42 | * their mnemonic values. So use these for .hw_value. */ | ||
| 43 | static struct ieee80211_channel wcn_2ghz_channels[] = { | ||
| 44 | CHAN2G(2412, 1), /* Channel 1 */ | ||
| 45 | CHAN2G(2417, 2), /* Channel 2 */ | ||
| 46 | CHAN2G(2422, 3), /* Channel 3 */ | ||
| 47 | CHAN2G(2427, 4), /* Channel 4 */ | ||
| 48 | CHAN2G(2432, 5), /* Channel 5 */ | ||
| 49 | CHAN2G(2437, 6), /* Channel 6 */ | ||
| 50 | CHAN2G(2442, 7), /* Channel 7 */ | ||
| 51 | CHAN2G(2447, 8), /* Channel 8 */ | ||
| 52 | CHAN2G(2452, 9), /* Channel 9 */ | ||
| 53 | CHAN2G(2457, 10), /* Channel 10 */ | ||
| 54 | CHAN2G(2462, 11), /* Channel 11 */ | ||
| 55 | CHAN2G(2467, 12), /* Channel 12 */ | ||
| 56 | CHAN2G(2472, 13), /* Channel 13 */ | ||
| 57 | CHAN2G(2484, 14) /* Channel 14 */ | ||
| 58 | |||
| 59 | }; | ||
| 60 | |||
| 61 | static struct ieee80211_channel wcn_5ghz_channels[] = { | ||
| 62 | CHAN5G(5180, 36), | ||
| 63 | CHAN5G(5200, 40), | ||
| 64 | CHAN5G(5220, 44), | ||
| 65 | CHAN5G(5240, 48), | ||
| 66 | CHAN5G(5260, 52), | ||
| 67 | CHAN5G(5280, 56), | ||
| 68 | CHAN5G(5300, 60), | ||
| 69 | CHAN5G(5320, 64), | ||
| 70 | CHAN5G(5500, 100), | ||
| 71 | CHAN5G(5520, 104), | ||
| 72 | CHAN5G(5540, 108), | ||
| 73 | CHAN5G(5560, 112), | ||
| 74 | CHAN5G(5580, 116), | ||
| 75 | CHAN5G(5600, 120), | ||
| 76 | CHAN5G(5620, 124), | ||
| 77 | CHAN5G(5640, 128), | ||
| 78 | CHAN5G(5660, 132), | ||
| 79 | CHAN5G(5700, 140), | ||
| 80 | CHAN5G(5745, 149), | ||
| 81 | CHAN5G(5765, 153), | ||
| 82 | CHAN5G(5785, 157), | ||
| 83 | CHAN5G(5805, 161), | ||
| 84 | CHAN5G(5825, 165) | ||
| 85 | }; | ||
| 86 | |||
| 87 | #define RATE(_bitrate, _hw_rate, _flags) { \ | ||
| 88 | .bitrate = (_bitrate), \ | ||
| 89 | .flags = (_flags), \ | ||
| 90 | .hw_value = (_hw_rate), \ | ||
| 91 | .hw_value_short = (_hw_rate) \ | ||
| 92 | } | ||
| 93 | |||
| 94 | static struct ieee80211_rate wcn_2ghz_rates[] = { | ||
| 95 | RATE(10, HW_RATE_INDEX_1MBPS, 0), | ||
| 96 | RATE(20, HW_RATE_INDEX_2MBPS, IEEE80211_RATE_SHORT_PREAMBLE), | ||
| 97 | RATE(55, HW_RATE_INDEX_5_5MBPS, IEEE80211_RATE_SHORT_PREAMBLE), | ||
| 98 | RATE(110, HW_RATE_INDEX_11MBPS, IEEE80211_RATE_SHORT_PREAMBLE), | ||
| 99 | RATE(60, HW_RATE_INDEX_6MBPS, 0), | ||
| 100 | RATE(90, HW_RATE_INDEX_9MBPS, 0), | ||
| 101 | RATE(120, HW_RATE_INDEX_12MBPS, 0), | ||
| 102 | RATE(180, HW_RATE_INDEX_18MBPS, 0), | ||
| 103 | RATE(240, HW_RATE_INDEX_24MBPS, 0), | ||
| 104 | RATE(360, HW_RATE_INDEX_36MBPS, 0), | ||
| 105 | RATE(480, HW_RATE_INDEX_48MBPS, 0), | ||
| 106 | RATE(540, HW_RATE_INDEX_54MBPS, 0) | ||
| 107 | }; | ||
| 108 | |||
| 109 | static struct ieee80211_rate wcn_5ghz_rates[] = { | ||
| 110 | RATE(60, HW_RATE_INDEX_6MBPS, 0), | ||
| 111 | RATE(90, HW_RATE_INDEX_9MBPS, 0), | ||
| 112 | RATE(120, HW_RATE_INDEX_12MBPS, 0), | ||
| 113 | RATE(180, HW_RATE_INDEX_18MBPS, 0), | ||
| 114 | RATE(240, HW_RATE_INDEX_24MBPS, 0), | ||
| 115 | RATE(360, HW_RATE_INDEX_36MBPS, 0), | ||
| 116 | RATE(480, HW_RATE_INDEX_48MBPS, 0), | ||
| 117 | RATE(540, HW_RATE_INDEX_54MBPS, 0) | ||
| 118 | }; | ||
| 119 | |||
| 120 | static struct ieee80211_supported_band wcn_band_2ghz = { | ||
| 121 | .channels = wcn_2ghz_channels, | ||
| 122 | .n_channels = ARRAY_SIZE(wcn_2ghz_channels), | ||
| 123 | .bitrates = wcn_2ghz_rates, | ||
| 124 | .n_bitrates = ARRAY_SIZE(wcn_2ghz_rates), | ||
| 125 | .ht_cap = { | ||
| 126 | .cap = IEEE80211_HT_CAP_GRN_FLD | | ||
| 127 | IEEE80211_HT_CAP_SGI_20 | | ||
| 128 | IEEE80211_HT_CAP_DSSSCCK40 | | ||
| 129 | IEEE80211_HT_CAP_LSIG_TXOP_PROT, | ||
| 130 | .ht_supported = true, | ||
| 131 | .ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K, | ||
| 132 | .ampdu_density = IEEE80211_HT_MPDU_DENSITY_16, | ||
| 133 | .mcs = { | ||
| 134 | .rx_mask = { 0xff, 0, 0, 0, 0, 0, 0, 0, 0, 0, }, | ||
| 135 | .rx_highest = cpu_to_le16(72), | ||
| 136 | .tx_params = IEEE80211_HT_MCS_TX_DEFINED, | ||
| 137 | } | ||
| 138 | } | ||
| 139 | }; | ||
| 140 | |||
| 141 | static struct ieee80211_supported_band wcn_band_5ghz = { | ||
| 142 | .channels = wcn_5ghz_channels, | ||
| 143 | .n_channels = ARRAY_SIZE(wcn_5ghz_channels), | ||
| 144 | .bitrates = wcn_5ghz_rates, | ||
| 145 | .n_bitrates = ARRAY_SIZE(wcn_5ghz_rates), | ||
| 146 | .ht_cap = { | ||
| 147 | .cap = IEEE80211_HT_CAP_GRN_FLD | | ||
| 148 | IEEE80211_HT_CAP_SGI_20 | | ||
| 149 | IEEE80211_HT_CAP_DSSSCCK40 | | ||
| 150 | IEEE80211_HT_CAP_LSIG_TXOP_PROT | | ||
| 151 | IEEE80211_HT_CAP_SGI_40 | | ||
| 152 | IEEE80211_HT_CAP_SUP_WIDTH_20_40, | ||
| 153 | .ht_supported = true, | ||
| 154 | .ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K, | ||
| 155 | .ampdu_density = IEEE80211_HT_MPDU_DENSITY_16, | ||
| 156 | .mcs = { | ||
| 157 | .rx_mask = { 0xff, 0, 0, 0, 0, 0, 0, 0, 0, 0, }, | ||
| 158 | .rx_highest = cpu_to_le16(72), | ||
| 159 | .tx_params = IEEE80211_HT_MCS_TX_DEFINED, | ||
| 160 | } | ||
| 161 | } | ||
| 162 | }; | ||
| 163 | |||
| 164 | #ifdef CONFIG_PM | ||
| 165 | |||
| 166 | static const struct wiphy_wowlan_support wowlan_support = { | ||
| 167 | .flags = WIPHY_WOWLAN_ANY | ||
| 168 | }; | ||
| 169 | |||
| 170 | #endif | ||
| 171 | |||
| 172 | static inline u8 get_sta_index(struct ieee80211_vif *vif, | ||
| 173 | struct wcn36xx_sta *sta_priv) | ||
| 174 | { | ||
| 175 | return NL80211_IFTYPE_STATION == vif->type ? | ||
| 176 | sta_priv->bss_sta_index : | ||
| 177 | sta_priv->sta_index; | ||
| 178 | } | ||
| 179 | |||
| 180 | static int wcn36xx_start(struct ieee80211_hw *hw) | ||
| 181 | { | ||
| 182 | struct wcn36xx *wcn = hw->priv; | ||
| 183 | int ret; | ||
| 184 | |||
| 185 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac start\n"); | ||
| 186 | |||
| 187 | /* SMD initialization */ | ||
| 188 | ret = wcn36xx_smd_open(wcn); | ||
| 189 | if (ret) { | ||
| 190 | wcn36xx_err("Failed to open smd channel: %d\n", ret); | ||
| 191 | goto out_err; | ||
| 192 | } | ||
| 193 | |||
| 194 | /* Allocate memory pools for Mgmt BD headers and Data BD headers */ | ||
| 195 | ret = wcn36xx_dxe_allocate_mem_pools(wcn); | ||
| 196 | if (ret) { | ||
| 197 | wcn36xx_err("Failed to alloc DXE mempool: %d\n", ret); | ||
| 198 | goto out_smd_close; | ||
| 199 | } | ||
| 200 | |||
| 201 | ret = wcn36xx_dxe_alloc_ctl_blks(wcn); | ||
| 202 | if (ret) { | ||
| 203 | wcn36xx_err("Failed to alloc DXE ctl blocks: %d\n", ret); | ||
| 204 | goto out_free_dxe_pool; | ||
| 205 | } | ||
| 206 | |||
| 207 | wcn->hal_buf = kmalloc(WCN36XX_HAL_BUF_SIZE, GFP_KERNEL); | ||
| 208 | if (!wcn->hal_buf) { | ||
| 209 | wcn36xx_err("Failed to allocate smd buf\n"); | ||
| 210 | ret = -ENOMEM; | ||
| 211 | goto out_free_dxe_ctl; | ||
| 212 | } | ||
| 213 | |||
| 214 | ret = wcn36xx_smd_load_nv(wcn); | ||
| 215 | if (ret) { | ||
| 216 | wcn36xx_err("Failed to push NV to chip\n"); | ||
| 217 | goto out_free_smd_buf; | ||
| 218 | } | ||
| 219 | |||
| 220 | ret = wcn36xx_smd_start(wcn); | ||
| 221 | if (ret) { | ||
| 222 | wcn36xx_err("Failed to start chip\n"); | ||
| 223 | goto out_free_smd_buf; | ||
| 224 | } | ||
| 225 | |||
| 226 | /* DMA channel initialization */ | ||
| 227 | ret = wcn36xx_dxe_init(wcn); | ||
| 228 | if (ret) { | ||
| 229 | wcn36xx_err("DXE init failed\n"); | ||
| 230 | goto out_smd_stop; | ||
| 231 | } | ||
| 232 | |||
| 233 | wcn36xx_debugfs_init(wcn); | ||
| 234 | |||
| 235 | if (!wcn36xx_is_fw_version(wcn, 1, 2, 2, 24)) { | ||
| 236 | ret = wcn36xx_smd_feature_caps_exchange(wcn); | ||
| 237 | if (ret) | ||
| 238 | wcn36xx_warn("Exchange feature caps failed\n"); | ||
| 239 | } | ||
| 240 | INIT_LIST_HEAD(&wcn->vif_list); | ||
| 241 | return 0; | ||
| 242 | |||
| 243 | out_smd_stop: | ||
| 244 | wcn36xx_smd_stop(wcn); | ||
| 245 | out_free_smd_buf: | ||
| 246 | kfree(wcn->hal_buf); | ||
| 247 | out_free_dxe_pool: | ||
| 248 | wcn36xx_dxe_free_mem_pools(wcn); | ||
| 249 | out_free_dxe_ctl: | ||
| 250 | wcn36xx_dxe_free_ctl_blks(wcn); | ||
| 251 | out_smd_close: | ||
| 252 | wcn36xx_smd_close(wcn); | ||
| 253 | out_err: | ||
| 254 | return ret; | ||
| 255 | } | ||
| 256 | |||
| 257 | static void wcn36xx_stop(struct ieee80211_hw *hw) | ||
| 258 | { | ||
| 259 | struct wcn36xx *wcn = hw->priv; | ||
| 260 | |||
| 261 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac stop\n"); | ||
| 262 | |||
| 263 | wcn36xx_debugfs_exit(wcn); | ||
| 264 | wcn36xx_smd_stop(wcn); | ||
| 265 | wcn36xx_dxe_deinit(wcn); | ||
| 266 | wcn36xx_smd_close(wcn); | ||
| 267 | |||
| 268 | wcn36xx_dxe_free_mem_pools(wcn); | ||
| 269 | wcn36xx_dxe_free_ctl_blks(wcn); | ||
| 270 | |||
| 271 | kfree(wcn->hal_buf); | ||
| 272 | } | ||
| 273 | |||
| 274 | static int wcn36xx_config(struct ieee80211_hw *hw, u32 changed) | ||
| 275 | { | ||
| 276 | struct wcn36xx *wcn = hw->priv; | ||
| 277 | struct ieee80211_vif *vif = NULL; | ||
| 278 | struct wcn36xx_vif *tmp; | ||
| 279 | |||
| 280 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac config changed 0x%08x\n", changed); | ||
| 281 | |||
| 282 | if (changed & IEEE80211_CONF_CHANGE_CHANNEL) { | ||
| 283 | int ch = WCN36XX_HW_CHANNEL(wcn); | ||
| 284 | wcn36xx_dbg(WCN36XX_DBG_MAC, "wcn36xx_config channel switch=%d\n", | ||
| 285 | ch); | ||
| 286 | list_for_each_entry(tmp, &wcn->vif_list, list) { | ||
| 287 | vif = container_of((void *)tmp, | ||
| 288 | struct ieee80211_vif, | ||
| 289 | drv_priv); | ||
| 290 | wcn36xx_smd_switch_channel(wcn, vif, ch); | ||
| 291 | } | ||
| 292 | } | ||
| 293 | |||
| 294 | return 0; | ||
| 295 | } | ||
| 296 | |||
| 297 | #define WCN36XX_SUPPORTED_FILTERS (0) | ||
| 298 | |||
| 299 | static void wcn36xx_configure_filter(struct ieee80211_hw *hw, | ||
| 300 | unsigned int changed, | ||
| 301 | unsigned int *total, u64 multicast) | ||
| 302 | { | ||
| 303 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac configure filter\n"); | ||
| 304 | |||
| 305 | *total &= WCN36XX_SUPPORTED_FILTERS; | ||
| 306 | } | ||
| 307 | |||
| 308 | static void wcn36xx_tx(struct ieee80211_hw *hw, | ||
| 309 | struct ieee80211_tx_control *control, | ||
| 310 | struct sk_buff *skb) | ||
| 311 | { | ||
| 312 | struct wcn36xx *wcn = hw->priv; | ||
| 313 | struct wcn36xx_sta *sta_priv = NULL; | ||
| 314 | |||
| 315 | if (control->sta) | ||
| 316 | sta_priv = (struct wcn36xx_sta *)control->sta->drv_priv; | ||
| 317 | |||
| 318 | if (wcn36xx_start_tx(wcn, sta_priv, skb)) | ||
| 319 | ieee80211_free_txskb(wcn->hw, skb); | ||
| 320 | } | ||
| 321 | |||
| 322 | static int wcn36xx_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, | ||
| 323 | struct ieee80211_vif *vif, | ||
| 324 | struct ieee80211_sta *sta, | ||
| 325 | struct ieee80211_key_conf *key_conf) | ||
| 326 | { | ||
| 327 | struct wcn36xx *wcn = hw->priv; | ||
| 328 | struct wcn36xx_vif *vif_priv = (struct wcn36xx_vif *)vif->drv_priv; | ||
| 329 | struct wcn36xx_sta *sta_priv = vif_priv->sta; | ||
| 330 | int ret = 0; | ||
| 331 | u8 key[WLAN_MAX_KEY_LEN]; | ||
| 332 | |||
| 333 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac80211 set key\n"); | ||
| 334 | wcn36xx_dbg(WCN36XX_DBG_MAC, "Key: cmd=0x%x algo:0x%x, id:%d, len:%d flags 0x%x\n", | ||
| 335 | cmd, key_conf->cipher, key_conf->keyidx, | ||
| 336 | key_conf->keylen, key_conf->flags); | ||
| 337 | wcn36xx_dbg_dump(WCN36XX_DBG_MAC, "KEY: ", | ||
| 338 | key_conf->key, | ||
| 339 | key_conf->keylen); | ||
| 340 | |||
| 341 | switch (key_conf->cipher) { | ||
| 342 | case WLAN_CIPHER_SUITE_WEP40: | ||
| 343 | vif_priv->encrypt_type = WCN36XX_HAL_ED_WEP40; | ||
| 344 | break; | ||
| 345 | case WLAN_CIPHER_SUITE_WEP104: | ||
| 346 | vif_priv->encrypt_type = WCN36XX_HAL_ED_WEP40; | ||
| 347 | break; | ||
| 348 | case WLAN_CIPHER_SUITE_CCMP: | ||
| 349 | vif_priv->encrypt_type = WCN36XX_HAL_ED_CCMP; | ||
| 350 | break; | ||
| 351 | case WLAN_CIPHER_SUITE_TKIP: | ||
| 352 | vif_priv->encrypt_type = WCN36XX_HAL_ED_TKIP; | ||
| 353 | break; | ||
| 354 | default: | ||
| 355 | wcn36xx_err("Unsupported key type 0x%x\n", | ||
| 356 | key_conf->cipher); | ||
| 357 | ret = -EOPNOTSUPP; | ||
| 358 | goto out; | ||
| 359 | } | ||
| 360 | |||
| 361 | switch (cmd) { | ||
| 362 | case SET_KEY: | ||
| 363 | if (WCN36XX_HAL_ED_TKIP == vif_priv->encrypt_type) { | ||
| 364 | /* | ||
| 365 | * Supplicant is sending key in the wrong order: | ||
| 366 | * Temporal Key (16 b) - TX MIC (8 b) - RX MIC (8 b) | ||
| 367 | * but HW expects it to be in the order as described in | ||
| 368 | * IEEE 802.11 spec (see chapter 11.7) like this: | ||
| 369 | * Temporal Key (16 b) - RX MIC (8 b) - TX MIC (8 b) | ||
| 370 | */ | ||
| 371 | memcpy(key, key_conf->key, 16); | ||
| 372 | memcpy(key + 16, key_conf->key + 24, 8); | ||
| 373 | memcpy(key + 24, key_conf->key + 16, 8); | ||
| 374 | } else { | ||
| 375 | memcpy(key, key_conf->key, key_conf->keylen); | ||
| 376 | } | ||
| 377 | |||
| 378 | if (IEEE80211_KEY_FLAG_PAIRWISE & key_conf->flags) { | ||
| 379 | sta_priv->is_data_encrypted = true; | ||
| 380 | /* Reconfigure bss with encrypt_type */ | ||
| 381 | if (NL80211_IFTYPE_STATION == vif->type) | ||
| 382 | wcn36xx_smd_config_bss(wcn, | ||
| 383 | vif, | ||
| 384 | sta, | ||
| 385 | sta->addr, | ||
| 386 | true); | ||
| 387 | |||
| 388 | wcn36xx_smd_set_stakey(wcn, | ||
| 389 | vif_priv->encrypt_type, | ||
| 390 | key_conf->keyidx, | ||
| 391 | key_conf->keylen, | ||
| 392 | key, | ||
| 393 | get_sta_index(vif, sta_priv)); | ||
| 394 | } else { | ||
| 395 | wcn36xx_smd_set_bsskey(wcn, | ||
| 396 | vif_priv->encrypt_type, | ||
| 397 | key_conf->keyidx, | ||
| 398 | key_conf->keylen, | ||
| 399 | key); | ||
| 400 | if ((WLAN_CIPHER_SUITE_WEP40 == key_conf->cipher) || | ||
| 401 | (WLAN_CIPHER_SUITE_WEP104 == key_conf->cipher)) { | ||
| 402 | sta_priv->is_data_encrypted = true; | ||
| 403 | wcn36xx_smd_set_stakey(wcn, | ||
| 404 | vif_priv->encrypt_type, | ||
| 405 | key_conf->keyidx, | ||
| 406 | key_conf->keylen, | ||
| 407 | key, | ||
| 408 | get_sta_index(vif, sta_priv)); | ||
| 409 | } | ||
| 410 | } | ||
| 411 | break; | ||
| 412 | case DISABLE_KEY: | ||
| 413 | if (!(IEEE80211_KEY_FLAG_PAIRWISE & key_conf->flags)) { | ||
| 414 | wcn36xx_smd_remove_bsskey(wcn, | ||
| 415 | vif_priv->encrypt_type, | ||
| 416 | key_conf->keyidx); | ||
| 417 | } else { | ||
| 418 | sta_priv->is_data_encrypted = false; | ||
| 419 | /* do not remove key if disassociated */ | ||
| 420 | if (sta_priv->aid) | ||
| 421 | wcn36xx_smd_remove_stakey(wcn, | ||
| 422 | vif_priv->encrypt_type, | ||
| 423 | key_conf->keyidx, | ||
| 424 | get_sta_index(vif, sta_priv)); | ||
| 425 | } | ||
| 426 | break; | ||
| 427 | default: | ||
| 428 | wcn36xx_err("Unsupported key cmd 0x%x\n", cmd); | ||
| 429 | ret = -EOPNOTSUPP; | ||
| 430 | goto out; | ||
| 431 | break; | ||
| 432 | } | ||
| 433 | |||
| 434 | out: | ||
| 435 | return ret; | ||
| 436 | } | ||
| 437 | |||
| 438 | static void wcn36xx_sw_scan_start(struct ieee80211_hw *hw) | ||
| 439 | { | ||
| 440 | struct wcn36xx *wcn = hw->priv; | ||
| 441 | |||
| 442 | wcn36xx_smd_init_scan(wcn, HAL_SYS_MODE_SCAN); | ||
| 443 | wcn36xx_smd_start_scan(wcn); | ||
| 444 | } | ||
| 445 | |||
| 446 | static void wcn36xx_sw_scan_complete(struct ieee80211_hw *hw) | ||
| 447 | { | ||
| 448 | struct wcn36xx *wcn = hw->priv; | ||
| 449 | |||
| 450 | wcn36xx_smd_end_scan(wcn); | ||
| 451 | wcn36xx_smd_finish_scan(wcn, HAL_SYS_MODE_SCAN); | ||
| 452 | } | ||
| 453 | |||
| 454 | static void wcn36xx_update_allowed_rates(struct ieee80211_sta *sta, | ||
| 455 | enum ieee80211_band band) | ||
| 456 | { | ||
| 457 | int i, size; | ||
| 458 | u16 *rates_table; | ||
| 459 | struct wcn36xx_sta *sta_priv = (struct wcn36xx_sta *)sta->drv_priv; | ||
| 460 | u32 rates = sta->supp_rates[band]; | ||
| 461 | |||
| 462 | memset(&sta_priv->supported_rates, 0, | ||
| 463 | sizeof(sta_priv->supported_rates)); | ||
| 464 | sta_priv->supported_rates.op_rate_mode = STA_11n; | ||
| 465 | |||
| 466 | size = ARRAY_SIZE(sta_priv->supported_rates.dsss_rates); | ||
| 467 | rates_table = sta_priv->supported_rates.dsss_rates; | ||
| 468 | if (band == IEEE80211_BAND_2GHZ) { | ||
| 469 | for (i = 0; i < size; i++) { | ||
| 470 | if (rates & 0x01) { | ||
| 471 | rates_table[i] = wcn_2ghz_rates[i].hw_value; | ||
| 472 | rates = rates >> 1; | ||
| 473 | } | ||
| 474 | } | ||
| 475 | } | ||
| 476 | |||
| 477 | size = ARRAY_SIZE(sta_priv->supported_rates.ofdm_rates); | ||
| 478 | rates_table = sta_priv->supported_rates.ofdm_rates; | ||
| 479 | for (i = 0; i < size; i++) { | ||
| 480 | if (rates & 0x01) { | ||
| 481 | rates_table[i] = wcn_5ghz_rates[i].hw_value; | ||
| 482 | rates = rates >> 1; | ||
| 483 | } | ||
| 484 | } | ||
| 485 | |||
| 486 | if (sta->ht_cap.ht_supported) { | ||
| 487 | BUILD_BUG_ON(sizeof(sta->ht_cap.mcs.rx_mask) > | ||
| 488 | sizeof(sta_priv->supported_rates.supported_mcs_set)); | ||
| 489 | memcpy(sta_priv->supported_rates.supported_mcs_set, | ||
| 490 | sta->ht_cap.mcs.rx_mask, | ||
| 491 | sizeof(sta->ht_cap.mcs.rx_mask)); | ||
| 492 | } | ||
| 493 | } | ||
| 494 | void wcn36xx_set_default_rates(struct wcn36xx_hal_supported_rates *rates) | ||
| 495 | { | ||
| 496 | u16 ofdm_rates[WCN36XX_HAL_NUM_OFDM_RATES] = { | ||
| 497 | HW_RATE_INDEX_6MBPS, | ||
| 498 | HW_RATE_INDEX_9MBPS, | ||
| 499 | HW_RATE_INDEX_12MBPS, | ||
| 500 | HW_RATE_INDEX_18MBPS, | ||
| 501 | HW_RATE_INDEX_24MBPS, | ||
| 502 | HW_RATE_INDEX_36MBPS, | ||
| 503 | HW_RATE_INDEX_48MBPS, | ||
| 504 | HW_RATE_INDEX_54MBPS | ||
| 505 | }; | ||
| 506 | u16 dsss_rates[WCN36XX_HAL_NUM_DSSS_RATES] = { | ||
| 507 | HW_RATE_INDEX_1MBPS, | ||
| 508 | HW_RATE_INDEX_2MBPS, | ||
| 509 | HW_RATE_INDEX_5_5MBPS, | ||
| 510 | HW_RATE_INDEX_11MBPS | ||
| 511 | }; | ||
| 512 | |||
| 513 | rates->op_rate_mode = STA_11n; | ||
| 514 | memcpy(rates->dsss_rates, dsss_rates, | ||
| 515 | sizeof(*dsss_rates) * WCN36XX_HAL_NUM_DSSS_RATES); | ||
| 516 | memcpy(rates->ofdm_rates, ofdm_rates, | ||
| 517 | sizeof(*ofdm_rates) * WCN36XX_HAL_NUM_OFDM_RATES); | ||
| 518 | rates->supported_mcs_set[0] = 0xFF; | ||
| 519 | } | ||
| 520 | static void wcn36xx_bss_info_changed(struct ieee80211_hw *hw, | ||
| 521 | struct ieee80211_vif *vif, | ||
| 522 | struct ieee80211_bss_conf *bss_conf, | ||
| 523 | u32 changed) | ||
| 524 | { | ||
| 525 | struct wcn36xx *wcn = hw->priv; | ||
| 526 | struct sk_buff *skb = NULL; | ||
| 527 | u16 tim_off, tim_len; | ||
| 528 | enum wcn36xx_hal_link_state link_state; | ||
| 529 | struct wcn36xx_vif *vif_priv = (struct wcn36xx_vif *)vif->drv_priv; | ||
| 530 | |||
| 531 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac bss info changed vif %p changed 0x%08x\n", | ||
| 532 | vif, changed); | ||
| 533 | |||
| 534 | if (changed & BSS_CHANGED_BEACON_INFO) { | ||
| 535 | wcn36xx_dbg(WCN36XX_DBG_MAC, | ||
| 536 | "mac bss changed dtim period %d\n", | ||
| 537 | bss_conf->dtim_period); | ||
| 538 | |||
| 539 | vif_priv->dtim_period = bss_conf->dtim_period; | ||
| 540 | } | ||
| 541 | |||
| 542 | if (changed & BSS_CHANGED_PS) { | ||
| 543 | wcn36xx_dbg(WCN36XX_DBG_MAC, | ||
| 544 | "mac bss PS set %d\n", | ||
| 545 | bss_conf->ps); | ||
| 546 | if (bss_conf->ps) { | ||
| 547 | wcn36xx_pmc_enter_bmps_state(wcn, vif); | ||
| 548 | } else { | ||
| 549 | wcn36xx_pmc_exit_bmps_state(wcn, vif); | ||
| 550 | } | ||
| 551 | } | ||
| 552 | |||
| 553 | if (changed & BSS_CHANGED_BSSID) { | ||
| 554 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac bss changed_bssid %pM\n", | ||
| 555 | bss_conf->bssid); | ||
| 556 | |||
| 557 | if (!is_zero_ether_addr(bss_conf->bssid)) { | ||
| 558 | vif_priv->is_joining = true; | ||
| 559 | vif_priv->bss_index = 0xff; | ||
| 560 | wcn36xx_smd_join(wcn, bss_conf->bssid, | ||
| 561 | vif->addr, WCN36XX_HW_CHANNEL(wcn)); | ||
| 562 | wcn36xx_smd_config_bss(wcn, vif, NULL, | ||
| 563 | bss_conf->bssid, false); | ||
| 564 | } else { | ||
| 565 | vif_priv->is_joining = false; | ||
| 566 | wcn36xx_smd_delete_bss(wcn, vif); | ||
| 567 | } | ||
| 568 | } | ||
| 569 | |||
| 570 | if (changed & BSS_CHANGED_SSID) { | ||
| 571 | wcn36xx_dbg(WCN36XX_DBG_MAC, | ||
| 572 | "mac bss changed ssid\n"); | ||
| 573 | wcn36xx_dbg_dump(WCN36XX_DBG_MAC, "ssid ", | ||
| 574 | bss_conf->ssid, bss_conf->ssid_len); | ||
| 575 | |||
| 576 | vif_priv->ssid.length = bss_conf->ssid_len; | ||
| 577 | memcpy(&vif_priv->ssid.ssid, | ||
| 578 | bss_conf->ssid, | ||
| 579 | bss_conf->ssid_len); | ||
| 580 | } | ||
| 581 | |||
| 582 | if (changed & BSS_CHANGED_ASSOC) { | ||
| 583 | vif_priv->is_joining = false; | ||
| 584 | if (bss_conf->assoc) { | ||
| 585 | struct ieee80211_sta *sta; | ||
| 586 | struct wcn36xx_sta *sta_priv; | ||
| 587 | |||
| 588 | wcn36xx_dbg(WCN36XX_DBG_MAC, | ||
| 589 | "mac assoc bss %pM vif %pM AID=%d\n", | ||
| 590 | bss_conf->bssid, | ||
| 591 | vif->addr, | ||
| 592 | bss_conf->aid); | ||
| 593 | |||
| 594 | rcu_read_lock(); | ||
| 595 | sta = ieee80211_find_sta(vif, bss_conf->bssid); | ||
| 596 | if (!sta) { | ||
| 597 | wcn36xx_err("sta %pM is not found\n", | ||
| 598 | bss_conf->bssid); | ||
| 599 | rcu_read_unlock(); | ||
| 600 | goto out; | ||
| 601 | } | ||
| 602 | sta_priv = (struct wcn36xx_sta *)sta->drv_priv; | ||
| 603 | |||
| 604 | wcn36xx_update_allowed_rates(sta, WCN36XX_BAND(wcn)); | ||
| 605 | |||
| 606 | wcn36xx_smd_set_link_st(wcn, bss_conf->bssid, | ||
| 607 | vif->addr, | ||
| 608 | WCN36XX_HAL_LINK_POSTASSOC_STATE); | ||
| 609 | wcn36xx_smd_config_bss(wcn, vif, sta, | ||
| 610 | bss_conf->bssid, | ||
| 611 | true); | ||
| 612 | sta_priv->aid = bss_conf->aid; | ||
| 613 | /* | ||
| 614 | * config_sta must be called from because this is the | ||
| 615 | * place where AID is available. | ||
| 616 | */ | ||
| 617 | wcn36xx_smd_config_sta(wcn, vif, sta); | ||
| 618 | rcu_read_unlock(); | ||
| 619 | } else { | ||
| 620 | wcn36xx_dbg(WCN36XX_DBG_MAC, | ||
| 621 | "disassociated bss %pM vif %pM AID=%d\n", | ||
| 622 | bss_conf->bssid, | ||
| 623 | vif->addr, | ||
| 624 | bss_conf->aid); | ||
| 625 | wcn36xx_smd_set_link_st(wcn, | ||
| 626 | bss_conf->bssid, | ||
| 627 | vif->addr, | ||
| 628 | WCN36XX_HAL_LINK_IDLE_STATE); | ||
| 629 | } | ||
| 630 | } | ||
| 631 | |||
| 632 | if (changed & BSS_CHANGED_AP_PROBE_RESP) { | ||
| 633 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac bss changed ap probe resp\n"); | ||
| 634 | skb = ieee80211_proberesp_get(hw, vif); | ||
| 635 | if (!skb) { | ||
| 636 | wcn36xx_err("failed to alloc probereq skb\n"); | ||
| 637 | goto out; | ||
| 638 | } | ||
| 639 | |||
| 640 | wcn36xx_smd_update_proberesp_tmpl(wcn, vif, skb); | ||
| 641 | dev_kfree_skb(skb); | ||
| 642 | } | ||
| 643 | |||
| 644 | if (changed & BSS_CHANGED_BEACON_ENABLED) { | ||
| 645 | wcn36xx_dbg(WCN36XX_DBG_MAC, | ||
| 646 | "mac bss changed beacon enabled %d\n", | ||
| 647 | bss_conf->enable_beacon); | ||
| 648 | |||
| 649 | if (bss_conf->enable_beacon) { | ||
| 650 | vif_priv->bss_index = 0xff; | ||
| 651 | wcn36xx_smd_config_bss(wcn, vif, NULL, | ||
| 652 | vif->addr, false); | ||
| 653 | skb = ieee80211_beacon_get_tim(hw, vif, &tim_off, | ||
| 654 | &tim_len); | ||
| 655 | if (!skb) { | ||
| 656 | wcn36xx_err("failed to alloc beacon skb\n"); | ||
| 657 | goto out; | ||
| 658 | } | ||
| 659 | wcn36xx_smd_send_beacon(wcn, vif, skb, tim_off, 0); | ||
| 660 | dev_kfree_skb(skb); | ||
| 661 | |||
| 662 | if (vif->type == NL80211_IFTYPE_ADHOC || | ||
| 663 | vif->type == NL80211_IFTYPE_MESH_POINT) | ||
| 664 | link_state = WCN36XX_HAL_LINK_IBSS_STATE; | ||
| 665 | else | ||
| 666 | link_state = WCN36XX_HAL_LINK_AP_STATE; | ||
| 667 | |||
| 668 | wcn36xx_smd_set_link_st(wcn, vif->addr, vif->addr, | ||
| 669 | link_state); | ||
| 670 | } else { | ||
| 671 | wcn36xx_smd_set_link_st(wcn, vif->addr, vif->addr, | ||
| 672 | WCN36XX_HAL_LINK_IDLE_STATE); | ||
| 673 | wcn36xx_smd_delete_bss(wcn, vif); | ||
| 674 | } | ||
| 675 | } | ||
| 676 | out: | ||
| 677 | return; | ||
| 678 | } | ||
| 679 | |||
| 680 | /* this is required when using IEEE80211_HW_HAS_RATE_CONTROL */ | ||
| 681 | static int wcn36xx_set_rts_threshold(struct ieee80211_hw *hw, u32 value) | ||
| 682 | { | ||
| 683 | struct wcn36xx *wcn = hw->priv; | ||
| 684 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac set RTS threshold %d\n", value); | ||
| 685 | |||
| 686 | wcn36xx_smd_update_cfg(wcn, WCN36XX_HAL_CFG_RTS_THRESHOLD, value); | ||
| 687 | return 0; | ||
| 688 | } | ||
| 689 | |||
| 690 | static void wcn36xx_remove_interface(struct ieee80211_hw *hw, | ||
| 691 | struct ieee80211_vif *vif) | ||
| 692 | { | ||
| 693 | struct wcn36xx *wcn = hw->priv; | ||
| 694 | struct wcn36xx_vif *vif_priv = (struct wcn36xx_vif *)vif->drv_priv; | ||
| 695 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac remove interface vif %p\n", vif); | ||
| 696 | |||
| 697 | list_del(&vif_priv->list); | ||
| 698 | wcn36xx_smd_delete_sta_self(wcn, vif->addr); | ||
| 699 | } | ||
| 700 | |||
| 701 | static int wcn36xx_add_interface(struct ieee80211_hw *hw, | ||
| 702 | struct ieee80211_vif *vif) | ||
| 703 | { | ||
| 704 | struct wcn36xx *wcn = hw->priv; | ||
| 705 | struct wcn36xx_vif *vif_priv = (struct wcn36xx_vif *)vif->drv_priv; | ||
| 706 | |||
| 707 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac add interface vif %p type %d\n", | ||
| 708 | vif, vif->type); | ||
| 709 | |||
| 710 | if (!(NL80211_IFTYPE_STATION == vif->type || | ||
| 711 | NL80211_IFTYPE_AP == vif->type || | ||
| 712 | NL80211_IFTYPE_ADHOC == vif->type || | ||
| 713 | NL80211_IFTYPE_MESH_POINT == vif->type)) { | ||
| 714 | wcn36xx_warn("Unsupported interface type requested: %d\n", | ||
| 715 | vif->type); | ||
| 716 | return -EOPNOTSUPP; | ||
| 717 | } | ||
| 718 | |||
| 719 | list_add(&vif_priv->list, &wcn->vif_list); | ||
| 720 | wcn36xx_smd_add_sta_self(wcn, vif); | ||
| 721 | |||
| 722 | return 0; | ||
| 723 | } | ||
| 724 | |||
| 725 | static int wcn36xx_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif, | ||
| 726 | struct ieee80211_sta *sta) | ||
| 727 | { | ||
| 728 | struct wcn36xx *wcn = hw->priv; | ||
| 729 | struct wcn36xx_vif *vif_priv = (struct wcn36xx_vif *)vif->drv_priv; | ||
| 730 | struct wcn36xx_sta *sta_priv = (struct wcn36xx_sta *)sta->drv_priv; | ||
| 731 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac sta add vif %p sta %pM\n", | ||
| 732 | vif, sta->addr); | ||
| 733 | |||
| 734 | vif_priv->sta = sta_priv; | ||
| 735 | sta_priv->vif = vif_priv; | ||
| 736 | /* | ||
| 737 | * For STA mode HW will be configured on BSS_CHANGED_ASSOC because | ||
| 738 | * at this stage AID is not available yet. | ||
| 739 | */ | ||
| 740 | if (NL80211_IFTYPE_STATION != vif->type) { | ||
| 741 | wcn36xx_update_allowed_rates(sta, WCN36XX_BAND(wcn)); | ||
| 742 | sta_priv->aid = sta->aid; | ||
| 743 | wcn36xx_smd_config_sta(wcn, vif, sta); | ||
| 744 | } | ||
| 745 | return 0; | ||
| 746 | } | ||
| 747 | |||
| 748 | static int wcn36xx_sta_remove(struct ieee80211_hw *hw, | ||
| 749 | struct ieee80211_vif *vif, | ||
| 750 | struct ieee80211_sta *sta) | ||
| 751 | { | ||
| 752 | struct wcn36xx *wcn = hw->priv; | ||
| 753 | struct wcn36xx_vif *vif_priv = (struct wcn36xx_vif *)vif->drv_priv; | ||
| 754 | struct wcn36xx_sta *sta_priv = (struct wcn36xx_sta *)sta->drv_priv; | ||
| 755 | |||
| 756 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac sta remove vif %p sta %pM index %d\n", | ||
| 757 | vif, sta->addr, sta_priv->sta_index); | ||
| 758 | |||
| 759 | wcn36xx_smd_delete_sta(wcn, sta_priv->sta_index); | ||
| 760 | vif_priv->sta = NULL; | ||
| 761 | sta_priv->vif = NULL; | ||
| 762 | return 0; | ||
| 763 | } | ||
| 764 | |||
| 765 | #ifdef CONFIG_PM | ||
| 766 | |||
| 767 | static int wcn36xx_suspend(struct ieee80211_hw *hw, struct cfg80211_wowlan *wow) | ||
| 768 | { | ||
| 769 | struct wcn36xx *wcn = hw->priv; | ||
| 770 | |||
| 771 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac suspend\n"); | ||
| 772 | |||
| 773 | flush_workqueue(wcn->hal_ind_wq); | ||
| 774 | wcn36xx_smd_set_power_params(wcn, true); | ||
| 775 | return 0; | ||
| 776 | } | ||
| 777 | |||
| 778 | static int wcn36xx_resume(struct ieee80211_hw *hw) | ||
| 779 | { | ||
| 780 | struct wcn36xx *wcn = hw->priv; | ||
| 781 | |||
| 782 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac resume\n"); | ||
| 783 | |||
| 784 | flush_workqueue(wcn->hal_ind_wq); | ||
| 785 | wcn36xx_smd_set_power_params(wcn, false); | ||
| 786 | return 0; | ||
| 787 | } | ||
| 788 | |||
| 789 | #endif | ||
| 790 | |||
| 791 | static int wcn36xx_ampdu_action(struct ieee80211_hw *hw, | ||
| 792 | struct ieee80211_vif *vif, | ||
| 793 | enum ieee80211_ampdu_mlme_action action, | ||
| 794 | struct ieee80211_sta *sta, u16 tid, u16 *ssn, | ||
| 795 | u8 buf_size) | ||
| 796 | { | ||
| 797 | struct wcn36xx *wcn = hw->priv; | ||
| 798 | struct wcn36xx_sta *sta_priv = NULL; | ||
| 799 | |||
| 800 | wcn36xx_dbg(WCN36XX_DBG_MAC, "mac ampdu action action %d tid %d\n", | ||
| 801 | action, tid); | ||
| 802 | |||
| 803 | sta_priv = (struct wcn36xx_sta *)sta->drv_priv; | ||
| 804 | |||
| 805 | switch (action) { | ||
| 806 | case IEEE80211_AMPDU_RX_START: | ||
| 807 | sta_priv->tid = tid; | ||
| 808 | wcn36xx_smd_add_ba_session(wcn, sta, tid, ssn, 0, | ||
| 809 | get_sta_index(vif, sta_priv)); | ||
| 810 | wcn36xx_smd_add_ba(wcn); | ||
| 811 | wcn36xx_smd_trigger_ba(wcn, get_sta_index(vif, sta_priv)); | ||
| 812 | ieee80211_start_tx_ba_session(sta, tid, 0); | ||
| 813 | break; | ||
| 814 | case IEEE80211_AMPDU_RX_STOP: | ||
| 815 | wcn36xx_smd_del_ba(wcn, tid, get_sta_index(vif, sta_priv)); | ||
| 816 | break; | ||
| 817 | case IEEE80211_AMPDU_TX_START: | ||
| 818 | ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid); | ||
| 819 | break; | ||
| 820 | case IEEE80211_AMPDU_TX_OPERATIONAL: | ||
| 821 | wcn36xx_smd_add_ba_session(wcn, sta, tid, ssn, 1, | ||
| 822 | get_sta_index(vif, sta_priv)); | ||
| 823 | break; | ||
| 824 | case IEEE80211_AMPDU_TX_STOP_FLUSH: | ||
| 825 | case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: | ||
| 826 | case IEEE80211_AMPDU_TX_STOP_CONT: | ||
| 827 | ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); | ||
| 828 | break; | ||
| 829 | default: | ||
| 830 | wcn36xx_err("Unknown AMPDU action\n"); | ||
| 831 | } | ||
| 832 | |||
| 833 | return 0; | ||
| 834 | } | ||
| 835 | |||
| 836 | static const struct ieee80211_ops wcn36xx_ops = { | ||
| 837 | .start = wcn36xx_start, | ||
| 838 | .stop = wcn36xx_stop, | ||
| 839 | .add_interface = wcn36xx_add_interface, | ||
| 840 | .remove_interface = wcn36xx_remove_interface, | ||
| 841 | #ifdef CONFIG_PM | ||
| 842 | .suspend = wcn36xx_suspend, | ||
| 843 | .resume = wcn36xx_resume, | ||
| 844 | #endif | ||
| 845 | .config = wcn36xx_config, | ||
| 846 | .configure_filter = wcn36xx_configure_filter, | ||
| 847 | .tx = wcn36xx_tx, | ||
| 848 | .set_key = wcn36xx_set_key, | ||
| 849 | .sw_scan_start = wcn36xx_sw_scan_start, | ||
| 850 | .sw_scan_complete = wcn36xx_sw_scan_complete, | ||
| 851 | .bss_info_changed = wcn36xx_bss_info_changed, | ||
| 852 | .set_rts_threshold = wcn36xx_set_rts_threshold, | ||
| 853 | .sta_add = wcn36xx_sta_add, | ||
| 854 | .sta_remove = wcn36xx_sta_remove, | ||
| 855 | .ampdu_action = wcn36xx_ampdu_action, | ||
| 856 | }; | ||
| 857 | |||
| 858 | static int wcn36xx_init_ieee80211(struct wcn36xx *wcn) | ||
| 859 | { | ||
| 860 | int ret = 0; | ||
| 861 | |||
| 862 | static const u32 cipher_suites[] = { | ||
| 863 | WLAN_CIPHER_SUITE_WEP40, | ||
| 864 | WLAN_CIPHER_SUITE_WEP104, | ||
| 865 | WLAN_CIPHER_SUITE_TKIP, | ||
| 866 | WLAN_CIPHER_SUITE_CCMP, | ||
| 867 | }; | ||
| 868 | |||
| 869 | wcn->hw->flags = IEEE80211_HW_SIGNAL_DBM | | ||
| 870 | IEEE80211_HW_HAS_RATE_CONTROL | | ||
| 871 | IEEE80211_HW_SUPPORTS_PS | | ||
| 872 | IEEE80211_HW_CONNECTION_MONITOR | | ||
| 873 | IEEE80211_HW_AMPDU_AGGREGATION | | ||
| 874 | IEEE80211_HW_TIMING_BEACON_ONLY; | ||
| 875 | |||
| 876 | wcn->hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | | ||
| 877 | BIT(NL80211_IFTYPE_AP) | | ||
| 878 | BIT(NL80211_IFTYPE_ADHOC) | | ||
| 879 | BIT(NL80211_IFTYPE_MESH_POINT); | ||
| 880 | |||
| 881 | wcn->hw->wiphy->bands[IEEE80211_BAND_2GHZ] = &wcn_band_2ghz; | ||
| 882 | wcn->hw->wiphy->bands[IEEE80211_BAND_5GHZ] = &wcn_band_5ghz; | ||
| 883 | |||
| 884 | wcn->hw->wiphy->cipher_suites = cipher_suites; | ||
| 885 | wcn->hw->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); | ||
| 886 | |||
| 887 | wcn->hw->wiphy->flags |= WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; | ||
| 888 | |||
| 889 | #ifdef CONFIG_PM | ||
| 890 | wcn->hw->wiphy->wowlan = &wowlan_support; | ||
| 891 | #endif | ||
| 892 | |||
| 893 | wcn->hw->max_listen_interval = 200; | ||
| 894 | |||
| 895 | wcn->hw->queues = 4; | ||
| 896 | |||
| 897 | SET_IEEE80211_DEV(wcn->hw, wcn->dev); | ||
| 898 | |||
| 899 | wcn->hw->sta_data_size = sizeof(struct wcn36xx_sta); | ||
| 900 | wcn->hw->vif_data_size = sizeof(struct wcn36xx_vif); | ||
| 901 | |||
| 902 | return ret; | ||
| 903 | } | ||
| 904 | |||
| 905 | static int wcn36xx_platform_get_resources(struct wcn36xx *wcn, | ||
| 906 | struct platform_device *pdev) | ||
| 907 | { | ||
| 908 | struct resource *res; | ||
| 909 | /* Set TX IRQ */ | ||
| 910 | res = platform_get_resource_byname(pdev, IORESOURCE_IRQ, | ||
| 911 | "wcnss_wlantx_irq"); | ||
| 912 | if (!res) { | ||
| 913 | wcn36xx_err("failed to get tx_irq\n"); | ||
| 914 | return -ENOENT; | ||
| 915 | } | ||
| 916 | wcn->tx_irq = res->start; | ||
| 917 | |||
| 918 | /* Set RX IRQ */ | ||
| 919 | res = platform_get_resource_byname(pdev, IORESOURCE_IRQ, | ||
| 920 | "wcnss_wlanrx_irq"); | ||
| 921 | if (!res) { | ||
| 922 | wcn36xx_err("failed to get rx_irq\n"); | ||
| 923 | return -ENOENT; | ||
| 924 | } | ||
| 925 | wcn->rx_irq = res->start; | ||
| 926 | |||
| 927 | /* Map the memory */ | ||
| 928 | res = platform_get_resource_byname(pdev, IORESOURCE_MEM, | ||
| 929 | "wcnss_mmio"); | ||
| 930 | if (!res) { | ||
| 931 | wcn36xx_err("failed to get mmio\n"); | ||
| 932 | return -ENOENT; | ||
| 933 | } | ||
| 934 | wcn->mmio = ioremap(res->start, resource_size(res)); | ||
| 935 | if (!wcn->mmio) { | ||
| 936 | wcn36xx_err("failed to map io memory\n"); | ||
| 937 | return -ENOMEM; | ||
| 938 | } | ||
| 939 | return 0; | ||
| 940 | } | ||
| 941 | |||
| 942 | static int wcn36xx_probe(struct platform_device *pdev) | ||
| 943 | { | ||
| 944 | struct ieee80211_hw *hw; | ||
| 945 | struct wcn36xx *wcn; | ||
| 946 | int ret; | ||
| 947 | u8 addr[ETH_ALEN]; | ||
| 948 | |||
| 949 | wcn36xx_dbg(WCN36XX_DBG_MAC, "platform probe\n"); | ||
| 950 | |||
| 951 | hw = ieee80211_alloc_hw(sizeof(struct wcn36xx), &wcn36xx_ops); | ||
| 952 | if (!hw) { | ||
| 953 | wcn36xx_err("failed to alloc hw\n"); | ||
| 954 | ret = -ENOMEM; | ||
| 955 | goto out_err; | ||
| 956 | } | ||
| 957 | platform_set_drvdata(pdev, hw); | ||
| 958 | wcn = hw->priv; | ||
| 959 | wcn->hw = hw; | ||
| 960 | wcn->dev = &pdev->dev; | ||
| 961 | wcn->ctrl_ops = pdev->dev.platform_data; | ||
| 962 | |||
| 963 | mutex_init(&wcn->hal_mutex); | ||
| 964 | |||
| 965 | if (!wcn->ctrl_ops->get_hw_mac(addr)) { | ||
| 966 | wcn36xx_info("mac address: %pM\n", addr); | ||
| 967 | SET_IEEE80211_PERM_ADDR(wcn->hw, addr); | ||
| 968 | } | ||
| 969 | |||
| 970 | ret = wcn36xx_platform_get_resources(wcn, pdev); | ||
| 971 | if (ret) | ||
| 972 | goto out_wq; | ||
| 973 | |||
| 974 | wcn36xx_init_ieee80211(wcn); | ||
| 975 | ret = ieee80211_register_hw(wcn->hw); | ||
| 976 | if (ret) | ||
| 977 | goto out_unmap; | ||
| 978 | |||
| 979 | return 0; | ||
| 980 | |||
| 981 | out_unmap: | ||
| 982 | iounmap(wcn->mmio); | ||
| 983 | out_wq: | ||
| 984 | ieee80211_free_hw(hw); | ||
| 985 | out_err: | ||
| 986 | return ret; | ||
| 987 | } | ||
| 988 | static int wcn36xx_remove(struct platform_device *pdev) | ||
| 989 | { | ||
| 990 | struct ieee80211_hw *hw = platform_get_drvdata(pdev); | ||
| 991 | struct wcn36xx *wcn = hw->priv; | ||
| 992 | wcn36xx_dbg(WCN36XX_DBG_MAC, "platform remove\n"); | ||
| 993 | |||
| 994 | mutex_destroy(&wcn->hal_mutex); | ||
| 995 | |||
| 996 | ieee80211_unregister_hw(hw); | ||
| 997 | iounmap(wcn->mmio); | ||
| 998 | ieee80211_free_hw(hw); | ||
| 999 | |||
| 1000 | return 0; | ||
| 1001 | } | ||
| 1002 | static const struct platform_device_id wcn36xx_platform_id_table[] = { | ||
| 1003 | { | ||
| 1004 | .name = "wcn36xx", | ||
| 1005 | .driver_data = 0 | ||
| 1006 | }, | ||
| 1007 | {} | ||
| 1008 | }; | ||
| 1009 | MODULE_DEVICE_TABLE(platform, wcn36xx_platform_id_table); | ||
| 1010 | |||
| 1011 | static struct platform_driver wcn36xx_driver = { | ||
| 1012 | .probe = wcn36xx_probe, | ||
| 1013 | .remove = wcn36xx_remove, | ||
| 1014 | .driver = { | ||
| 1015 | .name = "wcn36xx", | ||
| 1016 | .owner = THIS_MODULE, | ||
| 1017 | }, | ||
| 1018 | .id_table = wcn36xx_platform_id_table, | ||
| 1019 | }; | ||
| 1020 | |||
| 1021 | static int __init wcn36xx_init(void) | ||
| 1022 | { | ||
| 1023 | platform_driver_register(&wcn36xx_driver); | ||
| 1024 | return 0; | ||
| 1025 | } | ||
| 1026 | module_init(wcn36xx_init); | ||
| 1027 | |||
| 1028 | static void __exit wcn36xx_exit(void) | ||
| 1029 | { | ||
| 1030 | platform_driver_unregister(&wcn36xx_driver); | ||
| 1031 | } | ||
| 1032 | module_exit(wcn36xx_exit); | ||
| 1033 | |||
| 1034 | MODULE_LICENSE("Dual BSD/GPL"); | ||
| 1035 | MODULE_AUTHOR("Eugene Krasnikov k.eugene.e@gmail.com"); | ||
| 1036 | MODULE_FIRMWARE(WLAN_NV_FILE); | ||
