drivers/net/wireless/ath/ath9k/htc_drv_init.c

   1 /*
   2  * Copyright (c) 2010 Atheros Communications Inc.
   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
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include "htc.h"
  18
  19 MODULE_AUTHOR("Atheros Communications");
  20 MODULE_LICENSE("Dual BSD/GPL");
  21 MODULE_DESCRIPTION("Atheros driver 802.11n HTC based wireless devices");
  22
  23 static unsigned int ath9k_debug = ATH_DBG_DEFAULT;
  24 module_param_named(debug, ath9k_debug, uint, 0);
  25 MODULE_PARM_DESC(debug, "Debugging mask");
  26
  27 int htc_modparam_nohwcrypt;
  28 module_param_named(nohwcrypt, htc_modparam_nohwcrypt, int, 0444);
  29 MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption");
  30
  31 #define CHAN2G(_freq, _idx)  { \
  32         .center_freq = (_freq), \
  33         .hw_value = (_idx), \
  34         .max_power = 20, \
  35 }
  36
  37 static struct ieee80211_channel ath9k_2ghz_channels[] = {
  38         CHAN2G(2412, 0), /* Channel 1 */
  39         CHAN2G(2417, 1), /* Channel 2 */
  40         CHAN2G(2422, 2), /* Channel 3 */
  41         CHAN2G(2427, 3), /* Channel 4 */
  42         CHAN2G(2432, 4), /* Channel 5 */
  43         CHAN2G(2437, 5), /* Channel 6 */
  44         CHAN2G(2442, 6), /* Channel 7 */
  45         CHAN2G(2447, 7), /* Channel 8 */
  46         CHAN2G(2452, 8), /* Channel 9 */
  47         CHAN2G(2457, 9), /* Channel 10 */
  48         CHAN2G(2462, 10), /* Channel 11 */
  49         CHAN2G(2467, 11), /* Channel 12 */
  50         CHAN2G(2472, 12), /* Channel 13 */
  51         CHAN2G(2484, 13), /* Channel 14 */
  52 };
  53
  54 /* Atheros hardware rate code addition for short premble */
  55 #define SHPCHECK(__hw_rate, __flags) \
  56         ((__flags & IEEE80211_RATE_SHORT_PREAMBLE) ? (__hw_rate | 0x04) : 0)
  57
  58 #define RATE(_bitrate, _hw_rate, _flags) {              \
  59         .bitrate        = (_bitrate),                   \
  60         .flags          = (_flags),                     \
  61         .hw_value       = (_hw_rate),                   \
  62         .hw_value_short = (SHPCHECK(_hw_rate, _flags))  \
  63 }
  64
  65 static struct ieee80211_rate ath9k_legacy_rates[] = {
  66         RATE(10, 0x1b, 0),
  67         RATE(20, 0x1a, IEEE80211_RATE_SHORT_PREAMBLE), /* shortp : 0x1e */
  68         RATE(55, 0x19, IEEE80211_RATE_SHORT_PREAMBLE), /* shortp: 0x1d */
  69         RATE(110, 0x18, IEEE80211_RATE_SHORT_PREAMBLE), /* short: 0x1c */
  70         RATE(60, 0x0b, 0),
  71         RATE(90, 0x0f, 0),
  72         RATE(120, 0x0a, 0),
  73         RATE(180, 0x0e, 0),
  74         RATE(240, 0x09, 0),
  75         RATE(360, 0x0d, 0),
  76         RATE(480, 0x08, 0),
  77         RATE(540, 0x0c, 0),
  78 };
  79
  80 static int ath9k_htc_wait_for_target(struct ath9k_htc_priv *priv)
  81 {
  82         int time_left;
  83
  84         /* Firmware can take up to 50ms to get ready, to be safe use 1 second */
  85         time_left = wait_for_completion_timeout(&priv->htc->target_wait, HZ);
  86         if (!time_left) {
  87                 dev_err(priv->dev, "ath9k_htc: Target is unresponsive\n");
  88                 return -ETIMEDOUT;
  89         }
  90
  91         return 0;
  92 }
  93
  94 static void ath9k_deinit_priv(struct ath9k_htc_priv *priv)
  95 {
  96         ath9k_htc_exit_debug(priv->ah);
  97         ath9k_hw_deinit(priv->ah);
  98         tasklet_kill(&priv->wmi_tasklet);
  99         tasklet_kill(&priv->rx_tasklet);
 100         tasklet_kill(&priv->tx_tasklet);
 101         kfree(priv->ah);
 102         priv->ah = NULL;
 103 }
 104
 105 static void ath9k_deinit_device(struct ath9k_htc_priv *priv)
 106 {
 107         struct ieee80211_hw *hw = priv->hw;
 108
 109         wiphy_rfkill_stop_polling(hw->wiphy);
 110         ath9k_deinit_leds(priv);
 111         ieee80211_unregister_hw(hw);
 112         ath9k_rx_cleanup(priv);
 113         ath9k_tx_cleanup(priv);
 114         ath9k_deinit_priv(priv);
 115 }
 116
 117 static inline int ath9k_htc_connect_svc(struct ath9k_htc_priv *priv,
 118                                         u16 service_id,
 119                                         void (*tx) (void *,
 120                                                     struct sk_buff *,
 121                                                     enum htc_endpoint_id,
 122                                                     bool txok),
 123                                         enum htc_endpoint_id *ep_id)
 124 {
 125         struct htc_service_connreq req;
 126
 127         memset(&req, 0, sizeof(struct htc_service_connreq));
 128
 129         req.service_id = service_id;
 130         req.ep_callbacks.priv = priv;
 131         req.ep_callbacks.rx = ath9k_htc_rxep;
 132         req.ep_callbacks.tx = tx;
 133
 134         return htc_connect_service(priv->htc, &req, ep_id);
 135 }
 136
 137 static int ath9k_init_htc_services(struct ath9k_htc_priv *priv)
 138 {
 139         int ret;
 140
 141         /* WMI CMD*/
 142         ret = ath9k_wmi_connect(priv->htc, priv->wmi, &priv->wmi_cmd_ep);
 143         if (ret)
 144                 goto err;
 145
 146         /* Beacon */
 147         ret = ath9k_htc_connect_svc(priv, WMI_BEACON_SVC, NULL,
 148                                     &priv->beacon_ep);
 149         if (ret)
 150                 goto err;
 151
 152         /* CAB */
 153         ret = ath9k_htc_connect_svc(priv, WMI_CAB_SVC, ath9k_htc_txep,
 154                                     &priv->cab_ep);
 155         if (ret)
 156                 goto err;
 157
 158
 159         /* UAPSD */
 160         ret = ath9k_htc_connect_svc(priv, WMI_UAPSD_SVC, ath9k_htc_txep,
 161                                     &priv->uapsd_ep);
 162         if (ret)
 163                 goto err;
 164
 165         /* MGMT */
 166         ret = ath9k_htc_connect_svc(priv, WMI_MGMT_SVC, ath9k_htc_txep,
 167                                     &priv->mgmt_ep);
 168         if (ret)
 169                 goto err;
 170
 171         /* DATA BE */
 172         ret = ath9k_htc_connect_svc(priv, WMI_DATA_BE_SVC, ath9k_htc_txep,
 173                                     &priv->data_be_ep);
 174         if (ret)
 175                 goto err;
 176
 177         /* DATA BK */
 178         ret = ath9k_htc_connect_svc(priv, WMI_DATA_BK_SVC, ath9k_htc_txep,
 179                                     &priv->data_bk_ep);
 180         if (ret)
 181                 goto err;
 182
 183         /* DATA VI */
 184         ret = ath9k_htc_connect_svc(priv, WMI_DATA_VI_SVC, ath9k_htc_txep,
 185                                     &priv->data_vi_ep);
 186         if (ret)
 187                 goto err;
 188
 189         /* DATA VO */
 190         ret = ath9k_htc_connect_svc(priv, WMI_DATA_VO_SVC, ath9k_htc_txep,
 191                                     &priv->data_vo_ep);
 192         if (ret)
 193                 goto err;
 194
 195         ret = htc_init(priv->htc);
 196         if (ret)
 197                 goto err;
 198
 199         return 0;
 200
 201 err:
 202         dev_err(priv->dev, "ath9k_htc: Unable to initialize HTC services\n");
 203         return ret;
 204 }
 205
 206 static int ath9k_reg_notifier(struct wiphy *wiphy,
 207                               struct regulatory_request *request)
 208 {
 209         struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy);
 210         struct ath9k_htc_priv *priv = hw->priv;
 211
 212         return ath_reg_notifier_apply(wiphy, request,
 213                                       ath9k_hw_regulatory(priv->ah));
 214 }
 215
 216 static unsigned int ath9k_ioread32(void *hw_priv, u32 reg_offset)
 217 {
 218         struct ath_hw *ah = (struct ath_hw *) hw_priv;
 219         struct ath_common *common = ath9k_hw_common(ah);
 220         struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
 221         __be32 val, reg = cpu_to_be32(reg_offset);
 222         int r;
 223
 224         r = ath9k_wmi_cmd(priv->wmi, WMI_REG_READ_CMDID,
 225                           (u8 *) &reg, sizeof(reg),
 226                           (u8 *) &val, sizeof(val),
 227                           100);
 228         if (unlikely(r)) {
 229                 ath_print(common, ATH_DBG_WMI,
 230                           "REGISTER READ FAILED: (0x%04x, %d)\n",
 231                            reg_offset, r);
 232                 return -EIO;
 233         }
 234
 235         return be32_to_cpu(val);
 236 }
 237
 238 static void ath9k_iowrite32(void *hw_priv, u32 val, u32 reg_offset)
 239 {
 240         struct ath_hw *ah = (struct ath_hw *) hw_priv;
 241         struct ath_common *common = ath9k_hw_common(ah);
 242         struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv;
 243         __be32 buf[2] = {
 244                 cpu_to_be32(reg_offset),
 245                 cpu_to_be32(val),
 246         };
 247         int r;
 248
 249         r = ath9k_wmi_cmd(priv->wmi, WMI_REG_WRITE_CMDID,
 250                           (u8 *) &buf, sizeof(buf),
 251                           (u8 *) &val, sizeof(val),
 252                           100);
 253         if (unlikely(r)) {
 254                 ath_print(common, ATH_DBG_WMI,
 255                           "REGISTER WRITE FAILED:(0x%04x, %d)\n",
 256                           reg_offset, r);
 257         }
 258 }
 259
 260 static const struct ath_ops ath9k_common_ops = {
 261         .read = ath9k_ioread32,
 262         .write = ath9k_iowrite32,
 263 };
 264
 265 static void ath_usb_read_cachesize(struct ath_common *common, int *csz)
 266 {
 267         *csz = L1_CACHE_BYTES >> 2;
 268 }
 269
 270 static bool ath_usb_eeprom_read(struct ath_common *common, u32 off, u16 *data)
 271 {
 272         struct ath_hw *ah = (struct ath_hw *) common->ah;
 273
 274         (void)REG_READ(ah, AR5416_EEPROM_OFFSET + (off << AR5416_EEPROM_S));
 275
 276         if (!ath9k_hw_wait(ah,
 277                            AR_EEPROM_STATUS_DATA,
 278                            AR_EEPROM_STATUS_DATA_BUSY |
 279                            AR_EEPROM_STATUS_DATA_PROT_ACCESS, 0,
 280                            AH_WAIT_TIMEOUT))
 281                 return false;
 282
 283         *data = MS(REG_READ(ah, AR_EEPROM_STATUS_DATA),
 284                    AR_EEPROM_STATUS_DATA_VAL);
 285
 286         return true;
 287 }
 288
 289 static const struct ath_bus_ops ath9k_usb_bus_ops = {
 290         .ath_bus_type = ATH_USB,
 291         .read_cachesize = ath_usb_read_cachesize,
 292         .eeprom_read = ath_usb_eeprom_read,
 293 };
 294
 295 static void setup_ht_cap(struct ath9k_htc_priv *priv,
 296                          struct ieee80211_sta_ht_cap *ht_info)
 297 {
 298         ht_info->ht_supported = true;
 299         ht_info->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
 300                        IEEE80211_HT_CAP_SM_PS |
 301                        IEEE80211_HT_CAP_SGI_40 |
 302                        IEEE80211_HT_CAP_DSSSCCK40;
 303
 304         ht_info->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
 305         ht_info->ampdu_density = IEEE80211_HT_MPDU_DENSITY_8;
 306
 307         memset(&ht_info->mcs, 0, sizeof(ht_info->mcs));
 308         ht_info->mcs.rx_mask[0] = 0xff;
 309         ht_info->mcs.tx_params |= IEEE80211_HT_MCS_TX_DEFINED;
 310 }
 311
 312 static int ath9k_init_queues(struct ath9k_htc_priv *priv)
 313 {
 314         struct ath_common *common = ath9k_hw_common(priv->ah);
 315         int i;
 316
 317         for (i = 0; i < ARRAY_SIZE(priv->hwq_map); i++)
 318                 priv->hwq_map[i] = -1;
 319
 320         if (!ath9k_htc_txq_setup(priv, ATH9K_WME_AC_BE)) {
 321                 ath_print(common, ATH_DBG_FATAL,
 322                           "Unable to setup xmit queue for BE traffic\n");
 323                 goto err;
 324         }
 325
 326         if (!ath9k_htc_txq_setup(priv, ATH9K_WME_AC_BK)) {
 327                 ath_print(common, ATH_DBG_FATAL,
 328                           "Unable to setup xmit queue for BK traffic\n");
 329                 goto err;
 330         }
 331         if (!ath9k_htc_txq_setup(priv, ATH9K_WME_AC_VI)) {
 332                 ath_print(common, ATH_DBG_FATAL,
 333                           "Unable to setup xmit queue for VI traffic\n");
 334                 goto err;
 335         }
 336         if (!ath9k_htc_txq_setup(priv, ATH9K_WME_AC_VO)) {
 337                 ath_print(common, ATH_DBG_FATAL,
 338                           "Unable to setup xmit queue for VO traffic\n");
 339                 goto err;
 340         }
 341
 342         return 0;
 343
 344 err:
 345         return -EINVAL;
 346 }
 347
 348 static void ath9k_init_crypto(struct ath9k_htc_priv *priv)
 349 {
 350         struct ath_common *common = ath9k_hw_common(priv->ah);
 351         int i = 0;
 352
 353         /* Get the hardware key cache size. */
 354         common->keymax = priv->ah->caps.keycache_size;
 355         if (common->keymax > ATH_KEYMAX) {
 356                 ath_print(common, ATH_DBG_ANY,
 357                           "Warning, using only %u entries in %u key cache\n",
 358                           ATH_KEYMAX, common->keymax);
 359                 common->keymax = ATH_KEYMAX;
 360         }
 361
 362         /*
 363          * Reset the key cache since some parts do not
 364          * reset the contents on initial power up.
 365          */
 366         for (i = 0; i < common->keymax; i++)
 367                 ath9k_hw_keyreset(priv->ah, (u16) i);
 368
 369         if (ath9k_hw_getcapability(priv->ah, ATH9K_CAP_CIPHER,
 370                                    ATH9K_CIPHER_TKIP, NULL)) {
 371                 /*
 372                  * Whether we should enable h/w TKIP MIC.
 373                  * XXX: if we don't support WME TKIP MIC, then we wouldn't
 374                  * report WMM capable, so it's always safe to turn on
 375                  * TKIP MIC in this case.
 376                  */
 377                 ath9k_hw_setcapability(priv->ah, ATH9K_CAP_TKIP_MIC, 0, 1, NULL);
 378         }
 379
 380         /*
 381          * Check whether the separate key cache entries
 382          * are required to handle both tx+rx MIC keys.
 383          * With split mic keys the number of stations is limited
 384          * to 27 otherwise 59.
 385          */
 386         if (ath9k_hw_getcapability(priv->ah, ATH9K_CAP_CIPHER,
 387                                    ATH9K_CIPHER_TKIP, NULL)
 388             && ath9k_hw_getcapability(priv->ah, ATH9K_CAP_CIPHER,
 389                                       ATH9K_CIPHER_MIC, NULL)
 390             && ath9k_hw_getcapability(priv->ah, ATH9K_CAP_TKIP_SPLIT,
 391                                       0, NULL))
 392                 common->splitmic = 1;
 393
 394         /* turn on mcast key search if possible */
 395         if (!ath9k_hw_getcapability(priv->ah, ATH9K_CAP_MCAST_KEYSRCH, 0, NULL))
 396                 (void)ath9k_hw_setcapability(priv->ah, ATH9K_CAP_MCAST_KEYSRCH,
 397                                              1, 1, NULL);
 398 }
 399
 400 static void ath9k_init_channels_rates(struct ath9k_htc_priv *priv)
 401 {
 402         if (test_bit(ATH9K_MODE_11G, priv->ah->caps.wireless_modes)) {
 403                 priv->sbands[IEEE80211_BAND_2GHZ].channels =
 404                         ath9k_2ghz_channels;
 405                 priv->sbands[IEEE80211_BAND_2GHZ].band = IEEE80211_BAND_2GHZ;
 406                 priv->sbands[IEEE80211_BAND_2GHZ].n_channels =
 407                         ARRAY_SIZE(ath9k_2ghz_channels);
 408                 priv->sbands[IEEE80211_BAND_2GHZ].bitrates = ath9k_legacy_rates;
 409                 priv->sbands[IEEE80211_BAND_2GHZ].n_bitrates =
 410                         ARRAY_SIZE(ath9k_legacy_rates);
 411         }
 412 }
 413
 414 static void ath9k_init_misc(struct ath9k_htc_priv *priv)
 415 {
 416         struct ath_common *common = ath9k_hw_common(priv->ah);
 417
 418         common->tx_chainmask = priv->ah->caps.tx_chainmask;
 419         common->rx_chainmask = priv->ah->caps.rx_chainmask;
 420
 421         if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_BSSIDMASK)
 422                 memcpy(common->bssidmask, ath_bcast_mac, ETH_ALEN);
 423
 424         priv->op_flags |= OP_TXAGGR;
 425         priv->ah->opmode = NL80211_IFTYPE_STATION;
 426 }
 427
 428 static int ath9k_init_priv(struct ath9k_htc_priv *priv, u16 devid)
 429 {
 430         struct ath_hw *ah = NULL;
 431         struct ath_common *common;
 432         int ret = 0, csz = 0;
 433
 434         priv->op_flags |= OP_INVALID;
 435
 436         ah = kzalloc(sizeof(struct ath_hw), GFP_KERNEL);
 437         if (!ah)
 438                 return -ENOMEM;
 439
 440         ah->hw_version.devid = devid;
 441         ah->hw_version.subsysid = 0; /* FIXME */
 442         priv->ah = ah;
 443
 444         common = ath9k_hw_common(ah);
 445         common->ops = &ath9k_common_ops;
 446         common->bus_ops = &ath9k_usb_bus_ops;
 447         common->ah = ah;
 448         common->hw = priv->hw;
 449         common->priv = priv;
 450         common->debug_mask = ath9k_debug;
 451
 452         spin_lock_init(&priv->wmi->wmi_lock);
 453         spin_lock_init(&priv->beacon_lock);
 454         spin_lock_init(&priv->tx_lock);
 455         mutex_init(&priv->mutex);
 456         mutex_init(&priv->aggr_work.mutex);
 457         mutex_init(&priv->htc_pm_lock);
 458         tasklet_init(&priv->wmi_tasklet, ath9k_wmi_tasklet,
 459                      (unsigned long)priv);
 460         tasklet_init(&priv->rx_tasklet, ath9k_rx_tasklet,
 461                      (unsigned long)priv);
 462         tasklet_init(&priv->tx_tasklet, ath9k_tx_tasklet, (unsigned long)priv);
 463         INIT_DELAYED_WORK(&priv->ath9k_aggr_work, ath9k_htc_aggr_work);
 464         INIT_DELAYED_WORK(&priv->ath9k_ani_work, ath9k_ani_work);
 465         INIT_WORK(&priv->ps_work, ath9k_ps_work);
 466
 467         /*
 468          * Cache line size is used to size and align various
 469          * structures used to communicate with the hardware.
 470          */
 471         ath_read_cachesize(common, &csz);
 472         common->cachelsz = csz << 2; /* convert to bytes */
 473
 474         ret = ath9k_hw_init(ah);
 475         if (ret) {
 476                 ath_print(common, ATH_DBG_FATAL,
 477                           "Unable to initialize hardware; "
 478                           "initialization status: %d\n", ret);
 479                 goto err_hw;
 480         }
 481
 482         ret = ath9k_htc_init_debug(ah);
 483         if (ret) {
 484                 ath_print(common, ATH_DBG_FATAL,
 485                           "Unable to create debugfs files\n");
 486                 goto err_debug;
 487         }
 488
 489         ret = ath9k_init_queues(priv);
 490         if (ret)
 491                 goto err_queues;
 492
 493         ath9k_init_crypto(priv);
 494         ath9k_init_channels_rates(priv);
 495         ath9k_init_misc(priv);
 496
 497         return 0;
 498
 499 err_queues:
 500         ath9k_htc_exit_debug(ah);
 501 err_debug:
 502         ath9k_hw_deinit(ah);
 503 err_hw:
 504
 505         kfree(ah);
 506         priv->ah = NULL;
 507
 508         return ret;
 509 }
 510
 511 static void ath9k_set_hw_capab(struct ath9k_htc_priv *priv,
 512                                struct ieee80211_hw *hw)
 513 {
 514         struct ath_common *common = ath9k_hw_common(priv->ah);
 515
 516         hw->flags = IEEE80211_HW_SIGNAL_DBM |
 517                 IEEE80211_HW_AMPDU_AGGREGATION |
 518                 IEEE80211_HW_SPECTRUM_MGMT |
 519                 IEEE80211_HW_HAS_RATE_CONTROL |
 520                 IEEE80211_HW_RX_INCLUDES_FCS |
 521                 IEEE80211_HW_SUPPORTS_PS |
 522                 IEEE80211_HW_PS_NULLFUNC_STACK;
 523
 524         hw->wiphy->interface_modes =
 525                 BIT(NL80211_IFTYPE_STATION) |
 526                 BIT(NL80211_IFTYPE_ADHOC);
 527
 528         hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
 529
 530         hw->queues = 4;
 531         hw->channel_change_time = 5000;
 532         hw->max_listen_interval = 10;
 533         hw->vif_data_size = sizeof(struct ath9k_htc_vif);
 534         hw->sta_data_size = sizeof(struct ath9k_htc_sta);
 535
 536         /* tx_frame_hdr is larger than tx_mgmt_hdr anyway */
 537         hw->extra_tx_headroom = sizeof(struct tx_frame_hdr) +
 538                 sizeof(struct htc_frame_hdr) + 4;
 539
 540         if (test_bit(ATH9K_MODE_11G, priv->ah->caps.wireless_modes))
 541                 hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
 542                         &priv->sbands[IEEE80211_BAND_2GHZ];
 543
 544         if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_HT) {
 545                 if (test_bit(ATH9K_MODE_11G, priv->ah->caps.wireless_modes))
 546                         setup_ht_cap(priv,
 547                                      &priv->sbands[IEEE80211_BAND_2GHZ].ht_cap);
 548         }
 549
 550         SET_IEEE80211_PERM_ADDR(hw, common->macaddr);
 551 }
 552
 553 static int ath9k_init_device(struct ath9k_htc_priv *priv, u16 devid)
 554 {
 555         struct ieee80211_hw *hw = priv->hw;
 556         struct ath_common *common;
 557         struct ath_hw *ah;
 558         int error = 0;
 559         struct ath_regulatory *reg;
 560
 561         /* Bring up device */
 562         error = ath9k_init_priv(priv, devid);
 563         if (error != 0)
 564                 goto err_init;
 565
 566         ah = priv->ah;
 567         common = ath9k_hw_common(ah);
 568         ath9k_set_hw_capab(priv, hw);
 569
 570         /* Initialize regulatory */
 571         error = ath_regd_init(&common->regulatory, priv->hw->wiphy,
 572                               ath9k_reg_notifier);
 573         if (error)
 574                 goto err_regd;
 575
 576         reg = &common->regulatory;
 577
 578         /* Setup TX */
 579         error = ath9k_tx_init(priv);
 580         if (error != 0)
 581                 goto err_tx;
 582
 583         /* Setup RX */
 584         error = ath9k_rx_init(priv);
 585         if (error != 0)
 586                 goto err_rx;
 587
 588         /* Register with mac80211 */
 589         error = ieee80211_register_hw(hw);
 590         if (error)
 591                 goto err_register;
 592
 593         /* Handle world regulatory */
 594         if (!ath_is_world_regd(reg)) {
 595                 error = regulatory_hint(hw->wiphy, reg->alpha2);
 596                 if (error)
 597                         goto err_world;
 598         }
 599
 600         ath9k_init_leds(priv);
 601         ath9k_start_rfkill_poll(priv);
 602
 603         return 0;
 604
 605 err_world:
 606         ieee80211_unregister_hw(hw);
 607 err_register:
 608         ath9k_rx_cleanup(priv);
 609 err_rx:
 610         ath9k_tx_cleanup(priv);
 611 err_tx:
 612         /* Nothing */
 613 err_regd:
 614         ath9k_deinit_priv(priv);
 615 err_init:
 616         return error;
 617 }
 618
 619 int ath9k_htc_probe_device(struct htc_target *htc_handle, struct device *dev,
 620                            u16 devid)
 621 {
 622         struct ieee80211_hw *hw;
 623         struct ath9k_htc_priv *priv;
 624         int ret;
 625
 626         hw = ieee80211_alloc_hw(sizeof(struct ath9k_htc_priv), &ath9k_htc_ops);
 627         if (!hw)
 628                 return -ENOMEM;
 629
 630         priv = hw->priv;
 631         priv->hw = hw;
 632         priv->htc = htc_handle;
 633         priv->dev = dev;
 634         htc_handle->drv_priv = priv;
 635         SET_IEEE80211_DEV(hw, priv->dev);
 636
 637         ret = ath9k_htc_wait_for_target(priv);
 638         if (ret)
 639                 goto err_free;
 640
 641         priv->wmi = ath9k_init_wmi(priv);
 642         if (!priv->wmi) {
 643                 ret = -EINVAL;
 644                 goto err_free;
 645         }
 646
 647         ret = ath9k_init_htc_services(priv);
 648         if (ret)
 649                 goto err_init;
 650
 651         ret = ath9k_init_device(priv, devid);
 652         if (ret)
 653                 goto err_init;
 654
 655         return 0;
 656
 657 err_init:
 658         ath9k_deinit_wmi(priv);
 659 err_free:
 660         ieee80211_free_hw(hw);
 661         return ret;
 662 }
 663
 664 void ath9k_htc_disconnect_device(struct htc_target *htc_handle, bool hotunplug)
 665 {
 666         if (htc_handle->drv_priv) {
 667                 ath9k_deinit_device(htc_handle->drv_priv);
 668                 ath9k_deinit_wmi(htc_handle->drv_priv);
 669                 ieee80211_free_hw(htc_handle->drv_priv->hw);
 670         }
 671 }
 672
 673 #ifdef CONFIG_PM
 674 int ath9k_htc_resume(struct htc_target *htc_handle)
 675 {
 676         int ret;
 677
 678         ret = ath9k_htc_wait_for_target(htc_handle->drv_priv);
 679         if (ret)
 680                 return ret;
 681
 682         ret = ath9k_init_htc_services(htc_handle->drv_priv);
 683         return ret;
 684 }
 685 #endif
 686
 687 static int __init ath9k_htc_init(void)
 688 {
 689         int error;
 690
 691         error = ath9k_htc_debug_create_root();
 692         if (error < 0) {
 693                 printk(KERN_ERR
 694                         "ath9k_htc: Unable to create debugfs root: %d\n",
 695                         error);
 696                 goto err_dbg;
 697         }
 698
 699         error = ath9k_hif_usb_init();
 700         if (error < 0) {
 701                 printk(KERN_ERR
 702                         "ath9k_htc: No USB devices found,"
 703                         " driver not installed.\n");
 704                 error = -ENODEV;
 705                 goto err_usb;
 706         }
 707
 708         return 0;
 709
 710 err_usb:
 711         ath9k_htc_debug_remove_root();
 712 err_dbg:
 713         return error;
 714 }
 715 module_init(ath9k_htc_init);
 716
 717 static void __exit ath9k_htc_exit(void)
 718 {
 719         ath9k_hif_usb_exit();
 720         ath9k_htc_debug_remove_root();
 721         printk(KERN_INFO "ath9k_htc: Driver unloaded\n");
 722 }
 723 module_exit(ath9k_htc_exit);