drivers/staging/rtl8192e/rtl8192e/rtl_core.c

   1 /******************************************************************************
   2  * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
   3  *
   4  * Based on the r8180 driver, which is:
   5  * Copyright 2004-2005 Andrea Merello <andrea.merello@gmail.com>, et al.
   6  * This program is free software; you can redistribute it and/or modify it
   7  * under the terms of version 2 of the GNU General Public License as
   8  * published by the Free Software Foundation.
   9  *
  10  * This program is distributed in the hope that it will be useful, but WITHOUT
  11  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  13  * more details.
  14  *
  15  * You should have received a copy of the GNU General Public License along with
  16  * this program; if not, write to the Free Software Foundation, Inc.,
  17  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  18  *
  19  * The full GNU General Public License is included in this distribution in the
  20  * file called LICENSE.
  21  *
  22  * Contact Information:
  23  * wlanfae <wlanfae@realtek.com>
  24 ******************************************************************************/
  25 #include <linux/uaccess.h>
  26 #include <linux/pci.h>
  27 #include <linux/vmalloc.h>
  28 #include <linux/ieee80211.h>
  29 #include "rtl_core.h"
  30 #include "r8192E_phy.h"
  31 #include "r8192E_phyreg.h"
  32 #include "r8190P_rtl8256.h"
  33 #include "r8192E_cmdpkt.h"
  34
  35 #include "rtl_wx.h"
  36 #include "rtl_dm.h"
  37
  38 #include "rtl_pm.h"
  39
  40 int hwwep = 1;
  41 static int channels = 0x3fff;
  42 static char *ifname = "wlan%d";
  43
  44
  45 static struct rtl819x_ops rtl819xp_ops = {
  46         .nic_type                       = NIC_8192E,
  47         .get_eeprom_size                = rtl92e_get_eeprom_size,
  48         .init_adapter_variable          = rtl92e_init_variables,
  49         .initialize_adapter             = rtl92e_start_adapter,
  50         .link_change                    = rtl92e_link_change,
  51         .tx_fill_descriptor             = rtl92e_fill_tx_desc,
  52         .tx_fill_cmd_descriptor         = rtl92e_fill_tx_cmd_desc,
  53         .rx_query_status_descriptor     = rtl92e_get_rx_stats,
  54         .rx_command_packet_handler = NULL,
  55         .stop_adapter                   = rtl92e_stop_adapter,
  56         .update_ratr_table              = rtl92e_update_ratr_table,
  57         .irq_enable                     = rtl92e_enable_irq,
  58         .irq_disable                    = rtl92e_disable_irq,
  59         .irq_clear                      = rtl92e_clear_irq,
  60         .rx_enable                      = rtl92e_enable_rx,
  61         .tx_enable                      = rtl92e_enable_tx,
  62         .interrupt_recognized           = rtl92e_ack_irq,
  63         .TxCheckStuckHandler            = rtl92e_is_tx_stuck,
  64         .RxCheckStuckHandler            = rtl92e_is_rx_stuck,
  65 };
  66
  67 static struct pci_device_id rtl8192_pci_id_tbl[] = {
  68         {RTL_PCI_DEVICE(0x10ec, 0x8192, rtl819xp_ops)},
  69         {RTL_PCI_DEVICE(0x07aa, 0x0044, rtl819xp_ops)},
  70         {RTL_PCI_DEVICE(0x07aa, 0x0047, rtl819xp_ops)},
  71         {}
  72 };
  73
  74 MODULE_DEVICE_TABLE(pci, rtl8192_pci_id_tbl);
  75
  76 static int rtl8192_pci_probe(struct pci_dev *pdev,
  77                         const struct pci_device_id *id);
  78 static void rtl8192_pci_disconnect(struct pci_dev *pdev);
  79 static irqreturn_t rtl8192_interrupt(int irq, void *netdev);
  80
  81 static struct pci_driver rtl8192_pci_driver = {
  82         .name = DRV_NAME,       /* Driver name   */
  83         .id_table = rtl8192_pci_id_tbl, /* PCI_ID table  */
  84         .probe  = rtl8192_pci_probe,    /* probe fn      */
  85         .remove  = rtl8192_pci_disconnect,      /* remove fn */
  86         .suspend = rtl92e_suspend,      /* PM suspend fn */
  87         .resume = rtl92e_resume,                 /* PM resume fn  */
  88 };
  89
  90 static short rtl8192_is_tx_queue_empty(struct net_device *dev);
  91 static void rtl819x_watchdog_wqcallback(void *data);
  92 static void watch_dog_timer_callback(unsigned long data);
  93 static void rtl8192_data_hard_stop(struct net_device *dev);
  94 static void rtl8192_data_hard_resume(struct net_device *dev);
  95 static void rtl8192_hard_data_xmit(struct sk_buff *skb, struct net_device *dev,
  96                                    int rate);
  97 static int rtl8192_hard_start_xmit(struct sk_buff *skb, struct net_device *dev);
  98 static void rtl8192_tx_cmd(struct net_device *dev, struct sk_buff *skb);
  99 static short rtl8192_tx(struct net_device *dev, struct sk_buff *skb);
 100 static short rtl8192_pci_initdescring(struct net_device *dev);
 101 static void rtl8192_irq_tx_tasklet(struct r8192_priv *priv);
 102 static void rtl8192_irq_rx_tasklet(struct r8192_priv *priv);
 103 static void rtl8192_cancel_deferred_work(struct r8192_priv *priv);
 104 static int _rtl8192_up(struct net_device *dev, bool is_silent_reset);
 105 static int rtl8192_up(struct net_device *dev);
 106 static int rtl8192_down(struct net_device *dev, bool shutdownrf);
 107 static void rtl8192_restart(void *data);
 108
 109 /****************************************************************************
 110    -----------------------------IO STUFF-------------------------
 111 *****************************************************************************/
 112
 113 u8 rtl92e_readb(struct net_device *dev, int x)
 114 {
 115         return 0xff & readb((u8 __iomem *)dev->mem_start + x);
 116 }
 117
 118 u32 rtl92e_readl(struct net_device *dev, int x)
 119 {
 120         return readl((u8 __iomem *)dev->mem_start + x);
 121 }
 122
 123 u16 rtl92e_readw(struct net_device *dev, int x)
 124 {
 125         return readw((u8 __iomem *)dev->mem_start + x);
 126 }
 127
 128 void rtl92e_writeb(struct net_device *dev, int x, u8 y)
 129 {
 130         writeb(y, (u8 __iomem *)dev->mem_start + x);
 131
 132         udelay(20);
 133 }
 134
 135 void rtl92e_writel(struct net_device *dev, int x, u32 y)
 136 {
 137         writel(y, (u8 __iomem *)dev->mem_start + x);
 138
 139         udelay(20);
 140 }
 141
 142 void rtl92e_writew(struct net_device *dev, int x, u16 y)
 143 {
 144         writew(y, (u8 __iomem *)dev->mem_start + x);
 145
 146         udelay(20);
 147 }
 148
 149 /****************************************************************************
 150    -----------------------------GENERAL FUNCTION-------------------------
 151 *****************************************************************************/
 152 bool rtl92e_set_rf_state(struct net_device *dev,
 153                          enum rt_rf_power_state StateToSet,
 154                          RT_RF_CHANGE_SOURCE ChangeSource,
 155                          bool   ProtectOrNot)
 156 {
 157         struct r8192_priv *priv = rtllib_priv(dev);
 158         struct rtllib_device *ieee = priv->rtllib;
 159         bool                    bActionAllowed = false;
 160         bool                    bConnectBySSID = false;
 161         enum rt_rf_power_state rtState;
 162         u16                     RFWaitCounter = 0;
 163         unsigned long flag;
 164
 165         RT_TRACE((COMP_PS | COMP_RF),
 166                  "===>rtl92e_set_rf_state(): StateToSet(%d)\n", StateToSet);
 167
 168         ProtectOrNot = false;
 169
 170
 171         if (!ProtectOrNot) {
 172                 while (true) {
 173                         spin_lock_irqsave(&priv->rf_ps_lock, flag);
 174                         if (priv->RFChangeInProgress) {
 175                                 spin_unlock_irqrestore(&priv->rf_ps_lock, flag);
 176                                 RT_TRACE((COMP_PS | COMP_RF),
 177                                          "rtl92e_set_rf_state(): RF Change in progress! Wait to set..StateToSet(%d).\n",
 178                                          StateToSet);
 179
 180                                 while (priv->RFChangeInProgress) {
 181                                         RFWaitCounter++;
 182                                         RT_TRACE((COMP_PS | COMP_RF),
 183                                                  "rtl92e_set_rf_state(): Wait 1 ms (%d times)...\n",
 184                                                  RFWaitCounter);
 185                                         mdelay(1);
 186
 187                                         if (RFWaitCounter > 100) {
 188                                                 netdev_warn(dev,
 189                                                             "%s(): Timeout waiting for RF change.\n",
 190                                                             __func__);
 191                                                 return false;
 192                                         }
 193                                 }
 194                         } else {
 195                                 priv->RFChangeInProgress = true;
 196                                 spin_unlock_irqrestore(&priv->rf_ps_lock, flag);
 197                                 break;
 198                         }
 199                 }
 200         }
 201
 202         rtState = priv->rtllib->eRFPowerState;
 203
 204         switch (StateToSet) {
 205         case eRfOn:
 206                 priv->rtllib->RfOffReason &= (~ChangeSource);
 207
 208                 if ((ChangeSource == RF_CHANGE_BY_HW) && priv->bHwRadioOff)
 209                         priv->bHwRadioOff = false;
 210
 211                 if (!priv->rtllib->RfOffReason) {
 212                         priv->rtllib->RfOffReason = 0;
 213                         bActionAllowed = true;
 214
 215
 216                         if (rtState == eRfOff &&
 217                             ChangeSource >= RF_CHANGE_BY_HW)
 218                                 bConnectBySSID = true;
 219                 } else {
 220                         RT_TRACE((COMP_PS | COMP_RF),
 221                                  "rtl92e_set_rf_state - eRfon reject pMgntInfo->RfOffReason= 0x%x, ChangeSource=0x%X\n",
 222                                   priv->rtllib->RfOffReason, ChangeSource);
 223         }
 224
 225                 break;
 226
 227         case eRfOff:
 228
 229                 if ((priv->rtllib->iw_mode == IW_MODE_INFRA) ||
 230                     (priv->rtllib->iw_mode == IW_MODE_ADHOC)) {
 231                         if ((priv->rtllib->RfOffReason > RF_CHANGE_BY_IPS) ||
 232                             (ChangeSource > RF_CHANGE_BY_IPS)) {
 233                                 if (ieee->state == RTLLIB_LINKED)
 234                                         priv->blinked_ingpio = true;
 235                                 else
 236                                         priv->blinked_ingpio = false;
 237                                 rtllib_MgntDisconnect(priv->rtllib,
 238                                                       WLAN_REASON_DISASSOC_STA_HAS_LEFT);
 239                         }
 240                 }
 241                 if ((ChangeSource == RF_CHANGE_BY_HW) && !priv->bHwRadioOff)
 242                         priv->bHwRadioOff = true;
 243                 priv->rtllib->RfOffReason |= ChangeSource;
 244                 bActionAllowed = true;
 245                 break;
 246
 247         case eRfSleep:
 248                 priv->rtllib->RfOffReason |= ChangeSource;
 249                 bActionAllowed = true;
 250                 break;
 251
 252         default:
 253                 break;
 254         }
 255
 256         if (bActionAllowed) {
 257                 RT_TRACE((COMP_PS | COMP_RF),
 258                          "rtl92e_set_rf_state(): Action is allowed.... StateToSet(%d), RfOffReason(%#X)\n",
 259                          StateToSet, priv->rtllib->RfOffReason);
 260                 PHY_SetRFPowerState(dev, StateToSet);
 261                 if (StateToSet == eRfOn) {
 262
 263                         if (bConnectBySSID && priv->blinked_ingpio) {
 264                                 queue_delayed_work_rsl(ieee->wq,
 265                                          &ieee->associate_procedure_wq, 0);
 266                                 priv->blinked_ingpio = false;
 267                         }
 268                 }
 269         } else {
 270                 RT_TRACE((COMP_PS | COMP_RF),
 271                          "rtl92e_set_rf_state(): Action is rejected.... StateToSet(%d), ChangeSource(%#X), RfOffReason(%#X)\n",
 272                          StateToSet, ChangeSource, priv->rtllib->RfOffReason);
 273         }
 274
 275         if (!ProtectOrNot) {
 276                 spin_lock_irqsave(&priv->rf_ps_lock, flag);
 277                 priv->RFChangeInProgress = false;
 278                 spin_unlock_irqrestore(&priv->rf_ps_lock, flag);
 279         }
 280
 281         RT_TRACE((COMP_PS | COMP_RF), "<===rtl92e_set_rf_state()\n");
 282         return bActionAllowed;
 283 }
 284
 285 static short rtl8192_check_nic_enough_desc(struct net_device *dev, int prio)
 286 {
 287         struct r8192_priv *priv = rtllib_priv(dev);
 288         struct rtl8192_tx_ring *ring = &priv->tx_ring[prio];
 289
 290         if (ring->entries - skb_queue_len(&ring->queue) >= 2)
 291                 return 1;
 292         return 0;
 293 }
 294
 295 static void rtl8192_tx_timeout(struct net_device *dev)
 296 {
 297         struct r8192_priv *priv = rtllib_priv(dev);
 298
 299         schedule_work(&priv->reset_wq);
 300         netdev_info(dev, "TXTIMEOUT");
 301 }
 302
 303 void rtl92e_irq_enable(struct net_device *dev)
 304 {
 305         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
 306
 307         priv->irq_enabled = 1;
 308
 309         priv->ops->irq_enable(dev);
 310 }
 311
 312 void rtl92e_irq_disable(struct net_device *dev)
 313 {
 314         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
 315
 316         priv->ops->irq_disable(dev);
 317
 318         priv->irq_enabled = 0;
 319 }
 320
 321 static void rtl8192_set_chan(struct net_device *dev, short ch)
 322 {
 323         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
 324
 325         RT_TRACE(COMP_CH, "=====>%s()====ch:%d\n", __func__, ch);
 326         if (priv->chan_forced)
 327                 return;
 328
 329         priv->chan = ch;
 330
 331         if (priv->rf_set_chan)
 332                 priv->rf_set_chan(dev, priv->chan);
 333 }
 334
 335 static void rtl8192_update_cap(struct net_device *dev, u16 cap)
 336 {
 337         struct r8192_priv *priv = rtllib_priv(dev);
 338         struct rtllib_network *net = &priv->rtllib->current_network;
 339         bool            ShortPreamble;
 340
 341         if (cap & WLAN_CAPABILITY_SHORT_PREAMBLE) {
 342                 if (priv->dot11CurrentPreambleMode != PREAMBLE_SHORT) {
 343                         ShortPreamble = true;
 344                         priv->dot11CurrentPreambleMode = PREAMBLE_SHORT;
 345                         RT_TRACE(COMP_DBG,
 346                                  "%s(): WLAN_CAPABILITY_SHORT_PREAMBLE\n",
 347                                  __func__);
 348                         priv->rtllib->SetHwRegHandler(dev, HW_VAR_ACK_PREAMBLE,
 349                                         (unsigned char *)&ShortPreamble);
 350                 }
 351         } else {
 352                 if (priv->dot11CurrentPreambleMode != PREAMBLE_LONG) {
 353                         ShortPreamble = false;
 354                         priv->dot11CurrentPreambleMode = PREAMBLE_LONG;
 355                         RT_TRACE(COMP_DBG,
 356                                  "%s(): WLAN_CAPABILITY_LONG_PREAMBLE\n",
 357                                  __func__);
 358                         priv->rtllib->SetHwRegHandler(dev, HW_VAR_ACK_PREAMBLE,
 359                                               (unsigned char *)&ShortPreamble);
 360                 }
 361         }
 362
 363         if (net->mode & (IEEE_G|IEEE_N_24G)) {
 364                 u8      slot_time_val;
 365                 u8      CurSlotTime = priv->slot_time;
 366
 367                 if ((cap & WLAN_CAPABILITY_SHORT_SLOT_TIME) &&
 368                    (!priv->rtllib->pHTInfo->bCurrentRT2RTLongSlotTime)) {
 369                         if (CurSlotTime != SHORT_SLOT_TIME) {
 370                                 slot_time_val = SHORT_SLOT_TIME;
 371                                 priv->rtllib->SetHwRegHandler(dev,
 372                                          HW_VAR_SLOT_TIME, &slot_time_val);
 373                         }
 374                 } else {
 375                         if (CurSlotTime != NON_SHORT_SLOT_TIME) {
 376                                 slot_time_val = NON_SHORT_SLOT_TIME;
 377                                 priv->rtllib->SetHwRegHandler(dev,
 378                                          HW_VAR_SLOT_TIME, &slot_time_val);
 379                         }
 380                 }
 381         }
 382 }
 383
 384 static struct rtllib_qos_parameters def_qos_parameters = {
 385         {cpu_to_le16(3), cpu_to_le16(3), cpu_to_le16(3), cpu_to_le16(3)},
 386         {cpu_to_le16(7), cpu_to_le16(7), cpu_to_le16(7), cpu_to_le16(7)},
 387         {2, 2, 2, 2},
 388         {0, 0, 0, 0},
 389         {0, 0, 0, 0}
 390 };
 391
 392 static void rtl8192_update_beacon(void *data)
 393 {
 394         struct r8192_priv *priv = container_of_work_rsl(data, struct r8192_priv,
 395                                   update_beacon_wq.work);
 396         struct net_device *dev = priv->rtllib->dev;
 397         struct rtllib_device *ieee = priv->rtllib;
 398         struct rtllib_network *net = &ieee->current_network;
 399
 400         if (ieee->pHTInfo->bCurrentHTSupport)
 401                 HT_update_self_and_peer_setting(ieee, net);
 402         ieee->pHTInfo->bCurrentRT2RTLongSlotTime =
 403                  net->bssht.bdRT2RTLongSlotTime;
 404         ieee->pHTInfo->RT2RT_HT_Mode = net->bssht.RT2RT_HT_Mode;
 405         rtl8192_update_cap(dev, net->capability);
 406 }
 407
 408 static void rtl8192_qos_activate(void *data)
 409 {
 410         struct r8192_priv *priv = container_of_work_rsl(data, struct r8192_priv,
 411                                   qos_activate);
 412         struct net_device *dev = priv->rtllib->dev;
 413         int i;
 414
 415         mutex_lock(&priv->mutex);
 416         if (priv->rtllib->state != RTLLIB_LINKED)
 417                 goto success;
 418         RT_TRACE(COMP_QOS,
 419                  "qos active process with associate response received\n");
 420
 421         for (i = 0; i <  QOS_QUEUE_NUM; i++)
 422                 priv->rtllib->SetHwRegHandler(dev, HW_VAR_AC_PARAM, (u8 *)(&i));
 423
 424
 425 success:
 426         mutex_unlock(&priv->mutex);
 427 }
 428
 429 static int rtl8192_qos_handle_probe_response(struct r8192_priv *priv,
 430                 int active_network,
 431                 struct rtllib_network *network)
 432 {
 433         int ret = 0;
 434         u32 size = sizeof(struct rtllib_qos_parameters);
 435
 436         if (priv->rtllib->state != RTLLIB_LINKED)
 437                 return ret;
 438
 439         if (priv->rtllib->iw_mode != IW_MODE_INFRA)
 440                 return ret;
 441
 442         if (network->flags & NETWORK_HAS_QOS_MASK) {
 443                 if (active_network &&
 444                                 (network->flags & NETWORK_HAS_QOS_PARAMETERS))
 445                         network->qos_data.active = network->qos_data.supported;
 446
 447                 if ((network->qos_data.active == 1) && (active_network == 1) &&
 448                                 (network->flags & NETWORK_HAS_QOS_PARAMETERS) &&
 449                                 (network->qos_data.old_param_count !=
 450                                 network->qos_data.param_count)) {
 451                         network->qos_data.old_param_count =
 452                                 network->qos_data.param_count;
 453         priv->rtllib->wmm_acm = network->qos_data.wmm_acm;
 454                         queue_work_rsl(priv->priv_wq, &priv->qos_activate);
 455                         RT_TRACE(COMP_QOS,
 456                                  "QoS parameters change call qos_activate\n");
 457                 }
 458         } else {
 459                 memcpy(&priv->rtllib->current_network.qos_data.parameters,
 460                        &def_qos_parameters, size);
 461
 462                 if ((network->qos_data.active == 1) && (active_network == 1)) {
 463                         queue_work_rsl(priv->priv_wq, &priv->qos_activate);
 464                         RT_TRACE(COMP_QOS,
 465                                  "QoS was disabled call qos_activate\n");
 466                 }
 467                 network->qos_data.active = 0;
 468                 network->qos_data.supported = 0;
 469         }
 470
 471         return 0;
 472 }
 473
 474 static int rtl8192_handle_beacon(struct net_device *dev,
 475         struct rtllib_beacon *beacon,
 476         struct rtllib_network *network)
 477 {
 478         struct r8192_priv *priv = rtllib_priv(dev);
 479
 480         rtl8192_qos_handle_probe_response(priv, 1, network);
 481
 482         queue_delayed_work_rsl(priv->priv_wq, &priv->update_beacon_wq, 0);
 483         return 0;
 484
 485 }
 486
 487 static int rtl8192_qos_association_resp(struct r8192_priv *priv,
 488         struct rtllib_network *network)
 489 {
 490         unsigned long flags;
 491         u32 size = sizeof(struct rtllib_qos_parameters);
 492         int set_qos_param = 0;
 493
 494         if ((priv == NULL) || (network == NULL))
 495                 return 0;
 496
 497         if (priv->rtllib->state != RTLLIB_LINKED)
 498                 return 0;
 499
 500         if (priv->rtllib->iw_mode != IW_MODE_INFRA)
 501                 return 0;
 502
 503         spin_lock_irqsave(&priv->rtllib->lock, flags);
 504         if (network->flags & NETWORK_HAS_QOS_PARAMETERS) {
 505                 memcpy(&priv->rtllib->current_network.qos_data.parameters,
 506                        &network->qos_data.parameters,
 507                        sizeof(struct rtllib_qos_parameters));
 508                 priv->rtllib->current_network.qos_data.active = 1;
 509                 priv->rtllib->wmm_acm = network->qos_data.wmm_acm;
 510                 set_qos_param = 1;
 511                 priv->rtllib->current_network.qos_data.old_param_count =
 512                         priv->rtllib->current_network.qos_data.param_count;
 513                 priv->rtllib->current_network.qos_data.param_count =
 514                         network->qos_data.param_count;
 515         } else {
 516                 memcpy(&priv->rtllib->current_network.qos_data.parameters,
 517                 &def_qos_parameters, size);
 518                 priv->rtllib->current_network.qos_data.active = 0;
 519                 priv->rtllib->current_network.qos_data.supported = 0;
 520                 set_qos_param = 1;
 521         }
 522
 523         spin_unlock_irqrestore(&priv->rtllib->lock, flags);
 524
 525         RT_TRACE(COMP_QOS, "%s: network->flags = %d,%d\n", __func__,
 526                  network->flags, priv->rtllib->current_network.qos_data.active);
 527         if (set_qos_param == 1) {
 528                 rtl92e_dm_init_edca_turbo(priv->rtllib->dev);
 529                 queue_work_rsl(priv->priv_wq, &priv->qos_activate);
 530         }
 531         return 0;
 532 }
 533
 534 static int rtl8192_handle_assoc_response(struct net_device *dev,
 535                                  struct rtllib_assoc_response_frame *resp,
 536                                  struct rtllib_network *network)
 537 {
 538         struct r8192_priv *priv = rtllib_priv(dev);
 539
 540         rtl8192_qos_association_resp(priv, network);
 541         return 0;
 542 }
 543
 544 static void rtl8192_prepare_beacon(struct r8192_priv *priv)
 545 {
 546         struct net_device *dev = priv->rtllib->dev;
 547         struct sk_buff *pskb = NULL, *pnewskb = NULL;
 548         struct cb_desc *tcb_desc = NULL;
 549         struct rtl8192_tx_ring *ring = NULL;
 550         struct tx_desc *pdesc = NULL;
 551
 552         ring = &priv->tx_ring[BEACON_QUEUE];
 553         pskb = __skb_dequeue(&ring->queue);
 554         kfree_skb(pskb);
 555
 556         pnewskb = rtllib_get_beacon(priv->rtllib);
 557         if (!pnewskb)
 558                 return;
 559
 560         tcb_desc = (struct cb_desc *)(pnewskb->cb + 8);
 561         tcb_desc->queue_index = BEACON_QUEUE;
 562         tcb_desc->data_rate = 2;
 563         tcb_desc->RATRIndex = 7;
 564         tcb_desc->bTxDisableRateFallBack = 1;
 565         tcb_desc->bTxUseDriverAssingedRate = 1;
 566         skb_push(pnewskb, priv->rtllib->tx_headroom);
 567
 568         pdesc = &ring->desc[0];
 569         priv->ops->tx_fill_descriptor(dev, pdesc, tcb_desc, pnewskb);
 570         __skb_queue_tail(&ring->queue, pnewskb);
 571         pdesc->OWN = 1;
 572 }
 573
 574 static void rtl8192_stop_beacon(struct net_device *dev)
 575 {
 576 }
 577
 578 void rtl92e_config_rate(struct net_device *dev, u16 *rate_config)
 579 {
 580         struct r8192_priv *priv = rtllib_priv(dev);
 581         struct rtllib_network *net;
 582         u8 i = 0, basic_rate = 0;
 583
 584         net = &priv->rtllib->current_network;
 585
 586         for (i = 0; i < net->rates_len; i++) {
 587                 basic_rate = net->rates[i] & 0x7f;
 588                 switch (basic_rate) {
 589                 case MGN_1M:
 590                         *rate_config |= RRSR_1M;
 591                         break;
 592                 case MGN_2M:
 593                         *rate_config |= RRSR_2M;
 594                         break;
 595                 case MGN_5_5M:
 596                         *rate_config |= RRSR_5_5M;
 597                         break;
 598                 case MGN_11M:
 599                         *rate_config |= RRSR_11M;
 600                         break;
 601                 case MGN_6M:
 602                         *rate_config |= RRSR_6M;
 603                         break;
 604                 case MGN_9M:
 605                         *rate_config |= RRSR_9M;
 606                         break;
 607                 case MGN_12M:
 608                         *rate_config |= RRSR_12M;
 609                         break;
 610                 case MGN_18M:
 611                         *rate_config |= RRSR_18M;
 612                         break;
 613                 case MGN_24M:
 614                         *rate_config |= RRSR_24M;
 615                         break;
 616                 case MGN_36M:
 617                         *rate_config |= RRSR_36M;
 618                         break;
 619                 case MGN_48M:
 620                         *rate_config |= RRSR_48M;
 621                         break;
 622                 case MGN_54M:
 623                         *rate_config |= RRSR_54M;
 624                         break;
 625                 }
 626         }
 627
 628         for (i = 0; i < net->rates_ex_len; i++) {
 629                 basic_rate = net->rates_ex[i] & 0x7f;
 630                 switch (basic_rate) {
 631                 case MGN_1M:
 632                         *rate_config |= RRSR_1M;
 633                         break;
 634                 case MGN_2M:
 635                         *rate_config |= RRSR_2M;
 636                         break;
 637                 case MGN_5_5M:
 638                         *rate_config |= RRSR_5_5M;
 639                         break;
 640                 case MGN_11M:
 641                         *rate_config |= RRSR_11M;
 642                         break;
 643                 case MGN_6M:
 644                         *rate_config |= RRSR_6M;
 645                         break;
 646                 case MGN_9M:
 647                         *rate_config |= RRSR_9M;
 648                         break;
 649                 case MGN_12M:
 650                         *rate_config |= RRSR_12M;
 651                         break;
 652                 case MGN_18M:
 653                         *rate_config |= RRSR_18M;
 654                         break;
 655                 case MGN_24M:
 656                         *rate_config |= RRSR_24M;
 657                         break;
 658                 case MGN_36M:
 659                         *rate_config |= RRSR_36M;
 660                         break;
 661                 case MGN_48M:
 662                         *rate_config |= RRSR_48M;
 663                         break;
 664                 case MGN_54M:
 665                         *rate_config |= RRSR_54M;
 666                         break;
 667                 }
 668         }
 669 }
 670
 671 static void rtl8192_refresh_supportrate(struct r8192_priv *priv)
 672 {
 673         struct rtllib_device *ieee = priv->rtllib;
 674
 675         if (ieee->mode == WIRELESS_MODE_N_24G ||
 676             ieee->mode == WIRELESS_MODE_N_5G) {
 677                 memcpy(ieee->Regdot11HTOperationalRateSet,
 678                        ieee->RegHTSuppRateSet, 16);
 679                 memcpy(ieee->Regdot11TxHTOperationalRateSet,
 680                        ieee->RegHTSuppRateSet, 16);
 681
 682         } else {
 683                 memset(ieee->Regdot11HTOperationalRateSet, 0, 16);
 684         }
 685 }
 686
 687 static u8 rtl8192_getSupportedWireleeMode(struct net_device *dev)
 688 {
 689         struct r8192_priv *priv = rtllib_priv(dev);
 690         u8 ret = 0;
 691
 692         switch (priv->rf_chip) {
 693         case RF_8225:
 694         case RF_8256:
 695         case RF_6052:
 696         case RF_PSEUDO_11N:
 697                 ret = (WIRELESS_MODE_N_24G|WIRELESS_MODE_G | WIRELESS_MODE_B);
 698                 break;
 699         case RF_8258:
 700                 ret = (WIRELESS_MODE_A | WIRELESS_MODE_N_5G);
 701                 break;
 702         default:
 703                 ret = WIRELESS_MODE_B;
 704                 break;
 705         }
 706         return ret;
 707 }
 708
 709 void rtl92e_set_wireless_mode(struct net_device *dev, u8 wireless_mode)
 710 {
 711         struct r8192_priv *priv = rtllib_priv(dev);
 712         u8 bSupportMode = rtl8192_getSupportedWireleeMode(dev);
 713
 714         if ((wireless_mode == WIRELESS_MODE_AUTO) ||
 715             ((wireless_mode & bSupportMode) == 0)) {
 716                 if (bSupportMode & WIRELESS_MODE_N_24G) {
 717                         wireless_mode = WIRELESS_MODE_N_24G;
 718                 } else if (bSupportMode & WIRELESS_MODE_N_5G) {
 719                         wireless_mode = WIRELESS_MODE_N_5G;
 720                 } else if ((bSupportMode & WIRELESS_MODE_A)) {
 721                         wireless_mode = WIRELESS_MODE_A;
 722                 } else if ((bSupportMode & WIRELESS_MODE_G)) {
 723                         wireless_mode = WIRELESS_MODE_G;
 724                 } else if ((bSupportMode & WIRELESS_MODE_B)) {
 725                         wireless_mode = WIRELESS_MODE_B;
 726                 } else {
 727                         netdev_info(dev,
 728                                     "%s(): Unsupported mode requested. Fallback to 802.11b\n",
 729                                     __func__);
 730                         wireless_mode = WIRELESS_MODE_B;
 731                 }
 732         }
 733
 734         if ((wireless_mode & (WIRELESS_MODE_B | WIRELESS_MODE_G)) ==
 735             (WIRELESS_MODE_G | WIRELESS_MODE_B))
 736                 wireless_mode = WIRELESS_MODE_G;
 737
 738         priv->rtllib->mode = wireless_mode;
 739
 740         ActUpdateChannelAccessSetting(dev, wireless_mode,
 741                                       &priv->ChannelAccessSetting);
 742
 743         if ((wireless_mode == WIRELESS_MODE_N_24G) ||
 744             (wireless_mode == WIRELESS_MODE_N_5G)) {
 745                 priv->rtllib->pHTInfo->bEnableHT = 1;
 746         RT_TRACE(COMP_DBG, "%s(), wireless_mode:%x, bEnableHT = 1\n",
 747                  __func__, wireless_mode);
 748         } else {
 749                 priv->rtllib->pHTInfo->bEnableHT = 0;
 750                 RT_TRACE(COMP_DBG, "%s(), wireless_mode:%x, bEnableHT = 0\n",
 751                          __func__, wireless_mode);
 752         }
 753
 754         RT_TRACE(COMP_INIT, "Current Wireless Mode is %x\n", wireless_mode);
 755         rtl8192_refresh_supportrate(priv);
 756 }
 757
 758 static int _rtl8192_sta_up(struct net_device *dev, bool is_silent_reset)
 759 {
 760         struct r8192_priv *priv = rtllib_priv(dev);
 761         struct rt_pwr_save_ctrl *pPSC = (struct rt_pwr_save_ctrl *)
 762                                         (&(priv->rtllib->PowerSaveControl));
 763         bool init_status = true;
 764
 765         priv->bDriverIsGoingToUnload = false;
 766         priv->bdisable_nic = false;
 767
 768         priv->up = 1;
 769         priv->rtllib->ieee_up = 1;
 770
 771         priv->up_first_time = 0;
 772         RT_TRACE(COMP_INIT, "Bringing up iface");
 773         priv->bfirst_init = true;
 774         init_status = priv->ops->initialize_adapter(dev);
 775         if (!init_status) {
 776                 netdev_err(dev, "%s(): Initialization failed!\n", __func__);
 777                 priv->bfirst_init = false;
 778                 return -1;
 779         }
 780
 781         RT_TRACE(COMP_INIT, "start adapter finished\n");
 782         RT_CLEAR_PS_LEVEL(pPSC, RT_RF_OFF_LEVL_HALT_NIC);
 783         priv->bfirst_init = false;
 784
 785         if (priv->polling_timer_on == 0)
 786                 rtl92e_check_rfctrl_gpio_timer((unsigned long)dev);
 787
 788         if (priv->rtllib->state != RTLLIB_LINKED)
 789                 rtllib_softmac_start_protocol(priv->rtllib, 0);
 790         rtllib_reset_queue(priv->rtllib);
 791         watch_dog_timer_callback((unsigned long) dev);
 792
 793         if (!netif_queue_stopped(dev))
 794                 netif_start_queue(dev);
 795         else
 796                 netif_wake_queue(dev);
 797
 798         return 0;
 799 }
 800
 801 static int rtl8192_sta_down(struct net_device *dev, bool shutdownrf)
 802 {
 803         struct r8192_priv *priv = rtllib_priv(dev);
 804         unsigned long flags = 0;
 805         u8 RFInProgressTimeOut = 0;
 806
 807         if (priv->up == 0)
 808                 return -1;
 809
 810         if (priv->rtllib->rtllib_ips_leave != NULL)
 811                 priv->rtllib->rtllib_ips_leave(dev);
 812
 813         if (priv->rtllib->state == RTLLIB_LINKED)
 814                 rtl92e_leisure_ps_leave(dev);
 815
 816         priv->bDriverIsGoingToUnload = true;
 817         priv->up = 0;
 818         priv->rtllib->ieee_up = 0;
 819         priv->bfirst_after_down = true;
 820         RT_TRACE(COMP_DOWN, "==========>%s()\n", __func__);
 821         if (!netif_queue_stopped(dev))
 822                 netif_stop_queue(dev);
 823
 824         priv->rtllib->wpa_ie_len = 0;
 825         kfree(priv->rtllib->wpa_ie);
 826         priv->rtllib->wpa_ie = NULL;
 827         rtl92e_cam_reset(dev);
 828         memset(priv->rtllib->swcamtable, 0, sizeof(struct sw_cam_table) * 32);
 829         rtl92e_irq_disable(dev);
 830
 831         del_timer_sync(&priv->watch_dog_timer);
 832         rtl8192_cancel_deferred_work(priv);
 833         cancel_delayed_work(&priv->rtllib->hw_wakeup_wq);
 834
 835         rtllib_softmac_stop_protocol(priv->rtllib, 0, true);
 836         spin_lock_irqsave(&priv->rf_ps_lock, flags);
 837         while (priv->RFChangeInProgress) {
 838                 spin_unlock_irqrestore(&priv->rf_ps_lock, flags);
 839                 if (RFInProgressTimeOut > 100) {
 840                         spin_lock_irqsave(&priv->rf_ps_lock, flags);
 841                         break;
 842                 }
 843                 RT_TRACE(COMP_DBG,
 844                          "===>%s():RF is in progress, need to wait until rf change is done.\n",
 845                          __func__);
 846                 mdelay(1);
 847                 RFInProgressTimeOut++;
 848                 spin_lock_irqsave(&priv->rf_ps_lock, flags);
 849         }
 850         priv->RFChangeInProgress = true;
 851         spin_unlock_irqrestore(&priv->rf_ps_lock, flags);
 852         priv->ops->stop_adapter(dev, false);
 853         spin_lock_irqsave(&priv->rf_ps_lock, flags);
 854         priv->RFChangeInProgress = false;
 855         spin_unlock_irqrestore(&priv->rf_ps_lock, flags);
 856         udelay(100);
 857         memset(&priv->rtllib->current_network, 0,
 858                offsetof(struct rtllib_network, list));
 859         RT_TRACE(COMP_DOWN, "<==========%s()\n", __func__);
 860
 861         return 0;
 862 }
 863
 864 static void rtl8192_init_priv_handler(struct net_device *dev)
 865 {
 866         struct r8192_priv *priv = rtllib_priv(dev);
 867
 868         priv->rtllib->softmac_hard_start_xmit   = rtl8192_hard_start_xmit;
 869         priv->rtllib->set_chan                  = rtl8192_set_chan;
 870         priv->rtllib->link_change               = priv->ops->link_change;
 871         priv->rtllib->softmac_data_hard_start_xmit = rtl8192_hard_data_xmit;
 872         priv->rtllib->data_hard_stop            = rtl8192_data_hard_stop;
 873         priv->rtllib->data_hard_resume          = rtl8192_data_hard_resume;
 874         priv->rtllib->check_nic_enough_desc     = rtl8192_check_nic_enough_desc;
 875         priv->rtllib->handle_assoc_response     = rtl8192_handle_assoc_response;
 876         priv->rtllib->handle_beacon             = rtl8192_handle_beacon;
 877         priv->rtllib->SetWirelessMode           = rtl92e_set_wireless_mode;
 878         priv->rtllib->LeisurePSLeave            = rtl92e_leisure_ps_leave;
 879         priv->rtllib->SetBWModeHandler          = rtl92e_set_bw_mode;
 880         priv->rf_set_chan                       = rtl92e_set_channel;
 881
 882         priv->rtllib->start_send_beacons = rtl92e_start_beacon;
 883         priv->rtllib->stop_send_beacons = rtl8192_stop_beacon;
 884
 885         priv->rtllib->sta_wake_up = rtl8192_hw_wakeup;
 886         priv->rtllib->enter_sleep_state = rtl8192_hw_to_sleep;
 887         priv->rtllib->ps_is_queue_empty = rtl8192_is_tx_queue_empty;
 888
 889         priv->rtllib->GetNmodeSupportBySecCfg = rtl92e_get_nmode_support_by_sec;
 890         priv->rtllib->GetHalfNmodeSupportByAPsHandler =
 891                                                 rtl92e_is_halfn_supported_by_ap;
 892
 893         priv->rtllib->SetHwRegHandler = rtl92e_set_reg;
 894         priv->rtllib->AllowAllDestAddrHandler = rtl92e_set_monitor_mode;
 895         priv->rtllib->SetFwCmdHandler = NULL;
 896         priv->rtllib->InitialGainHandler = rtl92e_init_gain;
 897         priv->rtllib->rtllib_ips_leave_wq = rtllib_ips_leave_wq;
 898         priv->rtllib->rtllib_ips_leave = rtllib_ips_leave;
 899
 900         priv->rtllib->LedControlHandler = NULL;
 901         priv->rtllib->UpdateBeaconInterruptHandler = NULL;
 902
 903         priv->rtllib->ScanOperationBackupHandler = rtl92e_scan_op_backup;
 904 }
 905
 906 static void rtl8192_init_priv_constant(struct net_device *dev)
 907 {
 908         struct r8192_priv *priv = rtllib_priv(dev);
 909         struct rt_pwr_save_ctrl *pPSC = (struct rt_pwr_save_ctrl *)
 910                                         &(priv->rtllib->PowerSaveControl);
 911
 912         pPSC->RegMaxLPSAwakeIntvl = 5;
 913 }
 914
 915
 916 static void rtl8192_init_priv_variable(struct net_device *dev)
 917 {
 918         struct r8192_priv *priv = rtllib_priv(dev);
 919         u8 i;
 920
 921         priv->AcmMethod = eAcmWay2_SW;
 922         priv->dot11CurrentPreambleMode = PREAMBLE_AUTO;
 923         priv->rtllib->status = 0;
 924         priv->polling_timer_on = 0;
 925         priv->up_first_time = 1;
 926         priv->blinked_ingpio = false;
 927         priv->bDriverIsGoingToUnload = false;
 928         priv->being_init_adapter = false;
 929         priv->initialized_at_probe = false;
 930         priv->bdisable_nic = false;
 931         priv->bfirst_init = false;
 932         priv->txringcount = 64;
 933         priv->rxbuffersize = 9100;
 934         priv->rxringcount = MAX_RX_COUNT;
 935         priv->irq_enabled = 0;
 936         priv->chan = 1;
 937         priv->RegChannelPlan = 0xf;
 938         priv->rtllib->mode = WIRELESS_MODE_AUTO;
 939         priv->rtllib->iw_mode = IW_MODE_INFRA;
 940         priv->rtllib->bNetPromiscuousMode = false;
 941         priv->rtllib->IntelPromiscuousModeInfo.bPromiscuousOn = false;
 942         priv->rtllib->IntelPromiscuousModeInfo.bFilterSourceStationFrame =
 943                                                                  false;
 944         priv->rtllib->ieee_up = 0;
 945         priv->retry_rts = DEFAULT_RETRY_RTS;
 946         priv->retry_data = DEFAULT_RETRY_DATA;
 947         priv->rtllib->rts = DEFAULT_RTS_THRESHOLD;
 948         priv->rtllib->rate = 110;
 949         priv->rtllib->short_slot = 1;
 950         priv->promisc = (dev->flags & IFF_PROMISC) ? 1 : 0;
 951         priv->bcck_in_ch14 = false;
 952         priv->bfsync_processing  = false;
 953         priv->CCKPresentAttentuation = 0;
 954         priv->rfa_txpowertrackingindex = 0;
 955         priv->rfc_txpowertrackingindex = 0;
 956         priv->CckPwEnl = 6;
 957         priv->ScanDelay = 50;
 958         priv->ResetProgress = RESET_TYPE_NORESET;
 959         priv->bForcedSilentReset = false;
 960         priv->bDisableNormalResetCheck = false;
 961         priv->force_reset = false;
 962         memset(priv->rtllib->swcamtable, 0, sizeof(struct sw_cam_table) * 32);
 963
 964         memset(&priv->InterruptLog, 0, sizeof(struct log_int_8190));
 965         priv->RxCounter = 0;
 966         priv->rtllib->wx_set_enc = 0;
 967         priv->bHwRadioOff = false;
 968         priv->RegRfOff = false;
 969         priv->isRFOff = false;
 970         priv->bInPowerSaveMode = false;
 971         priv->rtllib->RfOffReason = 0;
 972         priv->RFChangeInProgress = false;
 973         priv->bHwRfOffAction = 0;
 974         priv->SetRFPowerStateInProgress = false;
 975         priv->rtllib->PowerSaveControl.bInactivePs = true;
 976         priv->rtllib->PowerSaveControl.bIPSModeBackup = false;
 977         priv->rtllib->PowerSaveControl.bLeisurePs = true;
 978         priv->rtllib->PowerSaveControl.bFwCtrlLPS = false;
 979         priv->rtllib->LPSDelayCnt = 0;
 980         priv->rtllib->sta_sleep = LPS_IS_WAKE;
 981         priv->rtllib->eRFPowerState = eRfOn;
 982
 983         priv->rtllib->current_network.beacon_interval = DEFAULT_BEACONINTERVAL;
 984         priv->rtllib->iw_mode = IW_MODE_INFRA;
 985         priv->rtllib->active_scan = 1;
 986         priv->rtllib->be_scan_inprogress = false;
 987         priv->rtllib->modulation = RTLLIB_CCK_MODULATION |
 988                                    RTLLIB_OFDM_MODULATION;
 989         priv->rtllib->host_encrypt = 1;
 990         priv->rtllib->host_decrypt = 1;
 991
 992         priv->rtllib->fts = DEFAULT_FRAG_THRESHOLD;
 993
 994         priv->card_type = PCI;
 995
 996         priv->pFirmware = vzalloc(sizeof(struct rt_firmware));
 997         if (!priv->pFirmware)
 998                 netdev_err(dev,
 999                            "rtl8192e: Unable to allocate space for firmware\n");
1000
1001         skb_queue_head_init(&priv->skb_queue);
1002
1003         for (i = 0; i < MAX_QUEUE_SIZE; i++)
1004                 skb_queue_head_init(&priv->rtllib->skb_waitQ[i]);
1005         for (i = 0; i < MAX_QUEUE_SIZE; i++)
1006                 skb_queue_head_init(&priv->rtllib->skb_aggQ[i]);
1007 }
1008
1009 static void rtl8192_init_priv_lock(struct r8192_priv *priv)
1010 {
1011         spin_lock_init(&priv->tx_lock);
1012         spin_lock_init(&priv->irq_th_lock);
1013         spin_lock_init(&priv->rf_ps_lock);
1014         spin_lock_init(&priv->ps_lock);
1015         sema_init(&priv->wx_sem, 1);
1016         sema_init(&priv->rf_sem, 1);
1017         mutex_init(&priv->mutex);
1018 }
1019
1020 static void rtl8192_init_priv_task(struct net_device *dev)
1021 {
1022         struct r8192_priv *priv = rtllib_priv(dev);
1023
1024         priv->priv_wq = create_workqueue(DRV_NAME);
1025         INIT_WORK_RSL(&priv->reset_wq, (void *)rtl8192_restart, dev);
1026         INIT_WORK_RSL(&priv->rtllib->ips_leave_wq, (void *)rtl92e_ips_leave_wq,
1027                       dev);
1028         INIT_DELAYED_WORK_RSL(&priv->watch_dog_wq,
1029                               (void *)rtl819x_watchdog_wqcallback, dev);
1030         INIT_DELAYED_WORK_RSL(&priv->txpower_tracking_wq,
1031                               (void *)rtl92e_dm_txpower_tracking_wq, dev);
1032         INIT_DELAYED_WORK_RSL(&priv->rfpath_check_wq,
1033                               (void *)rtl92e_dm_rf_pathcheck_wq, dev);
1034         INIT_DELAYED_WORK_RSL(&priv->update_beacon_wq,
1035                               (void *)rtl8192_update_beacon, dev);
1036         INIT_WORK_RSL(&priv->qos_activate, (void *)rtl8192_qos_activate, dev);
1037         INIT_DELAYED_WORK_RSL(&priv->rtllib->hw_wakeup_wq,
1038                               (void *) rtl8192_hw_wakeup_wq, dev);
1039         INIT_DELAYED_WORK_RSL(&priv->rtllib->hw_sleep_wq,
1040                               (void *) rtl92e_hw_sleep_wq, dev);
1041         tasklet_init(&priv->irq_rx_tasklet,
1042                      (void(*)(unsigned long))rtl8192_irq_rx_tasklet,
1043                      (unsigned long)priv);
1044         tasklet_init(&priv->irq_tx_tasklet,
1045                      (void(*)(unsigned long))rtl8192_irq_tx_tasklet,
1046                      (unsigned long)priv);
1047         tasklet_init(&priv->irq_prepare_beacon_tasklet,
1048                      (void(*)(unsigned long))rtl8192_prepare_beacon,
1049                      (unsigned long)priv);
1050 }
1051
1052 static short rtl8192_get_channel_map(struct net_device *dev)
1053 {
1054         int i;
1055
1056         struct r8192_priv *priv = rtllib_priv(dev);
1057
1058         if ((priv->rf_chip != RF_8225) && (priv->rf_chip != RF_8256)
1059                         && (priv->rf_chip != RF_6052)) {
1060                 netdev_err(dev, "%s: unknown rf chip, can't set channel map\n",
1061                            __func__);
1062                 return -1;
1063         }
1064
1065         if (priv->ChannelPlan >= COUNTRY_CODE_MAX) {
1066                 netdev_info(dev,
1067                             "rtl819x_init:Error channel plan! Set to default.\n");
1068                 priv->ChannelPlan = COUNTRY_CODE_FCC;
1069         }
1070         RT_TRACE(COMP_INIT, "Channel plan is %d\n", priv->ChannelPlan);
1071         dot11d_init(priv->rtllib);
1072         Dot11d_Channelmap(priv->ChannelPlan, priv->rtllib);
1073         for (i = 1; i <= 11; i++)
1074                 (priv->rtllib->active_channel_map)[i] = 1;
1075         (priv->rtllib->active_channel_map)[12] = 2;
1076         (priv->rtllib->active_channel_map)[13] = 2;
1077
1078         return 0;
1079 }
1080
1081 static short rtl8192_init(struct net_device *dev)
1082 {
1083         struct r8192_priv *priv = rtllib_priv(dev);
1084
1085         memset(&(priv->stats), 0, sizeof(struct rt_stats));
1086
1087         rtl8192_init_priv_handler(dev);
1088         rtl8192_init_priv_constant(dev);
1089         rtl8192_init_priv_variable(dev);
1090         rtl8192_init_priv_lock(priv);
1091         rtl8192_init_priv_task(dev);
1092         priv->ops->get_eeprom_size(dev);
1093         priv->ops->init_adapter_variable(dev);
1094         rtl8192_get_channel_map(dev);
1095
1096         init_hal_dm(dev);
1097
1098         setup_timer(&priv->watch_dog_timer,
1099                     watch_dog_timer_callback,
1100                     (unsigned long) dev);
1101
1102         setup_timer(&priv->gpio_polling_timer,
1103                     rtl92e_check_rfctrl_gpio_timer,
1104                     (unsigned long)dev);
1105
1106         rtl92e_irq_disable(dev);
1107         if (request_irq(dev->irq, rtl8192_interrupt, IRQF_SHARED,
1108             dev->name, dev)) {
1109                 netdev_err(dev, "Error allocating IRQ %d", dev->irq);
1110                 return -1;
1111         }
1112
1113         priv->irq = dev->irq;
1114         RT_TRACE(COMP_INIT, "IRQ %d\n", dev->irq);
1115
1116         if (rtl8192_pci_initdescring(dev) != 0) {
1117                 netdev_err(dev, "Endopoints initialization failed");
1118                 free_irq(dev->irq, dev);
1119                 return -1;
1120         }
1121
1122         return 0;
1123 }
1124
1125 /***************************************************************************
1126         -------------------------------WATCHDOG STUFF---------------------------
1127 ***************************************************************************/
1128 static short rtl8192_is_tx_queue_empty(struct net_device *dev)
1129 {
1130         int i = 0;
1131         struct r8192_priv *priv = rtllib_priv(dev);
1132
1133         for (i = 0; i <= MGNT_QUEUE; i++) {
1134                 if ((i == TXCMD_QUEUE) || (i == HCCA_QUEUE))
1135                         continue;
1136                 if (skb_queue_len(&(&priv->tx_ring[i])->queue) > 0) {
1137                         netdev_info(dev, "===>tx queue is not empty:%d, %d\n",
1138                                i, skb_queue_len(&(&priv->tx_ring[i])->queue));
1139                         return 0;
1140                 }
1141         }
1142         return 1;
1143 }
1144
1145 static enum reset_type rtl819x_TxCheckStuck(struct net_device *dev)
1146 {
1147         struct r8192_priv *priv = rtllib_priv(dev);
1148         u8      QueueID;
1149         u8      ResetThreshold = NIC_SEND_HANG_THRESHOLD_POWERSAVE;
1150         bool    bCheckFwTxCnt = false;
1151         struct rtl8192_tx_ring  *ring = NULL;
1152         struct sk_buff *skb = NULL;
1153         struct cb_desc *tcb_desc = NULL;
1154         unsigned long flags = 0;
1155
1156         switch (priv->rtllib->ps) {
1157         case RTLLIB_PS_DISABLED:
1158                 ResetThreshold = NIC_SEND_HANG_THRESHOLD_NORMAL;
1159                 break;
1160         case (RTLLIB_PS_MBCAST|RTLLIB_PS_UNICAST):
1161                 ResetThreshold = NIC_SEND_HANG_THRESHOLD_POWERSAVE;
1162                 break;
1163         default:
1164                 ResetThreshold = NIC_SEND_HANG_THRESHOLD_POWERSAVE;
1165                 break;
1166         }
1167         spin_lock_irqsave(&priv->irq_th_lock, flags);
1168         for (QueueID = 0; QueueID < MAX_TX_QUEUE; QueueID++) {
1169                 if (QueueID == TXCMD_QUEUE)
1170                         continue;
1171
1172                 if (QueueID == BEACON_QUEUE)
1173                         continue;
1174
1175                 ring = &priv->tx_ring[QueueID];
1176
1177                 if (skb_queue_len(&ring->queue) == 0) {
1178                         continue;
1179                 } else {
1180                         skb = (&ring->queue)->next;
1181                         tcb_desc = (struct cb_desc *)(skb->cb +
1182                                     MAX_DEV_ADDR_SIZE);
1183                         tcb_desc->nStuckCount++;
1184                         bCheckFwTxCnt = true;
1185                         if (tcb_desc->nStuckCount > 1)
1186                                 netdev_info(dev,
1187                                             "%s: QueueID=%d tcb_desc->nStuckCount=%d\n",
1188                                             __func__, QueueID,
1189                                             tcb_desc->nStuckCount);
1190                 }
1191         }
1192         spin_unlock_irqrestore(&priv->irq_th_lock, flags);
1193
1194         if (bCheckFwTxCnt) {
1195                 if (priv->ops->TxCheckStuckHandler(dev)) {
1196                         RT_TRACE(COMP_RESET,
1197                                  "TxCheckStuck(): Fw indicates no Tx condition!\n");
1198                         return RESET_TYPE_SILENT;
1199                 }
1200         }
1201
1202         return RESET_TYPE_NORESET;
1203 }
1204
1205 static enum reset_type rtl819x_RxCheckStuck(struct net_device *dev)
1206 {
1207         struct r8192_priv *priv = rtllib_priv(dev);
1208
1209         if (priv->ops->RxCheckStuckHandler(dev)) {
1210                 RT_TRACE(COMP_RESET, "RxStuck Condition\n");
1211                 return RESET_TYPE_SILENT;
1212         }
1213
1214         return RESET_TYPE_NORESET;
1215 }
1216
1217 static enum reset_type rtl819x_ifcheck_resetornot(struct net_device *dev)
1218 {
1219         struct r8192_priv *priv = rtllib_priv(dev);
1220         enum reset_type TxResetType = RESET_TYPE_NORESET;
1221         enum reset_type RxResetType = RESET_TYPE_NORESET;
1222         enum rt_rf_power_state rfState;
1223
1224         rfState = priv->rtllib->eRFPowerState;
1225
1226         if (rfState == eRfOn)
1227                 TxResetType = rtl819x_TxCheckStuck(dev);
1228
1229         if (rfState == eRfOn &&
1230             (priv->rtllib->iw_mode == IW_MODE_INFRA) &&
1231             (priv->rtllib->state == RTLLIB_LINKED))
1232                 RxResetType = rtl819x_RxCheckStuck(dev);
1233
1234         if (TxResetType == RESET_TYPE_NORMAL ||
1235             RxResetType == RESET_TYPE_NORMAL) {
1236                 netdev_info(dev, "%s(): TxResetType is %d, RxResetType is %d\n",
1237                             __func__, TxResetType, RxResetType);
1238                 return RESET_TYPE_NORMAL;
1239         } else if (TxResetType == RESET_TYPE_SILENT ||
1240                    RxResetType == RESET_TYPE_SILENT) {
1241                 netdev_info(dev, "%s(): TxResetType is %d, RxResetType is %d\n",
1242                             __func__, TxResetType, RxResetType);
1243                 return RESET_TYPE_SILENT;
1244         } else {
1245                 return RESET_TYPE_NORESET;
1246         }
1247
1248 }
1249
1250 static void rtl819x_silentreset_mesh_bk(struct net_device *dev, u8 IsPortal)
1251 {
1252 }
1253
1254 static void rtl819x_ifsilentreset(struct net_device *dev)
1255 {
1256         struct r8192_priv *priv = rtllib_priv(dev);
1257         u8      reset_times = 0;
1258         int reset_status = 0;
1259         struct rtllib_device *ieee = priv->rtllib;
1260         unsigned long flag;
1261
1262         u8 IsPortal = 0;
1263
1264
1265         if (priv->ResetProgress == RESET_TYPE_NORESET) {
1266
1267                 RT_TRACE(COMP_RESET, "=========>Reset progress!!\n");
1268
1269                 priv->ResetProgress = RESET_TYPE_SILENT;
1270
1271                 spin_lock_irqsave(&priv->rf_ps_lock, flag);
1272                 if (priv->RFChangeInProgress) {
1273                         spin_unlock_irqrestore(&priv->rf_ps_lock, flag);
1274                         goto END;
1275                 }
1276                 priv->RFChangeInProgress = true;
1277                 priv->bResetInProgress = true;
1278                 spin_unlock_irqrestore(&priv->rf_ps_lock, flag);
1279
1280 RESET_START:
1281
1282                 down(&priv->wx_sem);
1283
1284                 if (priv->rtllib->state == RTLLIB_LINKED)
1285                         rtl92e_leisure_ps_leave(dev);
1286
1287                 if (priv->up) {
1288                         netdev_info(dev, "%s():the driver is not up.\n",
1289                                     __func__);
1290                         up(&priv->wx_sem);
1291                         return;
1292                 }
1293                 priv->up = 0;
1294
1295                 RT_TRACE(COMP_RESET, "%s():======>start to down the driver\n",
1296                           __func__);
1297                 mdelay(1000);
1298                 RT_TRACE(COMP_RESET,
1299                          "%s():111111111111111111111111======>start to down the driver\n",
1300                          __func__);
1301
1302                 if (!netif_queue_stopped(dev))
1303                         netif_stop_queue(dev);
1304
1305                 rtl92e_irq_disable(dev);
1306                 del_timer_sync(&priv->watch_dog_timer);
1307                 rtl8192_cancel_deferred_work(priv);
1308                 rtl92e_dm_deinit(dev);
1309                 rtllib_stop_scan_syncro(ieee);
1310
1311                 if (ieee->state == RTLLIB_LINKED) {
1312                         SEM_DOWN_IEEE_WX(&ieee->wx_sem);
1313                         netdev_info(dev, "ieee->state is RTLLIB_LINKED\n");
1314                         rtllib_stop_send_beacons(priv->rtllib);
1315                         del_timer_sync(&ieee->associate_timer);
1316                         cancel_delayed_work(&ieee->associate_retry_wq);
1317                         rtllib_stop_scan(ieee);
1318                         netif_carrier_off(dev);
1319                         SEM_UP_IEEE_WX(&ieee->wx_sem);
1320                 } else {
1321                         netdev_info(dev, "ieee->state is NOT LINKED\n");
1322                         rtllib_softmac_stop_protocol(priv->rtllib, 0, true);
1323                 }
1324
1325                 rtl92e_dm_backup_state(dev);
1326
1327                 up(&priv->wx_sem);
1328                 RT_TRACE(COMP_RESET,
1329                          "%s():<==========down process is finished\n",
1330                          __func__);
1331
1332                 RT_TRACE(COMP_RESET, "%s():<===========up process start\n",
1333                          __func__);
1334                 reset_status = _rtl8192_up(dev, true);
1335
1336                 RT_TRACE(COMP_RESET,
1337                          "%s():<===========up process is finished\n", __func__);
1338                 if (reset_status == -1) {
1339                         if (reset_times < 3) {
1340                                 reset_times++;
1341                                 goto RESET_START;
1342                         } else {
1343                                 netdev_warn(dev, "%s(): Reset Failed\n",
1344                                             __func__);
1345                         }
1346                 }
1347
1348                 ieee->is_silent_reset = 1;
1349
1350                 spin_lock_irqsave(&priv->rf_ps_lock, flag);
1351                 priv->RFChangeInProgress = false;
1352                 spin_unlock_irqrestore(&priv->rf_ps_lock, flag);
1353
1354                 rtl92e_enable_hw_security_config(dev);
1355
1356                 if (ieee->state == RTLLIB_LINKED && ieee->iw_mode ==
1357                     IW_MODE_INFRA) {
1358                         ieee->set_chan(ieee->dev,
1359                                        ieee->current_network.channel);
1360
1361                         queue_work_rsl(ieee->wq, &ieee->associate_complete_wq);
1362
1363                 } else if (ieee->state == RTLLIB_LINKED && ieee->iw_mode ==
1364                            IW_MODE_ADHOC) {
1365                         ieee->set_chan(ieee->dev,
1366                                        ieee->current_network.channel);
1367                         ieee->link_change(ieee->dev);
1368
1369                         notify_wx_assoc_event(ieee);
1370
1371                         rtllib_start_send_beacons(ieee);
1372
1373                         if (ieee->data_hard_resume)
1374                                 ieee->data_hard_resume(ieee->dev);
1375                         netif_carrier_on(ieee->dev);
1376                 } else if (ieee->iw_mode == IW_MODE_MESH) {
1377                         rtl819x_silentreset_mesh_bk(dev, IsPortal);
1378                 }
1379
1380                 rtl92e_cam_restore(dev);
1381                 rtl92e_dm_restore_state(dev);
1382 END:
1383                 priv->ResetProgress = RESET_TYPE_NORESET;
1384                 priv->reset_count++;
1385
1386                 priv->bForcedSilentReset = false;
1387                 priv->bResetInProgress = false;
1388
1389                 rtl92e_writeb(dev, UFWP, 1);
1390                 RT_TRACE(COMP_RESET, "Reset finished!! ====>[%d]\n",
1391                          priv->reset_count);
1392         }
1393 }
1394
1395 static void rtl819x_update_rxcounts(struct r8192_priv *priv, u32 *TotalRxBcnNum,
1396                                     u32 *TotalRxDataNum)
1397 {
1398         u16     SlotIndex;
1399         u8      i;
1400
1401         *TotalRxBcnNum = 0;
1402         *TotalRxDataNum = 0;
1403
1404         SlotIndex = (priv->rtllib->LinkDetectInfo.SlotIndex++) %
1405                         (priv->rtllib->LinkDetectInfo.SlotNum);
1406         priv->rtllib->LinkDetectInfo.RxBcnNum[SlotIndex] =
1407                         priv->rtllib->LinkDetectInfo.NumRecvBcnInPeriod;
1408         priv->rtllib->LinkDetectInfo.RxDataNum[SlotIndex] =
1409                         priv->rtllib->LinkDetectInfo.NumRecvDataInPeriod;
1410         for (i = 0; i < priv->rtllib->LinkDetectInfo.SlotNum; i++) {
1411                 *TotalRxBcnNum += priv->rtllib->LinkDetectInfo.RxBcnNum[i];
1412                 *TotalRxDataNum += priv->rtllib->LinkDetectInfo.RxDataNum[i];
1413         }
1414 }
1415
1416 static void rtl819x_watchdog_wqcallback(void *data)
1417 {
1418         struct r8192_priv *priv = container_of_dwork_rsl(data,
1419                                   struct r8192_priv, watch_dog_wq);
1420         struct net_device *dev = priv->rtllib->dev;
1421         struct rtllib_device *ieee = priv->rtllib;
1422         enum reset_type ResetType = RESET_TYPE_NORESET;
1423         static u8 check_reset_cnt;
1424         unsigned long flags;
1425         struct rt_pwr_save_ctrl *pPSC = (struct rt_pwr_save_ctrl *)
1426                                         (&(priv->rtllib->PowerSaveControl));
1427         bool bBusyTraffic = false;
1428         bool    bHigherBusyTraffic = false;
1429         bool    bHigherBusyRxTraffic = false;
1430         bool bEnterPS = false;
1431
1432         if (!priv->up || priv->bHwRadioOff)
1433                 return;
1434
1435         if (priv->rtllib->state >= RTLLIB_LINKED) {
1436                 if (priv->rtllib->CntAfterLink < 2)
1437                         priv->rtllib->CntAfterLink++;
1438         } else {
1439                 priv->rtllib->CntAfterLink = 0;
1440         }
1441
1442         rtl92e_dm_watchdog(dev);
1443
1444         if (rtllib_act_scanning(priv->rtllib, false) == false) {
1445                 if ((ieee->iw_mode == IW_MODE_INFRA) && (ieee->state ==
1446                      RTLLIB_NOLINK) &&
1447                      (ieee->eRFPowerState == eRfOn) && !ieee->is_set_key &&
1448                      (!ieee->proto_stoppping) && !ieee->wx_set_enc) {
1449                         if ((ieee->PowerSaveControl.ReturnPoint ==
1450                              IPS_CALLBACK_NONE) &&
1451                              (!ieee->bNetPromiscuousMode)) {
1452                                 RT_TRACE(COMP_PS,
1453                                          "====================>haha: rtl92e_ips_enter()\n");
1454                                 rtl92e_ips_enter(dev);
1455                         }
1456                 }
1457         }
1458         if ((ieee->state == RTLLIB_LINKED) && (ieee->iw_mode ==
1459              IW_MODE_INFRA) && (!ieee->bNetPromiscuousMode)) {
1460                 if (ieee->LinkDetectInfo.NumRxOkInPeriod > 100 ||
1461                 ieee->LinkDetectInfo.NumTxOkInPeriod > 100)
1462                         bBusyTraffic = true;
1463
1464
1465                 if (ieee->LinkDetectInfo.NumRxOkInPeriod > 4000 ||
1466                     ieee->LinkDetectInfo.NumTxOkInPeriod > 4000) {
1467                         bHigherBusyTraffic = true;
1468                         if (ieee->LinkDetectInfo.NumRxOkInPeriod > 5000)
1469                                 bHigherBusyRxTraffic = true;
1470                         else
1471                                 bHigherBusyRxTraffic = false;
1472                 }
1473
1474                 if (((ieee->LinkDetectInfo.NumRxUnicastOkInPeriod +
1475                     ieee->LinkDetectInfo.NumTxOkInPeriod) > 8) ||
1476                     (ieee->LinkDetectInfo.NumRxUnicastOkInPeriod > 2))
1477                         bEnterPS = false;
1478                 else
1479                         bEnterPS = true;
1480
1481                 if (ieee->current_network.beacon_interval < 95)
1482                         bEnterPS = false;
1483
1484                 if (bEnterPS)
1485                         rtl92e_leisure_ps_enter(dev);
1486                 else
1487                         rtl92e_leisure_ps_leave(dev);
1488
1489         } else {
1490                 RT_TRACE(COMP_LPS, "====>no link LPS leave\n");
1491                 rtl92e_leisure_ps_leave(dev);
1492         }
1493
1494         ieee->LinkDetectInfo.NumRxOkInPeriod = 0;
1495         ieee->LinkDetectInfo.NumTxOkInPeriod = 0;
1496         ieee->LinkDetectInfo.NumRxUnicastOkInPeriod = 0;
1497         ieee->LinkDetectInfo.bBusyTraffic = bBusyTraffic;
1498
1499         ieee->LinkDetectInfo.bHigherBusyTraffic = bHigherBusyTraffic;
1500         ieee->LinkDetectInfo.bHigherBusyRxTraffic = bHigherBusyRxTraffic;
1501
1502         if (ieee->state == RTLLIB_LINKED && ieee->iw_mode == IW_MODE_INFRA) {
1503                 u32     TotalRxBcnNum = 0;
1504                 u32     TotalRxDataNum = 0;
1505
1506                 rtl819x_update_rxcounts(priv, &TotalRxBcnNum, &TotalRxDataNum);
1507
1508                 if ((TotalRxBcnNum+TotalRxDataNum) == 0)
1509                         priv->check_roaming_cnt++;
1510                 else
1511                         priv->check_roaming_cnt = 0;
1512
1513
1514                 if (priv->check_roaming_cnt > 0) {
1515                         if (ieee->eRFPowerState == eRfOff)
1516                                 netdev_info(dev, "%s(): RF is off\n", __func__);
1517
1518                         netdev_info(dev,
1519                                     "===>%s(): AP is power off, chan:%d, connect another one\n",
1520                                     __func__, priv->chan);
1521
1522                         ieee->state = RTLLIB_ASSOCIATING;
1523
1524                         RemovePeerTS(priv->rtllib,
1525                                      priv->rtllib->current_network.bssid);
1526                         ieee->is_roaming = true;
1527                         ieee->is_set_key = false;
1528                         ieee->link_change(dev);
1529                         if (ieee->LedControlHandler)
1530                                 ieee->LedControlHandler(ieee->dev,
1531                                                         LED_CTL_START_TO_LINK);
1532
1533                         notify_wx_assoc_event(ieee);
1534
1535                         if (!(ieee->rtllib_ap_sec_type(ieee) &
1536                              (SEC_ALG_CCMP|SEC_ALG_TKIP)))
1537                                 queue_delayed_work_rsl(ieee->wq,
1538                                         &ieee->associate_procedure_wq, 0);
1539
1540                         priv->check_roaming_cnt = 0;
1541                 }
1542                 ieee->LinkDetectInfo.NumRecvBcnInPeriod = 0;
1543                 ieee->LinkDetectInfo.NumRecvDataInPeriod = 0;
1544
1545         }
1546
1547         spin_lock_irqsave(&priv->tx_lock, flags);
1548         if ((check_reset_cnt++ >= 3) && (!ieee->is_roaming) &&
1549             (!priv->RFChangeInProgress) && (!pPSC->bSwRfProcessing)) {
1550                 ResetType = rtl819x_ifcheck_resetornot(dev);
1551                 check_reset_cnt = 3;
1552         }
1553         spin_unlock_irqrestore(&priv->tx_lock, flags);
1554
1555         if (!priv->bDisableNormalResetCheck && ResetType == RESET_TYPE_NORMAL) {
1556                 priv->ResetProgress = RESET_TYPE_NORMAL;
1557                 RT_TRACE(COMP_RESET, "%s(): NOMAL RESET\n", __func__);
1558                 return;
1559         }
1560
1561         if (((priv->force_reset) || (!priv->bDisableNormalResetCheck &&
1562               ResetType == RESET_TYPE_SILENT)))
1563                 rtl819x_ifsilentreset(dev);
1564         priv->force_reset = false;
1565         priv->bForcedSilentReset = false;
1566         priv->bResetInProgress = false;
1567         RT_TRACE(COMP_TRACE, " <==RtUsbCheckForHangWorkItemCallback()\n");
1568 }
1569
1570 static void watch_dog_timer_callback(unsigned long data)
1571 {
1572         struct r8192_priv *priv = rtllib_priv((struct net_device *)data);
1573
1574         queue_delayed_work_rsl(priv->priv_wq, &priv->watch_dog_wq, 0);
1575         mod_timer(&priv->watch_dog_timer, jiffies +
1576                   msecs_to_jiffies(RTLLIB_WATCH_DOG_TIME));
1577 }
1578
1579 /****************************************************************************
1580  ---------------------------- NIC TX/RX STUFF---------------------------
1581 *****************************************************************************/
1582 void rtl92e_rx_enable(struct net_device *dev)
1583 {
1584         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
1585
1586         priv->ops->rx_enable(dev);
1587 }
1588
1589 void rtl92e_tx_enable(struct net_device *dev)
1590 {
1591         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
1592
1593         priv->ops->tx_enable(dev);
1594
1595         rtllib_reset_queue(priv->rtllib);
1596 }
1597
1598
1599 static void rtl8192_free_rx_ring(struct net_device *dev)
1600 {
1601         struct r8192_priv *priv = rtllib_priv(dev);
1602         int i, rx_queue_idx;
1603
1604         for (rx_queue_idx = 0; rx_queue_idx < MAX_RX_QUEUE;
1605              rx_queue_idx++) {
1606                 for (i = 0; i < priv->rxringcount; i++) {
1607                         struct sk_buff *skb = priv->rx_buf[rx_queue_idx][i];
1608
1609                         if (!skb)
1610                                 continue;
1611
1612                         pci_unmap_single(priv->pdev,
1613                                 *((dma_addr_t *)skb->cb),
1614                                 priv->rxbuffersize, PCI_DMA_FROMDEVICE);
1615                                 kfree_skb(skb);
1616                 }
1617
1618                 pci_free_consistent(priv->pdev,
1619                         sizeof(*priv->rx_ring[rx_queue_idx]) *
1620                         priv->rxringcount,
1621                         priv->rx_ring[rx_queue_idx],
1622                         priv->rx_ring_dma[rx_queue_idx]);
1623                 priv->rx_ring[rx_queue_idx] = NULL;
1624         }
1625 }
1626
1627 static void rtl8192_free_tx_ring(struct net_device *dev, unsigned int prio)
1628 {
1629         struct r8192_priv *priv = rtllib_priv(dev);
1630         struct rtl8192_tx_ring *ring = &priv->tx_ring[prio];
1631
1632         while (skb_queue_len(&ring->queue)) {
1633                 struct tx_desc *entry = &ring->desc[ring->idx];
1634                 struct sk_buff *skb = __skb_dequeue(&ring->queue);
1635
1636                 pci_unmap_single(priv->pdev, entry->TxBuffAddr,
1637                         skb->len, PCI_DMA_TODEVICE);
1638                 kfree_skb(skb);
1639                 ring->idx = (ring->idx + 1) % ring->entries;
1640         }
1641
1642         pci_free_consistent(priv->pdev, sizeof(*ring->desc)*ring->entries,
1643         ring->desc, ring->dma);
1644         ring->desc = NULL;
1645 }
1646
1647 static void rtl8192_data_hard_stop(struct net_device *dev)
1648 {
1649 }
1650
1651 static void rtl8192_data_hard_resume(struct net_device *dev)
1652 {
1653 }
1654
1655 static void rtl8192_hard_data_xmit(struct sk_buff *skb, struct net_device *dev,
1656                             int rate)
1657 {
1658         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
1659         int ret;
1660         struct cb_desc *tcb_desc = (struct cb_desc *)(skb->cb +
1661                                     MAX_DEV_ADDR_SIZE);
1662         u8 queue_index = tcb_desc->queue_index;
1663
1664         if ((priv->rtllib->eRFPowerState == eRfOff) || !priv->up ||
1665              priv->bResetInProgress) {
1666                 kfree_skb(skb);
1667                 return;
1668         }
1669
1670         if (queue_index != TXCMD_QUEUE)
1671                 netdev_warn(dev, "%s(): queue index != TXCMD_QUEUE\n",
1672                             __func__);
1673
1674         memcpy((unsigned char *)(skb->cb), &dev, sizeof(dev));
1675         skb_push(skb, priv->rtllib->tx_headroom);
1676         ret = rtl8192_tx(dev, skb);
1677         if (ret != 0)
1678                 kfree_skb(skb);
1679
1680         if (queue_index != MGNT_QUEUE) {
1681                 priv->rtllib->stats.tx_bytes += (skb->len -
1682                                                  priv->rtllib->tx_headroom);
1683                 priv->rtllib->stats.tx_packets++;
1684         }
1685 }
1686
1687 static int rtl8192_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
1688 {
1689         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
1690         int ret;
1691         struct cb_desc *tcb_desc = (struct cb_desc *)(skb->cb +
1692                                     MAX_DEV_ADDR_SIZE);
1693         u8 queue_index = tcb_desc->queue_index;
1694
1695         if (queue_index != TXCMD_QUEUE) {
1696                 if ((priv->rtllib->eRFPowerState == eRfOff) ||
1697                      !priv->up || priv->bResetInProgress) {
1698                         kfree_skb(skb);
1699                         return 0;
1700                 }
1701         }
1702
1703         memcpy((unsigned char *)(skb->cb), &dev, sizeof(dev));
1704         if (queue_index == TXCMD_QUEUE) {
1705                 rtl8192_tx_cmd(dev, skb);
1706                 return 0;
1707         }
1708
1709         tcb_desc->RATRIndex = 7;
1710         tcb_desc->bTxDisableRateFallBack = 1;
1711         tcb_desc->bTxUseDriverAssingedRate = 1;
1712         tcb_desc->bTxEnableFwCalcDur = 1;
1713         skb_push(skb, priv->rtllib->tx_headroom);
1714         ret = rtl8192_tx(dev, skb);
1715         if (ret != 0)
1716                 kfree_skb(skb);
1717         return ret;
1718 }
1719
1720 static void rtl8192_tx_isr(struct net_device *dev, int prio)
1721 {
1722         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
1723
1724         struct rtl8192_tx_ring *ring = &priv->tx_ring[prio];
1725
1726         while (skb_queue_len(&ring->queue)) {
1727                 struct tx_desc *entry = &ring->desc[ring->idx];
1728                 struct sk_buff *skb;
1729
1730                 if (prio != BEACON_QUEUE) {
1731                         if (entry->OWN)
1732                                 return;
1733                         ring->idx = (ring->idx + 1) % ring->entries;
1734                 }
1735
1736                 skb = __skb_dequeue(&ring->queue);
1737                 pci_unmap_single(priv->pdev, entry->TxBuffAddr,
1738                 skb->len, PCI_DMA_TODEVICE);
1739
1740                 kfree_skb(skb);
1741         }
1742         if (prio != BEACON_QUEUE)
1743                 tasklet_schedule(&priv->irq_tx_tasklet);
1744 }
1745
1746 static void rtl8192_tx_cmd(struct net_device *dev, struct sk_buff *skb)
1747 {
1748         struct r8192_priv *priv = rtllib_priv(dev);
1749         struct rtl8192_tx_ring *ring;
1750         struct tx_desc_cmd *entry;
1751         unsigned int idx;
1752         struct cb_desc *tcb_desc;
1753         unsigned long flags;
1754
1755         spin_lock_irqsave(&priv->irq_th_lock, flags);
1756         ring = &priv->tx_ring[TXCMD_QUEUE];
1757
1758         idx = (ring->idx + skb_queue_len(&ring->queue)) % ring->entries;
1759         entry = (struct tx_desc_cmd *) &ring->desc[idx];
1760
1761         tcb_desc = (struct cb_desc *)(skb->cb + MAX_DEV_ADDR_SIZE);
1762
1763         priv->ops->tx_fill_cmd_descriptor(dev, entry, tcb_desc, skb);
1764
1765         __skb_queue_tail(&ring->queue, skb);
1766         spin_unlock_irqrestore(&priv->irq_th_lock, flags);
1767 }
1768
1769 static short rtl8192_tx(struct net_device *dev, struct sk_buff *skb)
1770 {
1771         struct r8192_priv *priv = rtllib_priv(dev);
1772         struct rtl8192_tx_ring  *ring;
1773         unsigned long flags;
1774         struct cb_desc *tcb_desc = (struct cb_desc *)(skb->cb +
1775                                     MAX_DEV_ADDR_SIZE);
1776         struct tx_desc *pdesc = NULL;
1777         struct rtllib_hdr_1addr *header = NULL;
1778         u16 fc = 0, type = 0, stype = 0;
1779         bool  multi_addr = false, broad_addr = false, uni_addr = false;
1780         u8 *pda_addr = NULL;
1781         int   idx;
1782         u32 fwinfo_size = 0;
1783
1784         if (priv->bdisable_nic) {
1785                 netdev_warn(dev, "%s: Nic is disabled! Can't tx packet.\n",
1786                             __func__);
1787                 return skb->len;
1788         }
1789
1790         priv->rtllib->bAwakePktSent = true;
1791
1792         fwinfo_size = sizeof(struct tx_fwinfo_8190pci);
1793
1794         header = (struct rtllib_hdr_1addr *)(((u8 *)skb->data) + fwinfo_size);
1795         fc = le16_to_cpu(header->frame_ctl);
1796         type = WLAN_FC_GET_TYPE(fc);
1797         stype = WLAN_FC_GET_STYPE(fc);
1798         pda_addr = header->addr1;
1799
1800         if (is_broadcast_ether_addr(pda_addr))
1801                 broad_addr = true;
1802         else if (is_multicast_ether_addr(pda_addr))
1803                 multi_addr = true;
1804         else
1805                 uni_addr = true;
1806
1807         if (uni_addr)
1808                 priv->stats.txbytesunicast += skb->len - fwinfo_size;
1809         else if (multi_addr)
1810                 priv->stats.txbytesmulticast += skb->len - fwinfo_size;
1811         else
1812                 priv->stats.txbytesbroadcast += skb->len - fwinfo_size;
1813
1814         spin_lock_irqsave(&priv->irq_th_lock, flags);
1815         ring = &priv->tx_ring[tcb_desc->queue_index];
1816         if (tcb_desc->queue_index != BEACON_QUEUE)
1817                 idx = (ring->idx + skb_queue_len(&ring->queue)) % ring->entries;
1818         else
1819                 idx = 0;
1820
1821         pdesc = &ring->desc[idx];
1822         if ((pdesc->OWN == 1) && (tcb_desc->queue_index != BEACON_QUEUE)) {
1823                 netdev_warn(dev,
1824                             "No more TX desc@%d, ring->idx = %d, idx = %d, skblen = 0x%x queuelen=%d",
1825                             tcb_desc->queue_index, ring->idx, idx, skb->len,
1826                             skb_queue_len(&ring->queue));
1827                 spin_unlock_irqrestore(&priv->irq_th_lock, flags);
1828                 return skb->len;
1829         }
1830
1831         if (type == RTLLIB_FTYPE_DATA) {
1832                 if (priv->rtllib->LedControlHandler)
1833                         priv->rtllib->LedControlHandler(dev, LED_CTL_TX);
1834         }
1835         priv->ops->tx_fill_descriptor(dev, pdesc, tcb_desc, skb);
1836         __skb_queue_tail(&ring->queue, skb);
1837         pdesc->OWN = 1;
1838         spin_unlock_irqrestore(&priv->irq_th_lock, flags);
1839         dev->trans_start = jiffies;
1840
1841         rtl92e_writew(dev, TPPoll, 0x01 << tcb_desc->queue_index);
1842         return 0;
1843 }
1844
1845 static short rtl8192_alloc_rx_desc_ring(struct net_device *dev)
1846 {
1847         struct r8192_priv *priv = rtllib_priv(dev);
1848         struct rx_desc *entry = NULL;
1849         int i, rx_queue_idx;
1850
1851         for (rx_queue_idx = 0; rx_queue_idx < MAX_RX_QUEUE; rx_queue_idx++) {
1852                 priv->rx_ring[rx_queue_idx] = pci_zalloc_consistent(priv->pdev,
1853                                               sizeof(*priv->rx_ring[rx_queue_idx]) * priv->rxringcount,
1854                                               &priv->rx_ring_dma[rx_queue_idx]);
1855                 if (!priv->rx_ring[rx_queue_idx] ||
1856                     (unsigned long)priv->rx_ring[rx_queue_idx] & 0xFF) {
1857                         netdev_warn(dev, "Cannot allocate RX ring\n");
1858                         return -ENOMEM;
1859                 }
1860
1861                 priv->rx_idx[rx_queue_idx] = 0;
1862
1863                 for (i = 0; i < priv->rxringcount; i++) {
1864                         struct sk_buff *skb = dev_alloc_skb(priv->rxbuffersize);
1865                         dma_addr_t *mapping;
1866
1867                         entry = &priv->rx_ring[rx_queue_idx][i];
1868                         if (!skb)
1869                                 return 0;
1870                         skb->dev = dev;
1871                         priv->rx_buf[rx_queue_idx][i] = skb;
1872                         mapping = (dma_addr_t *)skb->cb;
1873                         *mapping = pci_map_single(priv->pdev,
1874                                                   skb_tail_pointer_rsl(skb),
1875                                                   priv->rxbuffersize,
1876                                                   PCI_DMA_FROMDEVICE);
1877                         if (pci_dma_mapping_error(priv->pdev, *mapping)) {
1878                                 dev_kfree_skb_any(skb);
1879                                 return -1;
1880                         }
1881                         entry->BufferAddress = *mapping;
1882
1883                         entry->Length = priv->rxbuffersize;
1884                         entry->OWN = 1;
1885                 }
1886
1887                 if (entry)
1888                         entry->EOR = 1;
1889         }
1890         return 0;
1891 }
1892
1893 static int rtl8192_alloc_tx_desc_ring(struct net_device *dev,
1894         unsigned int prio, unsigned int entries)
1895 {
1896         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
1897         struct tx_desc *ring;
1898         dma_addr_t dma;
1899         int i;
1900
1901         ring = pci_zalloc_consistent(priv->pdev, sizeof(*ring) * entries, &dma);
1902         if (!ring || (unsigned long)ring & 0xFF) {
1903                 netdev_warn(dev, "Cannot allocate TX ring (prio = %d)\n", prio);
1904                 return -ENOMEM;
1905         }
1906
1907         priv->tx_ring[prio].desc = ring;
1908         priv->tx_ring[prio].dma = dma;
1909         priv->tx_ring[prio].idx = 0;
1910         priv->tx_ring[prio].entries = entries;
1911         skb_queue_head_init(&priv->tx_ring[prio].queue);
1912
1913         for (i = 0; i < entries; i++)
1914                 ring[i].NextDescAddress =
1915                         (u32)dma + ((i + 1) % entries) *
1916                         sizeof(*ring);
1917
1918         return 0;
1919 }
1920
1921 static short rtl8192_pci_initdescring(struct net_device *dev)
1922 {
1923         u32 ret;
1924         int i;
1925         struct r8192_priv *priv = rtllib_priv(dev);
1926
1927         ret = rtl8192_alloc_rx_desc_ring(dev);
1928         if (ret)
1929                 return ret;
1930
1931         for (i = 0; i < MAX_TX_QUEUE_COUNT; i++) {
1932                 ret = rtl8192_alloc_tx_desc_ring(dev, i, priv->txringcount);
1933                 if (ret)
1934                         goto err_free_rings;
1935         }
1936
1937         return 0;
1938
1939 err_free_rings:
1940         rtl8192_free_rx_ring(dev);
1941         for (i = 0; i < MAX_TX_QUEUE_COUNT; i++)
1942                 if (priv->tx_ring[i].desc)
1943                         rtl8192_free_tx_ring(dev, i);
1944         return 1;
1945 }
1946
1947 void rtl92e_reset_desc_ring(struct net_device *dev)
1948 {
1949         struct r8192_priv *priv = rtllib_priv(dev);
1950         int i, rx_queue_idx;
1951         unsigned long flags = 0;
1952
1953         for (rx_queue_idx = 0; rx_queue_idx < MAX_RX_QUEUE; rx_queue_idx++) {
1954                 if (priv->rx_ring[rx_queue_idx]) {
1955                         struct rx_desc *entry = NULL;
1956
1957                         for (i = 0; i < priv->rxringcount; i++) {
1958                                 entry = &priv->rx_ring[rx_queue_idx][i];
1959                                 entry->OWN = 1;
1960                         }
1961                         priv->rx_idx[rx_queue_idx] = 0;
1962                 }
1963         }
1964
1965         spin_lock_irqsave(&priv->irq_th_lock, flags);
1966         for (i = 0; i < MAX_TX_QUEUE_COUNT; i++) {
1967                 if (priv->tx_ring[i].desc) {
1968                         struct rtl8192_tx_ring *ring = &priv->tx_ring[i];
1969
1970                         while (skb_queue_len(&ring->queue)) {
1971                                 struct tx_desc *entry = &ring->desc[ring->idx];
1972                                 struct sk_buff *skb =
1973                                                  __skb_dequeue(&ring->queue);
1974
1975                                 pci_unmap_single(priv->pdev,
1976                                                  entry->TxBuffAddr,
1977                                                  skb->len, PCI_DMA_TODEVICE);
1978                                 kfree_skb(skb);
1979                                 ring->idx = (ring->idx + 1) % ring->entries;
1980                         }
1981                         ring->idx = 0;
1982                 }
1983         }
1984         spin_unlock_irqrestore(&priv->irq_th_lock, flags);
1985 }
1986
1987 void rtl92e_update_rx_pkt_timestamp(struct net_device *dev,
1988                                     struct rtllib_rx_stats *stats)
1989 {
1990         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
1991
1992         if (stats->bIsAMPDU && !stats->bFirstMPDU)
1993                 stats->mac_time = priv->LastRxDescTSF;
1994         else
1995                 priv->LastRxDescTSF = stats->mac_time;
1996 }
1997
1998 long rtl92e_translate_to_dbm(struct r8192_priv *priv, u8 signal_strength_index)
1999 {
2000         long    signal_power;
2001
2002         signal_power = (long)((signal_strength_index + 1) >> 1);
2003         signal_power -= 95;
2004
2005         return signal_power;
2006 }
2007
2008
2009 void rtl92e_update_rx_statistics(struct r8192_priv *priv,
2010                                  struct rtllib_rx_stats *pprevious_stats)
2011 {
2012         int weighting = 0;
2013
2014
2015         if (priv->stats.recv_signal_power == 0)
2016                 priv->stats.recv_signal_power =
2017                                          pprevious_stats->RecvSignalPower;
2018
2019         if (pprevious_stats->RecvSignalPower > priv->stats.recv_signal_power)
2020                 weighting = 5;
2021         else if (pprevious_stats->RecvSignalPower <
2022                  priv->stats.recv_signal_power)
2023                 weighting = (-5);
2024         priv->stats.recv_signal_power = (priv->stats.recv_signal_power * 5 +
2025                                         pprevious_stats->RecvSignalPower +
2026                                         weighting) / 6;
2027 }
2028
2029 u8 rtl92e_rx_db_to_percent(char antpower)
2030 {
2031         if ((antpower <= -100) || (antpower >= 20))
2032                 return  0;
2033         else if (antpower >= 0)
2034                 return  100;
2035         else
2036                 return  100 + antpower;
2037
2038 }       /* QueryRxPwrPercentage */
2039
2040 u8 rtl92e_evm_db_to_percent(char value)
2041 {
2042         char ret_val;
2043
2044         ret_val = value;
2045
2046         if (ret_val >= 0)
2047                 ret_val = 0;
2048         if (ret_val <= -33)
2049                 ret_val = -33;
2050         ret_val = 0 - ret_val;
2051         ret_val *= 3;
2052         if (ret_val == 99)
2053                 ret_val = 100;
2054         return ret_val;
2055 }
2056
2057 void rtl92e_copy_mpdu_stats(struct rtllib_rx_stats *psrc_stats,
2058                             struct rtllib_rx_stats *ptarget_stats)
2059 {
2060         ptarget_stats->bIsAMPDU = psrc_stats->bIsAMPDU;
2061         ptarget_stats->bFirstMPDU = psrc_stats->bFirstMPDU;
2062 }
2063
2064
2065
2066 static void rtl8192_rx_normal(struct net_device *dev)
2067 {
2068         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
2069         struct rtllib_hdr_1addr *rtllib_hdr = NULL;
2070         bool unicast_packet = false;
2071         bool bLedBlinking = true;
2072         u16 fc = 0, type = 0;
2073         u32 skb_len = 0;
2074         int rx_queue_idx = RX_MPDU_QUEUE;
2075
2076         struct rtllib_rx_stats stats = {
2077                 .signal = 0,
2078                 .noise = (u8) -98,
2079                 .rate = 0,
2080                 .freq = RTLLIB_24GHZ_BAND,
2081         };
2082         unsigned int count = priv->rxringcount;
2083
2084         stats.nic_type = NIC_8192E;
2085
2086         while (count--) {
2087                 struct rx_desc *pdesc = &priv->rx_ring[rx_queue_idx]
2088                                         [priv->rx_idx[rx_queue_idx]];
2089                 struct sk_buff *skb = priv->rx_buf[rx_queue_idx]
2090                                       [priv->rx_idx[rx_queue_idx]];
2091                 struct sk_buff *new_skb;
2092
2093                 if (pdesc->OWN)
2094                         return;
2095                 if (!priv->ops->rx_query_status_descriptor(dev, &stats,
2096                 pdesc, skb))
2097                         goto done;
2098                 new_skb = dev_alloc_skb(priv->rxbuffersize);
2099                 /* if allocation of new skb failed - drop current packet
2100                  * and reuse skb
2101                  */
2102                 if (unlikely(!new_skb))
2103                         goto done;
2104
2105                 pci_unmap_single(priv->pdev,
2106                                 *((dma_addr_t *)skb->cb),
2107                                 priv->rxbuffersize,
2108                                 PCI_DMA_FROMDEVICE);
2109
2110                 skb_put(skb, pdesc->Length);
2111                 skb_reserve(skb, stats.RxDrvInfoSize +
2112                         stats.RxBufShift);
2113                 skb_trim(skb, skb->len - 4/*sCrcLng*/);
2114                 rtllib_hdr = (struct rtllib_hdr_1addr *)skb->data;
2115                 if (!is_multicast_ether_addr(rtllib_hdr->addr1)) {
2116                         /* unicast packet */
2117                         unicast_packet = true;
2118                 }
2119                 fc = le16_to_cpu(rtllib_hdr->frame_ctl);
2120                 type = WLAN_FC_GET_TYPE(fc);
2121                 if (type == RTLLIB_FTYPE_MGMT)
2122                         bLedBlinking = false;
2123
2124                 if (bLedBlinking)
2125                         if (priv->rtllib->LedControlHandler)
2126                                 priv->rtllib->LedControlHandler(dev,
2127                                                         LED_CTL_RX);
2128
2129                 if (stats.bCRC) {
2130                         if (type != RTLLIB_FTYPE_MGMT)
2131                                 priv->stats.rxdatacrcerr++;
2132                         else
2133                                 priv->stats.rxmgmtcrcerr++;
2134                 }
2135
2136                 skb_len = skb->len;
2137
2138                 if (!rtllib_rx(priv->rtllib, skb, &stats)) {
2139                         dev_kfree_skb_any(skb);
2140                 } else {
2141                         priv->stats.rxok++;
2142                         if (unicast_packet)
2143                                 priv->stats.rxbytesunicast += skb_len;
2144                 }
2145
2146                 skb = new_skb;
2147                 skb->dev = dev;
2148
2149                 priv->rx_buf[rx_queue_idx][priv->rx_idx[rx_queue_idx]] =
2150                                                                  skb;
2151                 *((dma_addr_t *) skb->cb) = pci_map_single(priv->pdev,
2152                                             skb_tail_pointer_rsl(skb),
2153                                             priv->rxbuffersize,
2154                                             PCI_DMA_FROMDEVICE);
2155                 if (pci_dma_mapping_error(priv->pdev,
2156                                           *((dma_addr_t *)skb->cb))) {
2157                         dev_kfree_skb_any(skb);
2158                         return;
2159                 }
2160 done:
2161                 pdesc->BufferAddress = *((dma_addr_t *)skb->cb);
2162                 pdesc->OWN = 1;
2163                 pdesc->Length = priv->rxbuffersize;
2164                 if (priv->rx_idx[rx_queue_idx] == priv->rxringcount-1)
2165                         pdesc->EOR = 1;
2166                 priv->rx_idx[rx_queue_idx] = (priv->rx_idx[rx_queue_idx] + 1) %
2167                                               priv->rxringcount;
2168         }
2169
2170 }
2171
2172 static void rtl8192_tx_resume(struct net_device *dev)
2173 {
2174         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
2175         struct rtllib_device *ieee = priv->rtllib;
2176         struct sk_buff *skb;
2177         int queue_index;
2178
2179         for (queue_index = BK_QUEUE;
2180              queue_index < MAX_QUEUE_SIZE; queue_index++) {
2181                 while ((!skb_queue_empty(&ieee->skb_waitQ[queue_index])) &&
2182                 (priv->rtllib->check_nic_enough_desc(dev, queue_index) > 0)) {
2183                         skb = skb_dequeue(&ieee->skb_waitQ[queue_index]);
2184                         ieee->softmac_data_hard_start_xmit(skb, dev, 0);
2185                 }
2186         }
2187 }
2188
2189 static void rtl8192_irq_tx_tasklet(struct r8192_priv *priv)
2190 {
2191         rtl8192_tx_resume(priv->rtllib->dev);
2192 }
2193
2194 static void rtl8192_irq_rx_tasklet(struct r8192_priv *priv)
2195 {
2196         rtl8192_rx_normal(priv->rtllib->dev);
2197
2198         rtl92e_writel(priv->rtllib->dev, INTA_MASK,
2199                       rtl92e_readl(priv->rtllib->dev, INTA_MASK) | IMR_RDU);
2200 }
2201
2202 /****************************************************************************
2203  ---------------------------- NIC START/CLOSE STUFF---------------------------
2204 *****************************************************************************/
2205 static void rtl8192_cancel_deferred_work(struct r8192_priv *priv)
2206 {
2207         cancel_delayed_work(&priv->watch_dog_wq);
2208         cancel_delayed_work(&priv->update_beacon_wq);
2209         cancel_delayed_work(&priv->rtllib->hw_sleep_wq);
2210         cancel_work_sync(&priv->reset_wq);
2211         cancel_work_sync(&priv->qos_activate);
2212 }
2213
2214 static int _rtl8192_up(struct net_device *dev, bool is_silent_reset)
2215 {
2216         if (_rtl8192_sta_up(dev, is_silent_reset) == -1)
2217                 return -1;
2218         return 0;
2219 }
2220
2221 static int rtl8192_open(struct net_device *dev)
2222 {
2223         struct r8192_priv *priv = rtllib_priv(dev);
2224         int ret;
2225
2226         down(&priv->wx_sem);
2227         ret = rtl8192_up(dev);
2228         up(&priv->wx_sem);
2229         return ret;
2230
2231 }
2232
2233 static int rtl8192_up(struct net_device *dev)
2234 {
2235         struct r8192_priv *priv = rtllib_priv(dev);
2236
2237         if (priv->up == 1)
2238                 return -1;
2239         return _rtl8192_up(dev, false);
2240 }
2241
2242
2243 static int rtl8192_close(struct net_device *dev)
2244 {
2245         struct r8192_priv *priv = rtllib_priv(dev);
2246         int ret;
2247
2248         if ((rtllib_act_scanning(priv->rtllib, false)) &&
2249                 !(priv->rtllib->softmac_features & IEEE_SOFTMAC_SCAN)) {
2250                 rtllib_stop_scan(priv->rtllib);
2251         }
2252
2253         down(&priv->wx_sem);
2254
2255         ret = rtl8192_down(dev, true);
2256
2257         up(&priv->wx_sem);
2258
2259         return ret;
2260
2261 }
2262
2263 static int rtl8192_down(struct net_device *dev, bool shutdownrf)
2264 {
2265         if (rtl8192_sta_down(dev, shutdownrf) == -1)
2266                 return -1;
2267
2268         return 0;
2269 }
2270
2271 void rtl92e_commit(struct net_device *dev)
2272 {
2273         struct r8192_priv *priv = rtllib_priv(dev);
2274
2275         if (priv->up == 0)
2276                 return;
2277         rtllib_softmac_stop_protocol(priv->rtllib, 0, true);
2278         rtl92e_irq_disable(dev);
2279         priv->ops->stop_adapter(dev, true);
2280         _rtl8192_up(dev, false);
2281 }
2282
2283 static void rtl8192_restart(void *data)
2284 {
2285         struct r8192_priv *priv = container_of_work_rsl(data, struct r8192_priv,
2286                                   reset_wq);
2287         struct net_device *dev = priv->rtllib->dev;
2288
2289         down(&priv->wx_sem);
2290
2291         rtl92e_commit(dev);
2292
2293         up(&priv->wx_sem);
2294 }
2295
2296 static void r8192_set_multicast(struct net_device *dev)
2297 {
2298         struct r8192_priv *priv = rtllib_priv(dev);
2299         short promisc;
2300
2301         promisc = (dev->flags & IFF_PROMISC) ? 1 : 0;
2302         priv->promisc = promisc;
2303
2304 }
2305
2306
2307 static int r8192_set_mac_adr(struct net_device *dev, void *mac)
2308 {
2309         struct r8192_priv *priv = rtllib_priv(dev);
2310         struct sockaddr *addr = mac;
2311
2312         down(&priv->wx_sem);
2313
2314         ether_addr_copy(dev->dev_addr, addr->sa_data);
2315
2316         schedule_work(&priv->reset_wq);
2317         up(&priv->wx_sem);
2318
2319         return 0;
2320 }
2321
2322 /* based on ipw2200 driver */
2323 static int rtl8192_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
2324 {
2325         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
2326         struct iwreq *wrq = (struct iwreq *)rq;
2327         int ret = -1;
2328         struct rtllib_device *ieee = priv->rtllib;
2329         u32 key[4];
2330         const u8 broadcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
2331         struct iw_point *p = &wrq->u.data;
2332         struct ieee_param *ipw = NULL;
2333
2334         down(&priv->wx_sem);
2335
2336         switch (cmd) {
2337         case RTL_IOCTL_WPA_SUPPLICANT:
2338                 if (p->length < sizeof(struct ieee_param) || !p->pointer) {
2339                         ret = -EINVAL;
2340                         goto out;
2341                 }
2342
2343                 ipw = memdup_user(p->pointer, p->length);
2344                 if (IS_ERR(ipw)) {
2345                         ret = PTR_ERR(ipw);
2346                         goto out;
2347                 }
2348
2349                 if (ipw->cmd == IEEE_CMD_SET_ENCRYPTION) {
2350                         if (ipw->u.crypt.set_tx) {
2351                                 if (strcmp(ipw->u.crypt.alg, "CCMP") == 0)
2352                                         ieee->pairwise_key_type = KEY_TYPE_CCMP;
2353                                 else if (strcmp(ipw->u.crypt.alg, "TKIP") == 0)
2354                                         ieee->pairwise_key_type = KEY_TYPE_TKIP;
2355                                 else if (strcmp(ipw->u.crypt.alg, "WEP") == 0) {
2356                                         if (ipw->u.crypt.key_len == 13)
2357                                                 ieee->pairwise_key_type =
2358                                                          KEY_TYPE_WEP104;
2359                                         else if (ipw->u.crypt.key_len == 5)
2360                                                 ieee->pairwise_key_type =
2361                                                          KEY_TYPE_WEP40;
2362                                 } else {
2363                                         ieee->pairwise_key_type = KEY_TYPE_NA;
2364                                 }
2365
2366                                 if (ieee->pairwise_key_type) {
2367                                         if (is_zero_ether_addr(ieee->ap_mac_addr))
2368                                                 ieee->iw_mode = IW_MODE_ADHOC;
2369                                         memcpy((u8 *)key, ipw->u.crypt.key, 16);
2370                                         rtl92e_enable_hw_security_config(dev);
2371                                         rtl92e_set_swcam(dev, 4,
2372                                                          ipw->u.crypt.idx,
2373                                                          ieee->pairwise_key_type,
2374                                                          (u8 *)ieee->ap_mac_addr,
2375                                                          0, key, 0);
2376                                         rtl92e_set_key(dev, 4, ipw->u.crypt.idx,
2377                                                        ieee->pairwise_key_type,
2378                                                        (u8 *)ieee->ap_mac_addr,
2379                                                        0, key);
2380                                         if (ieee->iw_mode == IW_MODE_ADHOC) {
2381                                                 rtl92e_set_swcam(dev,
2382                                                                  ipw->u.crypt.idx,
2383                                                                  ipw->u.crypt.idx,
2384                                                                  ieee->pairwise_key_type,
2385                                                                  (u8 *)ieee->ap_mac_addr,
2386                                                                  0, key, 0);
2387                                                 rtl92e_set_key(dev,
2388                                                                ipw->u.crypt.idx,
2389                                                                ipw->u.crypt.idx,
2390                                                                ieee->pairwise_key_type,
2391                                                                (u8 *)ieee->ap_mac_addr,
2392                                                                0, key);
2393                                         }
2394                                 }
2395                                 if ((ieee->pairwise_key_type == KEY_TYPE_CCMP)
2396                                      && ieee->pHTInfo->bCurrentHTSupport) {
2397                                         rtl92e_writeb(dev, 0x173, 1);
2398                                 }
2399
2400                         } else {
2401                                 memcpy((u8 *)key, ipw->u.crypt.key, 16);
2402                                 if (strcmp(ipw->u.crypt.alg, "CCMP") == 0)
2403                                         ieee->group_key_type = KEY_TYPE_CCMP;
2404                                 else if (strcmp(ipw->u.crypt.alg, "TKIP") == 0)
2405                                         ieee->group_key_type = KEY_TYPE_TKIP;
2406                                 else if (strcmp(ipw->u.crypt.alg, "WEP") == 0) {
2407                                         if (ipw->u.crypt.key_len == 13)
2408                                                 ieee->group_key_type =
2409                                                          KEY_TYPE_WEP104;
2410                                         else if (ipw->u.crypt.key_len == 5)
2411                                                 ieee->group_key_type =
2412                                                          KEY_TYPE_WEP40;
2413                                 } else
2414                                         ieee->group_key_type = KEY_TYPE_NA;
2415
2416                                 if (ieee->group_key_type) {
2417                                         rtl92e_set_swcam(dev, ipw->u.crypt.idx,
2418                                                          ipw->u.crypt.idx,
2419                                                          ieee->group_key_type,
2420                                                          broadcast_addr, 0, key,
2421                                                          0);
2422                                         rtl92e_set_key(dev, ipw->u.crypt.idx,
2423                                                        ipw->u.crypt.idx,
2424                                                        ieee->group_key_type,
2425                                                        broadcast_addr, 0, key);
2426                                 }
2427                         }
2428                 }
2429
2430                 ret = rtllib_wpa_supplicant_ioctl(priv->rtllib, &wrq->u.data,
2431                                                   0);
2432                 kfree(ipw);
2433                 break;
2434         default:
2435                 ret = -EOPNOTSUPP;
2436                 break;
2437         }
2438
2439 out:
2440         up(&priv->wx_sem);
2441
2442         return ret;
2443 }
2444
2445
2446 static irqreturn_t rtl8192_interrupt(int irq, void *netdev)
2447 {
2448         struct net_device *dev = (struct net_device *) netdev;
2449         struct r8192_priv *priv = (struct r8192_priv *)rtllib_priv(dev);
2450         unsigned long flags;
2451         u32 inta;
2452         u32 intb;
2453
2454         intb = 0;
2455
2456         if (priv->irq_enabled == 0)
2457                 goto done;
2458
2459         spin_lock_irqsave(&priv->irq_th_lock, flags);
2460
2461         priv->ops->interrupt_recognized(dev, &inta, &intb);
2462         priv->stats.shints++;
2463
2464         if (!inta) {
2465                 spin_unlock_irqrestore(&priv->irq_th_lock, flags);
2466                 goto done;
2467         }
2468
2469         if (inta == 0xffff) {
2470                 spin_unlock_irqrestore(&priv->irq_th_lock, flags);
2471                 goto done;
2472         }
2473
2474         priv->stats.ints++;
2475
2476         if (!netif_running(dev)) {
2477                 spin_unlock_irqrestore(&priv->irq_th_lock, flags);
2478                 goto done;
2479         }
2480
2481         if (inta & IMR_TBDOK) {
2482                 RT_TRACE(COMP_INTR, "beacon ok interrupt!\n");
2483                 priv->stats.txbeaconokint++;
2484         }
2485
2486         if (inta & IMR_TBDER) {
2487                 RT_TRACE(COMP_INTR, "beacon ok interrupt!\n");
2488                 priv->stats.txbeaconerr++;
2489         }
2490
2491         if (inta & IMR_BDOK)
2492                 RT_TRACE(COMP_INTR, "beacon interrupt!\n");
2493
2494         if (inta  & IMR_MGNTDOK) {
2495                 RT_TRACE(COMP_INTR, "Manage ok interrupt!\n");
2496                 priv->stats.txmanageokint++;
2497                 rtl8192_tx_isr(dev, MGNT_QUEUE);
2498                 spin_unlock_irqrestore(&priv->irq_th_lock, flags);
2499                 if (priv->rtllib->ack_tx_to_ieee) {
2500                         if (rtl8192_is_tx_queue_empty(dev)) {
2501                                 priv->rtllib->ack_tx_to_ieee = 0;
2502                                 rtllib_ps_tx_ack(priv->rtllib, 1);
2503                         }
2504                 }
2505                 spin_lock_irqsave(&priv->irq_th_lock, flags);
2506         }
2507
2508         if (inta & IMR_COMDOK) {
2509                 priv->stats.txcmdpktokint++;
2510                 rtl8192_tx_isr(dev, TXCMD_QUEUE);
2511         }
2512
2513         if (inta & IMR_HIGHDOK)
2514                 rtl8192_tx_isr(dev, HIGH_QUEUE);
2515
2516         if (inta & IMR_ROK) {
2517                 priv->stats.rxint++;
2518                 priv->InterruptLog.nIMR_ROK++;
2519                 tasklet_schedule(&priv->irq_rx_tasklet);
2520         }
2521
2522         if (inta & IMR_BcnInt) {
2523                 RT_TRACE(COMP_INTR, "prepare beacon for interrupt!\n");
2524                 tasklet_schedule(&priv->irq_prepare_beacon_tasklet);
2525         }
2526
2527         if (inta & IMR_RDU) {
2528                 RT_TRACE(COMP_INTR, "rx descriptor unavailable!\n");
2529                 priv->stats.rxrdu++;
2530                 rtl92e_writel(dev, INTA_MASK,
2531                               rtl92e_readl(dev, INTA_MASK) & ~IMR_RDU);
2532                 tasklet_schedule(&priv->irq_rx_tasklet);
2533         }
2534
2535         if (inta & IMR_RXFOVW) {
2536                 RT_TRACE(COMP_INTR, "rx overflow !\n");
2537                 priv->stats.rxoverflow++;
2538                 tasklet_schedule(&priv->irq_rx_tasklet);
2539         }
2540
2541         if (inta & IMR_TXFOVW)
2542                 priv->stats.txoverflow++;
2543
2544         if (inta & IMR_BKDOK) {
2545                 RT_TRACE(COMP_INTR, "BK Tx OK interrupt!\n");
2546                 priv->stats.txbkokint++;
2547                 priv->rtllib->LinkDetectInfo.NumTxOkInPeriod++;
2548                 rtl8192_tx_isr(dev, BK_QUEUE);
2549         }
2550
2551         if (inta & IMR_BEDOK) {
2552                 RT_TRACE(COMP_INTR, "BE TX OK interrupt!\n");
2553                 priv->stats.txbeokint++;
2554                 priv->rtllib->LinkDetectInfo.NumTxOkInPeriod++;
2555                 rtl8192_tx_isr(dev, BE_QUEUE);
2556         }
2557
2558         if (inta & IMR_VIDOK) {
2559                 RT_TRACE(COMP_INTR, "VI TX OK interrupt!\n");
2560                 priv->stats.txviokint++;
2561                 priv->rtllib->LinkDetectInfo.NumTxOkInPeriod++;
2562                 rtl8192_tx_isr(dev, VI_QUEUE);
2563         }
2564
2565         if (inta & IMR_VODOK) {
2566                 priv->stats.txvookint++;
2567                 RT_TRACE(COMP_INTR, "Vo TX OK interrupt!\n");
2568                 priv->rtllib->LinkDetectInfo.NumTxOkInPeriod++;
2569                 rtl8192_tx_isr(dev, VO_QUEUE);
2570         }
2571
2572         spin_unlock_irqrestore(&priv->irq_th_lock, flags);
2573
2574 done:
2575
2576         return IRQ_HANDLED;
2577 }
2578
2579
2580
2581 /****************************************************************************
2582         ---------------------------- PCI_STUFF---------------------------
2583 *****************************************************************************/
2584 static const struct net_device_ops rtl8192_netdev_ops = {
2585         .ndo_open = rtl8192_open,
2586         .ndo_stop = rtl8192_close,
2587         .ndo_tx_timeout = rtl8192_tx_timeout,
2588         .ndo_do_ioctl = rtl8192_ioctl,
2589         .ndo_set_rx_mode = r8192_set_multicast,
2590         .ndo_set_mac_address = r8192_set_mac_adr,
2591         .ndo_validate_addr = eth_validate_addr,
2592         .ndo_change_mtu = eth_change_mtu,
2593         .ndo_start_xmit = rtllib_xmit,
2594 };
2595
2596 static int rtl8192_pci_probe(struct pci_dev *pdev,
2597                         const struct pci_device_id *id)
2598 {
2599         unsigned long ioaddr = 0;
2600         struct net_device *dev = NULL;
2601         struct r8192_priv *priv = NULL;
2602         struct rtl819x_ops *ops = (struct rtl819x_ops *)(id->driver_data);
2603         unsigned long pmem_start, pmem_len, pmem_flags;
2604         int err = -ENOMEM;
2605         u8 revision_id;
2606
2607         RT_TRACE(COMP_INIT, "Configuring chip resources");
2608
2609         if (pci_enable_device(pdev)) {
2610                 dev_err(&pdev->dev, "Failed to enable PCI device");
2611                 return -EIO;
2612         }
2613
2614         pci_set_master(pdev);
2615
2616         if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) {
2617                 if (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32))) {
2618                         dev_info(&pdev->dev,
2619                                  "Unable to obtain 32bit DMA for consistent allocations\n");
2620                         goto err_pci_disable;
2621                 }
2622         }
2623         dev = alloc_rtllib(sizeof(struct r8192_priv));
2624         if (!dev)
2625                 goto err_pci_disable;
2626
2627         err = -ENODEV;
2628
2629         pci_set_drvdata(pdev, dev);
2630         SET_NETDEV_DEV(dev, &pdev->dev);
2631         priv = rtllib_priv(dev);
2632         priv->rtllib = (struct rtllib_device *)netdev_priv_rsl(dev);
2633         priv->pdev = pdev;
2634         priv->rtllib->pdev = pdev;
2635         if ((pdev->subsystem_vendor == PCI_VENDOR_ID_DLINK) &&
2636             (pdev->subsystem_device == 0x3304))
2637                 priv->rtllib->bSupportRemoteWakeUp = 1;
2638         else
2639                 priv->rtllib->bSupportRemoteWakeUp = 0;
2640
2641         pmem_start = pci_resource_start(pdev, 1);
2642         pmem_len = pci_resource_len(pdev, 1);
2643         pmem_flags = pci_resource_flags(pdev, 1);
2644
2645         if (!(pmem_flags & IORESOURCE_MEM)) {
2646                 netdev_err(dev, "region #1 not a MMIO resource, aborting");
2647                 goto err_rel_rtllib;
2648         }
2649
2650         dev_info(&pdev->dev, "Memory mapped space start: 0x%08lx\n",
2651                  pmem_start);
2652         if (!request_mem_region(pmem_start, pmem_len, DRV_NAME)) {
2653                 netdev_err(dev, "request_mem_region failed!");
2654                 goto err_rel_rtllib;
2655         }
2656
2657
2658         ioaddr = (unsigned long)ioremap_nocache(pmem_start, pmem_len);
2659         if (ioaddr == (unsigned long)NULL) {
2660                 netdev_err(dev, "ioremap failed!");
2661                 goto err_rel_mem;
2662         }
2663
2664         dev->mem_start = ioaddr;
2665         dev->mem_end = ioaddr + pci_resource_len(pdev, 0);
2666
2667         pci_read_config_byte(pdev, 0x08, &revision_id);
2668         /* If the revisionid is 0x10, the device uses rtl8192se. */
2669         if (pdev->device == 0x8192 && revision_id == 0x10)
2670                 goto err_rel_mem;
2671
2672         priv->ops = ops;
2673
2674         if (rtl92e_check_adapter(pdev, dev) == false)
2675                 goto err_rel_mem;
2676
2677         dev->irq = pdev->irq;
2678         priv->irq = 0;
2679
2680         dev->netdev_ops = &rtl8192_netdev_ops;
2681
2682         dev->wireless_handlers = &r8192_wx_handlers_def;
2683         dev->ethtool_ops = &rtl819x_ethtool_ops;
2684
2685         dev->type = ARPHRD_ETHER;
2686         dev->watchdog_timeo = HZ * 3;
2687
2688         if (dev_alloc_name(dev, ifname) < 0) {
2689                 RT_TRACE(COMP_INIT,
2690                          "Oops: devname already taken! Trying wlan%%d...\n");
2691                         dev_alloc_name(dev, ifname);
2692         }
2693
2694         RT_TRACE(COMP_INIT, "Driver probe completed1\n");
2695         if (rtl8192_init(dev) != 0) {
2696                 netdev_warn(dev, "Initialization failed");
2697                 goto err_free_irq;
2698         }
2699
2700         netif_carrier_off(dev);
2701         netif_stop_queue(dev);
2702
2703         if (register_netdev(dev))
2704                 goto err_free_irq;
2705         RT_TRACE(COMP_INIT, "dev name: %s\n", dev->name);
2706
2707         if (priv->polling_timer_on == 0)
2708                 rtl92e_check_rfctrl_gpio_timer((unsigned long)dev);
2709
2710         RT_TRACE(COMP_INIT, "Driver probe completed\n");
2711         return 0;
2712
2713 err_free_irq:
2714         free_irq(dev->irq, dev);
2715         priv->irq = 0;
2716 err_rel_mem:
2717         release_mem_region(pmem_start, pmem_len);
2718 err_rel_rtllib:
2719         free_rtllib(dev);
2720 err_pci_disable:
2721         pci_disable_device(pdev);
2722         return err;
2723 }
2724
2725 static void rtl8192_pci_disconnect(struct pci_dev *pdev)
2726 {
2727         struct net_device *dev = pci_get_drvdata(pdev);
2728         struct r8192_priv *priv;
2729         u32 i;
2730
2731         if (dev) {
2732                 unregister_netdev(dev);
2733
2734                 priv = rtllib_priv(dev);
2735
2736                 del_timer_sync(&priv->gpio_polling_timer);
2737                 cancel_delayed_work(&priv->gpio_change_rf_wq);
2738                 priv->polling_timer_on = 0;
2739                 rtl8192_down(dev, true);
2740                 rtl92e_dm_deinit(dev);
2741                 if (priv->pFirmware) {
2742                         vfree(priv->pFirmware);
2743                         priv->pFirmware = NULL;
2744                 }
2745                 destroy_workqueue(priv->priv_wq);
2746                 rtl8192_free_rx_ring(dev);
2747                 for (i = 0; i < MAX_TX_QUEUE_COUNT; i++)
2748                         rtl8192_free_tx_ring(dev, i);
2749
2750                 if (priv->irq) {
2751                         dev_info(&pdev->dev, "Freeing irq %d\n", dev->irq);
2752                         free_irq(dev->irq, dev);
2753                         priv->irq = 0;
2754                 }
2755                 free_rtllib(dev);
2756
2757                 if (dev->mem_start != 0) {
2758                         iounmap((void __iomem *)dev->mem_start);
2759                         release_mem_region(pci_resource_start(pdev, 1),
2760                                         pci_resource_len(pdev, 1));
2761                 }
2762         } else {
2763                 priv = rtllib_priv(dev);
2764         }
2765
2766         pci_disable_device(pdev);
2767         RT_TRACE(COMP_DOWN, "wlan driver removed\n");
2768 }
2769
2770 bool rtl92e_enable_nic(struct net_device *dev)
2771 {
2772         bool init_status = true;
2773         struct r8192_priv *priv = rtllib_priv(dev);
2774         struct rt_pwr_save_ctrl *pPSC = (struct rt_pwr_save_ctrl *)
2775                                         (&(priv->rtllib->PowerSaveControl));
2776
2777         if (!priv->up) {
2778                 netdev_warn(dev, "%s(): Driver is already down!\n", __func__);
2779                 priv->bdisable_nic = false;
2780                 return false;
2781         }
2782
2783         RT_TRACE(COMP_PS, "===========>%s()\n", __func__);
2784         priv->bfirst_init = true;
2785         init_status = priv->ops->initialize_adapter(dev);
2786         if (!init_status) {
2787                 netdev_warn(dev, "%s(): Initialization failed!\n", __func__);
2788                 priv->bdisable_nic = false;
2789                 return false;
2790         }
2791         RT_TRACE(COMP_INIT, "start adapter finished\n");
2792         RT_CLEAR_PS_LEVEL(pPSC, RT_RF_OFF_LEVL_HALT_NIC);
2793         priv->bfirst_init = false;
2794
2795         rtl92e_irq_enable(dev);
2796         priv->bdisable_nic = false;
2797         RT_TRACE(COMP_PS, "<===========%s()\n", __func__);
2798         return init_status;
2799 }
2800 bool rtl92e_disable_nic(struct net_device *dev)
2801 {
2802         struct r8192_priv *priv = rtllib_priv(dev);
2803         u8 tmp_state = 0;
2804
2805         RT_TRACE(COMP_PS, "=========>%s()\n", __func__);
2806         priv->bdisable_nic = true;
2807         tmp_state = priv->rtllib->state;
2808         rtllib_softmac_stop_protocol(priv->rtllib, 0, false);
2809         priv->rtllib->state = tmp_state;
2810         rtl8192_cancel_deferred_work(priv);
2811         rtl92e_irq_disable(dev);
2812
2813         priv->ops->stop_adapter(dev, false);
2814         RT_TRACE(COMP_PS, "<=========%s()\n", __func__);
2815
2816         return true;
2817 }
2818
2819 static int __init rtl8192_pci_module_init(void)
2820 {
2821         pr_info("\nLinux kernel driver for RTL8192E WLAN cards\n");
2822         pr_info("Copyright (c) 2007-2008, Realsil Wlan Driver\n");
2823
2824         if (0 != pci_register_driver(&rtl8192_pci_driver)) {
2825                 /*pci_unregister_driver (&rtl8192_pci_driver);*/
2826                 return -ENODEV;
2827         }
2828         return 0;
2829 }
2830
2831 static void __exit rtl8192_pci_module_exit(void)
2832 {
2833         pci_unregister_driver(&rtl8192_pci_driver);
2834
2835         RT_TRACE(COMP_DOWN, "Exiting");
2836 }
2837
2838 void rtl92e_check_rfctrl_gpio_timer(unsigned long data)
2839 {
2840         struct r8192_priv *priv = rtllib_priv((struct net_device *)data);
2841
2842         priv->polling_timer_on = 1;
2843
2844         queue_delayed_work_rsl(priv->priv_wq, &priv->gpio_change_rf_wq, 0);
2845
2846         mod_timer(&priv->gpio_polling_timer, jiffies +
2847                   msecs_to_jiffies(RTLLIB_WATCH_DOG_TIME));
2848 }
2849
2850 /***************************************************************************
2851         ------------------- module init / exit stubs ----------------
2852 ****************************************************************************/
2853 module_init(rtl8192_pci_module_init);
2854 module_exit(rtl8192_pci_module_exit);
2855
2856 MODULE_DESCRIPTION("Linux driver for Realtek RTL819x WiFi cards");
2857 MODULE_AUTHOR(DRV_COPYRIGHT " " DRV_AUTHOR);
2858 MODULE_VERSION(DRV_VERSION);
2859 MODULE_LICENSE("GPL");
2860 MODULE_FIRMWARE(RTL8192E_BOOT_IMG_FW);
2861 MODULE_FIRMWARE(RTL8192E_MAIN_IMG_FW);
2862 MODULE_FIRMWARE(RTL8192E_DATA_IMG_FW);
2863
2864 module_param(ifname, charp, S_IRUGO|S_IWUSR);
2865 module_param(hwwep, int, S_IRUGO|S_IWUSR);
2866 module_param(channels, int, S_IRUGO|S_IWUSR);
2867
2868 MODULE_PARM_DESC(ifname, " Net interface name, wlan%d=default");
2869 MODULE_PARM_DESC(hwwep, " Try to use hardware WEP support(default use hw. set 0 to use software security)");
2870 MODULE_PARM_DESC(channels, " Channel bitmask for specific locales. NYI");