drivers/net/wireless/ath/wcn36xx/main.c

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