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         tasklet_init(&priv->wmi_tasklet, ath9k_wmi_tasklet,
 458                      (unsigned long)priv);
 459         tasklet_init(&priv->rx_tasklet, ath9k_rx_tasklet,
 460                      (unsigned long)priv);
 461         tasklet_init(&priv->tx_tasklet, ath9k_tx_tasklet, (unsigned long)priv);
 462         INIT_DELAYED_WORK(&priv->ath9k_aggr_work, ath9k_htc_aggr_work);
 463         INIT_DELAYED_WORK(&priv->ath9k_ani_work, ath9k_ani_work);
 464
 465         /*
 466          * Cache line size is used to size and align various
 467          * structures used to communicate with the hardware.
 468          */
 469         ath_read_cachesize(common, &csz);
 470         common->cachelsz = csz << 2; /* convert to bytes */
 471
 472         ret = ath9k_hw_init(ah);
 473         if (ret) {
 474                 ath_print(common, ATH_DBG_FATAL,
 475                           "Unable to initialize hardware; "
 476                           "initialization status: %d\n", ret);
 477                 goto err_hw;
 478         }
 479
 480         ret = ath9k_htc_init_debug(ah);
 481         if (ret) {
 482                 ath_print(common, ATH_DBG_FATAL,
 483                           "Unable to create debugfs files\n");
 484                 goto err_debug;
 485         }
 486
 487         ret = ath9k_init_queues(priv);
 488         if (ret)
 489                 goto err_queues;
 490
 491         ath9k_init_crypto(priv);
 492         ath9k_init_channels_rates(priv);
 493         ath9k_init_misc(priv);
 494
 495         return 0;
 496
 497 err_queues:
 498         ath9k_htc_exit_debug(ah);
 499 err_debug:
 500         ath9k_hw_deinit(ah);
 501 err_hw:
 502
 503         kfree(ah);
 504         priv->ah = NULL;
 505
 506         return ret;
 507 }
 508
 509 static void ath9k_set_hw_capab(struct ath9k_htc_priv *priv,
 510                                struct ieee80211_hw *hw)
 511 {
 512         struct ath_common *common = ath9k_hw_common(priv->ah);
 513
 514         hw->flags = IEEE80211_HW_SIGNAL_DBM |
 515                 IEEE80211_HW_AMPDU_AGGREGATION |
 516                 IEEE80211_HW_SPECTRUM_MGMT |
 517                 IEEE80211_HW_HAS_RATE_CONTROL |
 518                 IEEE80211_HW_RX_INCLUDES_FCS;
 519
 520         hw->wiphy->interface_modes =
 521                 BIT(NL80211_IFTYPE_STATION) |
 522                 BIT(NL80211_IFTYPE_ADHOC);
 523
 524         hw->queues = 4;
 525         hw->channel_change_time = 5000;
 526         hw->max_listen_interval = 10;
 527         hw->vif_data_size = sizeof(struct ath9k_htc_vif);
 528         hw->sta_data_size = sizeof(struct ath9k_htc_sta);
 529
 530         /* tx_frame_hdr is larger than tx_mgmt_hdr anyway */
 531         hw->extra_tx_headroom = sizeof(struct tx_frame_hdr) +
 532                 sizeof(struct htc_frame_hdr) + 4;
 533
 534         if (test_bit(ATH9K_MODE_11G, priv->ah->caps.wireless_modes))
 535                 hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
 536                         &priv->sbands[IEEE80211_BAND_2GHZ];
 537
 538         if (priv->ah->caps.hw_caps & ATH9K_HW_CAP_HT) {
 539                 if (test_bit(ATH9K_MODE_11G, priv->ah->caps.wireless_modes))
 540                         setup_ht_cap(priv,
 541                                      &priv->sbands[IEEE80211_BAND_2GHZ].ht_cap);
 542         }
 543
 544         SET_IEEE80211_PERM_ADDR(hw, common->macaddr);
 545 }
 546
 547 static int ath9k_init_device(struct ath9k_htc_priv *priv, u16 devid)
 548 {
 549         struct ieee80211_hw *hw = priv->hw;
 550         struct ath_common *common;
 551         struct ath_hw *ah;
 552         int error = 0;
 553         struct ath_regulatory *reg;
 554
 555         /* Bring up device */
 556         error = ath9k_init_priv(priv, devid);
 557         if (error != 0)
 558                 goto err_init;
 559
 560         ah = priv->ah;
 561         common = ath9k_hw_common(ah);
 562         ath9k_set_hw_capab(priv, hw);
 563
 564         /* Initialize regulatory */
 565         error = ath_regd_init(&common->regulatory, priv->hw->wiphy,
 566                               ath9k_reg_notifier);
 567         if (error)
 568                 goto err_regd;
 569
 570         reg = &common->regulatory;
 571
 572         /* Setup TX */
 573         error = ath9k_tx_init(priv);
 574         if (error != 0)
 575                 goto err_tx;
 576
 577         /* Setup RX */
 578         error = ath9k_rx_init(priv);
 579         if (error != 0)
 580                 goto err_rx;
 581
 582         /* Register with mac80211 */
 583         error = ieee80211_register_hw(hw);
 584         if (error)
 585                 goto err_register;
 586
 587         /* Handle world regulatory */
 588         if (!ath_is_world_regd(reg)) {
 589                 error = regulatory_hint(hw->wiphy, reg->alpha2);
 590                 if (error)
 591                         goto err_world;
 592         }
 593
 594         ath9k_init_leds(priv);
 595         ath9k_start_rfkill_poll(priv);
 596
 597         return 0;
 598
 599 err_world:
 600         ieee80211_unregister_hw(hw);
 601 err_register:
 602         ath9k_rx_cleanup(priv);
 603 err_rx:
 604         ath9k_tx_cleanup(priv);
 605 err_tx:
 606         /* Nothing */
 607 err_regd:
 608         ath9k_deinit_priv(priv);
 609 err_init:
 610         return error;
 611 }
 612
 613 int ath9k_htc_probe_device(struct htc_target *htc_handle, struct device *dev,
 614                            u16 devid)
 615 {
 616         struct ieee80211_hw *hw;
 617         struct ath9k_htc_priv *priv;
 618         int ret;
 619
 620         hw = ieee80211_alloc_hw(sizeof(struct ath9k_htc_priv), &ath9k_htc_ops);
 621         if (!hw)
 622                 return -ENOMEM;
 623
 624         priv = hw->priv;
 625         priv->hw = hw;
 626         priv->htc = htc_handle;
 627         priv->dev = dev;
 628         htc_handle->drv_priv = priv;
 629         SET_IEEE80211_DEV(hw, priv->dev);
 630
 631         ret = ath9k_htc_wait_for_target(priv);
 632         if (ret)
 633                 goto err_free;
 634
 635         priv->wmi = ath9k_init_wmi(priv);
 636         if (!priv->wmi) {
 637                 ret = -EINVAL;
 638                 goto err_free;
 639         }
 640
 641         ret = ath9k_init_htc_services(priv);
 642         if (ret)
 643                 goto err_init;
 644
 645         ret = ath9k_init_device(priv, devid);
 646         if (ret)
 647                 goto err_init;
 648
 649         return 0;
 650
 651 err_init:
 652         ath9k_deinit_wmi(priv);
 653 err_free:
 654         ieee80211_free_hw(hw);
 655         return ret;
 656 }
 657
 658 void ath9k_htc_disconnect_device(struct htc_target *htc_handle, bool hotunplug)
 659 {
 660         if (htc_handle->drv_priv) {
 661                 ath9k_deinit_device(htc_handle->drv_priv);
 662                 ath9k_deinit_wmi(htc_handle->drv_priv);
 663                 ieee80211_free_hw(htc_handle->drv_priv->hw);
 664         }
 665 }
 666
 667 #ifdef CONFIG_PM
 668 int ath9k_htc_resume(struct htc_target *htc_handle)
 669 {
 670         int ret;
 671
 672         ret = ath9k_htc_wait_for_target(htc_handle->drv_priv);
 673         if (ret)
 674                 return ret;
 675
 676         ret = ath9k_init_htc_services(htc_handle->drv_priv);
 677         return ret;
 678 }
 679 #endif
 680
 681 static int __init ath9k_htc_init(void)
 682 {
 683         int error;
 684
 685         error = ath9k_htc_debug_create_root();
 686         if (error < 0) {
 687                 printk(KERN_ERR
 688                         "ath9k_htc: Unable to create debugfs root: %d\n",
 689                         error);
 690                 goto err_dbg;
 691         }
 692
 693         error = ath9k_hif_usb_init();
 694         if (error < 0) {
 695                 printk(KERN_ERR
 696                         "ath9k_htc: No USB devices found,"
 697                         " driver not installed.\n");
 698                 error = -ENODEV;
 699                 goto err_usb;
 700         }
 701
 702         return 0;
 703
 704 err_usb:
 705         ath9k_htc_debug_remove_root();
 706 err_dbg:
 707         return error;
 708 }
 709 module_init(ath9k_htc_init);
 710
 711 static void __exit ath9k_htc_exit(void)
 712 {
 713         ath9k_hif_usb_exit();
 714         ath9k_htc_debug_remove_root();
 715         printk(KERN_INFO "ath9k_htc: Driver unloaded\n");
 716 }
 717 module_exit(ath9k_htc_exit);