drivers/staging/rtl8188eu/os_dep/usb_intf.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17  *
  18  *
  19  ******************************************************************************/
  20 #define _HCI_INTF_C_
  21
  22 #include <osdep_service.h>
  23 #include <drv_types.h>
  24 #include <recv_osdep.h>
  25 #include <xmit_osdep.h>
  26 #include <hal_intf.h>
  27 #include <rtw_version.h>
  28 #include <linux/usb.h>
  29 #include <osdep_intf.h>
  30
  31 #include <usb_vendor_req.h>
  32 #include <usb_ops.h>
  33 #include <usb_osintf.h>
  34 #include <usb_hal.h>
  35 #include <rtw_ioctl.h>
  36
  37 int ui_pid[3] = {0, 0, 0};
  38
  39 static int rtw_suspend(struct usb_interface *intf, pm_message_t message);
  40 static int rtw_resume(struct usb_interface *intf);
  41
  42
  43 static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device_id *pdid);
  44 static void rtw_dev_remove(struct usb_interface *pusb_intf);
  45
  46
  47 #define USB_VENDER_ID_REALTEK           0x0bda
  48
  49 /* DID_USB_v916_20130116 */
  50 static struct usb_device_id rtw_usb_id_tbl[] = {
  51         /*=== Realtek demoboard ===*/
  52         {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x8179)}, /* 8188EUS */
  53         {USB_DEVICE(USB_VENDER_ID_REALTEK, 0x0179)}, /* 8188ETV */
  54         /*=== Customer ID ===*/
  55         /****** 8188EUS ********/
  56         {USB_DEVICE(0x8179, 0x07B8)}, /* Abocom - Abocom */
  57         {USB_DEVICE(0x2001, 0x330F)}, /* DLink DWA-125 REV D1 */
  58         {}      /* Terminating entry */
  59 };
  60
  61 MODULE_DEVICE_TABLE(usb, rtw_usb_id_tbl);
  62
  63 static struct specific_device_id specific_device_id_tbl[] = {
  64         {}              /* empty table for now */
  65 };
  66
  67 struct rtw_usb_drv {
  68         struct usb_driver usbdrv;
  69         int drv_registered;
  70         struct mutex hw_init_mutex;
  71 };
  72
  73 static struct rtw_usb_drv rtl8188e_usb_drv = {
  74         .usbdrv.name = (char *)"r8188eu",
  75         .usbdrv.probe = rtw_drv_init,
  76         .usbdrv.disconnect = rtw_dev_remove,
  77         .usbdrv.id_table = rtw_usb_id_tbl,
  78         .usbdrv.suspend =  rtw_suspend,
  79         .usbdrv.resume = rtw_resume,
  80         .usbdrv.reset_resume   = rtw_resume,
  81 };
  82
  83 static struct rtw_usb_drv *usb_drv = &rtl8188e_usb_drv;
  84
  85 static inline int RT_usb_endpoint_dir_in(const struct usb_endpoint_descriptor *epd)
  86 {
  87         return (epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN;
  88 }
  89
  90 static inline int RT_usb_endpoint_dir_out(const struct usb_endpoint_descriptor *epd)
  91 {
  92         return (epd->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT;
  93 }
  94
  95 static inline int RT_usb_endpoint_xfer_int(const struct usb_endpoint_descriptor *epd)
  96 {
  97         return (epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT;
  98 }
  99
 100 static inline int RT_usb_endpoint_xfer_bulk(const struct usb_endpoint_descriptor *epd)
 101 {
 102         return (epd->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK;
 103 }
 104
 105 static inline int RT_usb_endpoint_is_bulk_in(const struct usb_endpoint_descriptor *epd)
 106 {
 107         return RT_usb_endpoint_xfer_bulk(epd) && RT_usb_endpoint_dir_in(epd);
 108 }
 109
 110 static inline int RT_usb_endpoint_is_bulk_out(const struct usb_endpoint_descriptor *epd)
 111 {
 112         return RT_usb_endpoint_xfer_bulk(epd) && RT_usb_endpoint_dir_out(epd);
 113 }
 114
 115 static inline int usb_endpoint_is_int(const struct usb_endpoint_descriptor *epd)
 116 {
 117         return RT_usb_endpoint_xfer_int(epd) && RT_usb_endpoint_dir_in(epd);
 118 }
 119
 120 static inline int RT_usb_endpoint_num(const struct usb_endpoint_descriptor *epd)
 121 {
 122         return epd->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK;
 123 }
 124
 125 static u8 rtw_init_intf_priv(struct dvobj_priv *dvobj)
 126 {
 127         u8 rst = _SUCCESS;
 128
 129         _rtw_mutex_init(&dvobj->usb_vendor_req_mutex);
 130
 131         dvobj->usb_alloc_vendor_req_buf = rtw_zmalloc(MAX_USB_IO_CTL_SIZE);
 132         if (dvobj->usb_alloc_vendor_req_buf == NULL) {
 133                 DBG_88E("alloc usb_vendor_req_buf failed... /n");
 134                 rst = _FAIL;
 135                 goto exit;
 136         }
 137         dvobj->usb_vendor_req_buf = (u8 *)N_BYTE_ALIGMENT((size_t)(dvobj->usb_alloc_vendor_req_buf), ALIGNMENT_UNIT);
 138 exit:
 139         return rst;
 140 }
 141
 142 static u8 rtw_deinit_intf_priv(struct dvobj_priv *dvobj)
 143 {
 144         u8 rst = _SUCCESS;
 145
 146         kfree(dvobj->usb_alloc_vendor_req_buf);
 147         _rtw_mutex_free(&dvobj->usb_vendor_req_mutex);
 148         return rst;
 149 }
 150
 151 static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf)
 152 {
 153         int     i;
 154         int     status = _FAIL;
 155         struct dvobj_priv *pdvobjpriv;
 156         struct usb_host_config          *phost_conf;
 157         struct usb_config_descriptor    *pconf_desc;
 158         struct usb_host_interface       *phost_iface;
 159         struct usb_interface_descriptor *piface_desc;
 160         struct usb_host_endpoint        *phost_endp;
 161         struct usb_endpoint_descriptor  *pendp_desc;
 162         struct usb_device       *pusbd;
 163
 164 _func_enter_;
 165
 166         pdvobjpriv = (struct dvobj_priv *)rtw_zmalloc(sizeof(*pdvobjpriv));
 167         if (pdvobjpriv == NULL)
 168                 goto exit;
 169
 170         pdvobjpriv->pusbintf = usb_intf;
 171         pusbd = interface_to_usbdev(usb_intf);
 172         pdvobjpriv->pusbdev = pusbd;
 173         usb_set_intfdata(usb_intf, pdvobjpriv);
 174
 175         pdvobjpriv->RtNumInPipes = 0;
 176         pdvobjpriv->RtNumOutPipes = 0;
 177
 178         phost_conf = pusbd->actconfig;
 179         pconf_desc = &phost_conf->desc;
 180
 181         phost_iface = &usb_intf->altsetting[0];
 182         piface_desc = &phost_iface->desc;
 183
 184         pdvobjpriv->NumInterfaces = pconf_desc->bNumInterfaces;
 185         pdvobjpriv->InterfaceNumber = piface_desc->bInterfaceNumber;
 186         pdvobjpriv->nr_endpoint = piface_desc->bNumEndpoints;
 187
 188         for (i = 0; i < pdvobjpriv->nr_endpoint; i++) {
 189                 phost_endp = phost_iface->endpoint + i;
 190                 if (phost_endp) {
 191                         pendp_desc = &phost_endp->desc;
 192
 193                         DBG_88E("\nusb_endpoint_descriptor(%d):\n", i);
 194                         DBG_88E("bLength=%x\n", pendp_desc->bLength);
 195                         DBG_88E("bDescriptorType=%x\n",
 196                                 pendp_desc->bDescriptorType);
 197                         DBG_88E("bEndpointAddress=%x\n",
 198                                 pendp_desc->bEndpointAddress);
 199                         DBG_88E("wMaxPacketSize=%d\n",
 200                                 le16_to_cpu(pendp_desc->wMaxPacketSize));
 201                         DBG_88E("bInterval=%x\n", pendp_desc->bInterval);
 202
 203                         if (RT_usb_endpoint_is_bulk_in(pendp_desc)) {
 204                                 DBG_88E("RT_usb_endpoint_is_bulk_in = %x\n",
 205                                         RT_usb_endpoint_num(pendp_desc));
 206                                 pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] = RT_usb_endpoint_num(pendp_desc);
 207                                 pdvobjpriv->RtNumInPipes++;
 208                         } else if (usb_endpoint_is_int(pendp_desc)) {
 209                                 DBG_88E("usb_endpoint_is_int = %x, Interval = %x\n",
 210                                         RT_usb_endpoint_num(pendp_desc),
 211                                         pendp_desc->bInterval);
 212                                 pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] = RT_usb_endpoint_num(pendp_desc);
 213                                 pdvobjpriv->RtNumInPipes++;
 214                         } else if (RT_usb_endpoint_is_bulk_out(pendp_desc)) {
 215                                 DBG_88E("RT_usb_endpoint_is_bulk_out = %x\n",
 216                                         RT_usb_endpoint_num(pendp_desc));
 217                                 pdvobjpriv->RtOutPipe[pdvobjpriv->RtNumOutPipes] = RT_usb_endpoint_num(pendp_desc);
 218                                 pdvobjpriv->RtNumOutPipes++;
 219                         }
 220                         pdvobjpriv->ep_num[i] = RT_usb_endpoint_num(pendp_desc);
 221                 }
 222         }
 223
 224         DBG_88E("nr_endpoint=%d, in_num=%d, out_num=%d\n\n",
 225                 pdvobjpriv->nr_endpoint, pdvobjpriv->RtNumInPipes,
 226                 pdvobjpriv->RtNumOutPipes);
 227
 228         if (pusbd->speed == USB_SPEED_HIGH) {
 229                 pdvobjpriv->ishighspeed = true;
 230                 DBG_88E("USB_SPEED_HIGH\n");
 231         } else {
 232                 pdvobjpriv->ishighspeed = false;
 233                 DBG_88E("NON USB_SPEED_HIGH\n");
 234         }
 235
 236         if (rtw_init_intf_priv(pdvobjpriv) == _FAIL) {
 237                 RT_TRACE(_module_os_intfs_c_, _drv_err_,
 238                          ("\n Can't INIT rtw_init_intf_priv\n"));
 239                 goto free_dvobj;
 240         }
 241
 242         /* 3 misc */
 243         _rtw_init_sema(&(pdvobjpriv->usb_suspend_sema), 0);
 244         rtw_reset_continual_urb_error(pdvobjpriv);
 245
 246         usb_get_dev(pusbd);
 247
 248         status = _SUCCESS;
 249
 250 free_dvobj:
 251         if (status != _SUCCESS && pdvobjpriv) {
 252                 usb_set_intfdata(usb_intf, NULL);
 253                 kfree(pdvobjpriv);
 254                 pdvobjpriv = NULL;
 255         }
 256 exit:
 257 _func_exit_;
 258         return pdvobjpriv;
 259 }
 260
 261 static void usb_dvobj_deinit(struct usb_interface *usb_intf)
 262 {
 263         struct dvobj_priv *dvobj = usb_get_intfdata(usb_intf);
 264
 265 _func_enter_;
 266
 267         usb_set_intfdata(usb_intf, NULL);
 268         if (dvobj) {
 269                 /* Modify condition for 92DU DMDP 2010.11.18, by Thomas */
 270                 if ((dvobj->NumInterfaces != 2 &&
 271                     dvobj->NumInterfaces != 3) ||
 272                     (dvobj->InterfaceNumber == 1)) {
 273                         if (interface_to_usbdev(usb_intf)->state !=
 274                             USB_STATE_NOTATTACHED) {
 275                                 /* If we didn't unplug usb dongle and
 276                                  * remove/insert module, driver fails
 277                                  * on sitesurvey for the first time when
 278                                  * device is up . Reset usb port for sitesurvey
 279                                  * fail issue. */
 280                                 DBG_88E("usb attached..., try to reset usb device\n");
 281                                 usb_reset_device(interface_to_usbdev(usb_intf));
 282                         }
 283                 }
 284                 rtw_deinit_intf_priv(dvobj);
 285                 kfree(dvobj);
 286         }
 287
 288         usb_put_dev(interface_to_usbdev(usb_intf));
 289
 290 _func_exit_;
 291 }
 292
 293 static void chip_by_usb_id(struct adapter *padapter,
 294                            const struct usb_device_id *pdid)
 295 {
 296         padapter->chip_type = NULL_CHIP_TYPE;
 297         hal_set_hw_type(padapter);
 298 }
 299
 300 static void usb_intf_start(struct adapter *padapter)
 301 {
 302         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+usb_intf_start\n"));
 303
 304         rtw_hal_inirp_init(padapter);
 305
 306         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-usb_intf_start\n"));
 307 }
 308
 309 static void usb_intf_stop(struct adapter *padapter)
 310 {
 311         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+usb_intf_stop\n"));
 312
 313         /* disabel_hw_interrupt */
 314         if (!padapter->bSurpriseRemoved) {
 315                 /* device still exists, so driver can do i/o operation */
 316                 /* TODO: */
 317                 RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 318                          ("SurpriseRemoved == false\n"));
 319         }
 320
 321         /* cancel in irp */
 322         rtw_hal_inirp_deinit(padapter);
 323
 324         /* cancel out irp */
 325         rtw_write_port_cancel(padapter);
 326
 327         /* todo:cancel other irps */
 328
 329         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-usb_intf_stop\n"));
 330 }
 331
 332 static void rtw_dev_unload(struct adapter *padapter)
 333 {
 334         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+rtw_dev_unload\n"));
 335
 336         if (padapter->bup) {
 337                 DBG_88E("===> rtw_dev_unload\n");
 338                 padapter->bDriverStopped = true;
 339                 if (padapter->xmitpriv.ack_tx)
 340                         rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP);
 341                 /* s3. */
 342                 if (padapter->intf_stop)
 343                         padapter->intf_stop(padapter);
 344                 /* s4. */
 345                 if (!padapter->pwrctrlpriv.bInternalAutoSuspend)
 346                         rtw_stop_drv_threads(padapter);
 347
 348                 /* s5. */
 349                 if (!padapter->bSurpriseRemoved) {
 350                         rtw_hal_deinit(padapter);
 351                         padapter->bSurpriseRemoved = true;
 352                 }
 353
 354                 padapter->bup = false;
 355         } else {
 356                 RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 357                          ("r871x_dev_unload():padapter->bup == false\n"));
 358         }
 359
 360         DBG_88E("<=== rtw_dev_unload\n");
 361
 362         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-rtw_dev_unload\n"));
 363 }
 364
 365 static void process_spec_devid(const struct usb_device_id *pdid)
 366 {
 367         u16 vid, pid;
 368         u32 flags;
 369         int i;
 370         int num = sizeof(specific_device_id_tbl) /
 371                   sizeof(struct specific_device_id);
 372
 373         for (i = 0; i < num; i++) {
 374                 vid = specific_device_id_tbl[i].idVendor;
 375                 pid = specific_device_id_tbl[i].idProduct;
 376                 flags = specific_device_id_tbl[i].flags;
 377
 378                 if ((pdid->idVendor == vid) && (pdid->idProduct == pid) &&
 379                     (flags&SPEC_DEV_ID_DISABLE_HT)) {
 380                         rtw_ht_enable = 0;
 381                         rtw_cbw40_enable = 0;
 382                         rtw_ampdu_enable = 0;
 383                 }
 384         }
 385 }
 386
 387 int rtw_hw_suspend(struct adapter *padapter)
 388 {
 389         struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
 390         struct net_device *pnetdev = padapter->pnetdev;
 391
 392         _func_enter_;
 393
 394         if ((!padapter->bup) || (padapter->bDriverStopped) ||
 395             (padapter->bSurpriseRemoved)) {
 396                 DBG_88E("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n",
 397                         padapter->bup, padapter->bDriverStopped,
 398                         padapter->bSurpriseRemoved);
 399                 goto error_exit;
 400         }
 401
 402         if (padapter) { /* system suspend */
 403                 LeaveAllPowerSaveMode(padapter);
 404
 405                 DBG_88E("==> rtw_hw_suspend\n");
 406                 _enter_pwrlock(&pwrpriv->lock);
 407                 pwrpriv->bips_processing = true;
 408                 /* s1. */
 409                 if (pnetdev) {
 410                         netif_carrier_off(pnetdev);
 411                         rtw_netif_stop_queue(pnetdev);
 412                 }
 413
 414                 /* s2. */
 415                 rtw_disassoc_cmd(padapter, 500, false);
 416
 417                 /* s2-2.  indicate disconnect to os */
 418                 {
 419                         struct  mlme_priv *pmlmepriv = &padapter->mlmepriv;
 420
 421                         if (check_fwstate(pmlmepriv, _FW_LINKED)) {
 422                                 _clr_fwstate_(pmlmepriv, _FW_LINKED);
 423
 424                                 rtw_led_control(padapter, LED_CTL_NO_LINK);
 425
 426                                 rtw_os_indicate_disconnect(padapter);
 427
 428                                 /* donnot enqueue cmd */
 429                                 rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 0);
 430                         }
 431                 }
 432                 /* s2-3. */
 433                 rtw_free_assoc_resources(padapter, 1);
 434
 435                 /* s2-4. */
 436                 rtw_free_network_queue(padapter, true);
 437                 rtw_ips_dev_unload(padapter);
 438                 pwrpriv->rf_pwrstate = rf_off;
 439                 pwrpriv->bips_processing = false;
 440
 441                 _exit_pwrlock(&pwrpriv->lock);
 442         } else {
 443                 goto error_exit;
 444         }
 445         _func_exit_;
 446         return 0;
 447
 448 error_exit:
 449         DBG_88E("%s, failed\n", __func__);
 450         return -1;
 451 }
 452
 453 int rtw_hw_resume(struct adapter *padapter)
 454 {
 455         struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
 456         struct net_device *pnetdev = padapter->pnetdev;
 457
 458         _func_enter_;
 459
 460         if (padapter) { /* system resume */
 461                 DBG_88E("==> rtw_hw_resume\n");
 462                 _enter_pwrlock(&pwrpriv->lock);
 463                 pwrpriv->bips_processing = true;
 464                 rtw_reset_drv_sw(padapter);
 465
 466                 if (pm_netdev_open(pnetdev, false) != 0) {
 467                         _exit_pwrlock(&pwrpriv->lock);
 468                         goto error_exit;
 469                 }
 470
 471                 netif_device_attach(pnetdev);
 472                 netif_carrier_on(pnetdev);
 473
 474                 if (!netif_queue_stopped(pnetdev))
 475                         netif_start_queue(pnetdev);
 476                 else
 477                         netif_wake_queue(pnetdev);
 478
 479                 pwrpriv->bkeepfwalive = false;
 480                 pwrpriv->brfoffbyhw = false;
 481
 482                 pwrpriv->rf_pwrstate = rf_on;
 483                 pwrpriv->bips_processing = false;
 484
 485                 _exit_pwrlock(&pwrpriv->lock);
 486         } else {
 487                 goto error_exit;
 488         }
 489
 490         _func_exit_;
 491
 492         return 0;
 493 error_exit:
 494         DBG_88E("%s, Open net dev failed\n", __func__);
 495         return -1;
 496 }
 497
 498 static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
 499 {
 500         struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
 501         struct adapter *padapter = dvobj->if1;
 502         struct net_device *pnetdev = padapter->pnetdev;
 503         struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 504         struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
 505
 506         int ret = 0;
 507         u32 start_time = rtw_get_current_time();
 508
 509         _func_enter_;
 510
 511         DBG_88E("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
 512
 513         if ((!padapter->bup) || (padapter->bDriverStopped) ||
 514             (padapter->bSurpriseRemoved)) {
 515                 DBG_88E("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n",
 516                         padapter->bup, padapter->bDriverStopped,
 517                         padapter->bSurpriseRemoved);
 518                 goto exit;
 519         }
 520
 521         pwrpriv->bInSuspend = true;
 522         rtw_cancel_all_timer(padapter);
 523         LeaveAllPowerSaveMode(padapter);
 524
 525         _enter_pwrlock(&pwrpriv->lock);
 526         /* s1. */
 527         if (pnetdev) {
 528                 netif_carrier_off(pnetdev);
 529                 rtw_netif_stop_queue(pnetdev);
 530         }
 531
 532         /* s2. */
 533         rtw_disassoc_cmd(padapter, 0, false);
 534
 535         if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) &&
 536             check_fwstate(pmlmepriv, _FW_LINKED)) {
 537                 DBG_88E("%s:%d %s(%pM), length:%d assoc_ssid.length:%d\n",
 538                         __func__, __LINE__,
 539                         pmlmepriv->cur_network.network.Ssid.Ssid,
 540                         pmlmepriv->cur_network.network.MacAddress,
 541                         pmlmepriv->cur_network.network.Ssid.SsidLength,
 542                         pmlmepriv->assoc_ssid.SsidLength);
 543
 544                 pmlmepriv->to_roaming = 1;
 545         }
 546         /* s2-2.  indicate disconnect to os */
 547         rtw_indicate_disconnect(padapter);
 548         /* s2-3. */
 549         rtw_free_assoc_resources(padapter, 1);
 550         /* s2-4. */
 551         rtw_free_network_queue(padapter, true);
 552
 553         rtw_dev_unload(padapter);
 554         _exit_pwrlock(&pwrpriv->lock);
 555
 556         if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
 557                 rtw_indicate_scan_done(padapter, 1);
 558
 559         if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
 560                 rtw_indicate_disconnect(padapter);
 561
 562 exit:
 563         DBG_88E("<===  %s return %d.............. in %dms\n", __func__
 564                 , ret, rtw_get_passing_time_ms(start_time));
 565
 566         _func_exit_;
 567         return ret;
 568 }
 569
 570 static int rtw_resume(struct usb_interface *pusb_intf)
 571 {
 572         struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
 573         struct adapter *padapter = dvobj->if1;
 574         struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
 575          int ret = 0;
 576
 577         if (pwrpriv->bInternalAutoSuspend)
 578                 ret = rtw_resume_process(padapter);
 579         else
 580                 ret = rtw_resume_process(padapter);
 581         return ret;
 582 }
 583
 584 int rtw_resume_process(struct adapter *padapter)
 585 {
 586         struct net_device *pnetdev;
 587         struct pwrctrl_priv *pwrpriv = NULL;
 588         int ret = -1;
 589         u32 start_time = rtw_get_current_time();
 590         _func_enter_;
 591
 592         DBG_88E("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
 593
 594         if (padapter) {
 595                 pnetdev = padapter->pnetdev;
 596                 pwrpriv = &padapter->pwrctrlpriv;
 597         } else {
 598                 goto exit;
 599         }
 600
 601         _enter_pwrlock(&pwrpriv->lock);
 602         rtw_reset_drv_sw(padapter);
 603         if (pwrpriv)
 604                 pwrpriv->bkeepfwalive = false;
 605
 606         DBG_88E("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
 607         if (pm_netdev_open(pnetdev, true) != 0)
 608                 goto exit;
 609
 610         netif_device_attach(pnetdev);
 611         netif_carrier_on(pnetdev);
 612
 613         _exit_pwrlock(&pwrpriv->lock);
 614
 615         if (padapter->pid[1] != 0) {
 616                 DBG_88E("pid[1]:%d\n", padapter->pid[1]);
 617                 rtw_signal_process(padapter->pid[1], SIGUSR2);
 618         }
 619
 620         rtw_roaming(padapter, NULL);
 621
 622         ret = 0;
 623 exit:
 624         if (pwrpriv)
 625                 pwrpriv->bInSuspend = false;
 626         DBG_88E("<===  %s return %d.............. in %dms\n", __func__,
 627                 ret, rtw_get_passing_time_ms(start_time));
 628
 629         _func_exit_;
 630
 631         return ret;
 632 }
 633
 634 /*
 635  * drv_init() - a device potentially for us
 636  *
 637  * notes: drv_init() is called when the bus driver has located
 638  * a card for us to support.
 639  *        We accept the new device by returning 0.
 640  */
 641
 642 static struct adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
 643         struct usb_interface *pusb_intf, const struct usb_device_id *pdid)
 644 {
 645         struct adapter *padapter = NULL;
 646         struct net_device *pnetdev = NULL;
 647         int status = _FAIL;
 648
 649         padapter = (struct adapter *)rtw_zvmalloc(sizeof(*padapter));
 650         if (padapter == NULL)
 651                 goto exit;
 652         padapter->dvobj = dvobj;
 653         dvobj->if1 = padapter;
 654
 655         padapter->bDriverStopped = true;
 656
 657         padapter->hw_init_mutex = &usb_drv->hw_init_mutex;
 658
 659         /* step 1-1., decide the chip_type via vid/pid */
 660         padapter->interface_type = RTW_USB;
 661         chip_by_usb_id(padapter, pdid);
 662
 663         if (rtw_handle_dualmac(padapter, 1) != _SUCCESS)
 664                 goto free_adapter;
 665
 666         pnetdev = rtw_init_netdev(padapter);
 667         if (pnetdev == NULL)
 668                 goto handle_dualmac;
 669         SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));
 670         padapter = rtw_netdev_priv(pnetdev);
 671
 672         /* step 2. hook HalFunc, allocate HalData */
 673         hal_set_hal_ops(padapter);
 674
 675         padapter->intf_start = &usb_intf_start;
 676         padapter->intf_stop = &usb_intf_stop;
 677
 678         /* step init_io_priv */
 679         rtw_init_io_priv(padapter, usb_set_intf_ops);
 680
 681         /* step read_chip_version */
 682         rtw_hal_read_chip_version(padapter);
 683
 684         /* step usb endpoint mapping */
 685         rtw_hal_chip_configure(padapter);
 686
 687         /* step read efuse/eeprom data and get mac_addr */
 688         rtw_hal_read_chip_info(padapter);
 689
 690         /* step 5. */
 691         if (rtw_init_drv_sw(padapter) == _FAIL) {
 692                 RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 693                          ("Initialize driver software resource Failed!\n"));
 694                 goto free_hal_data;
 695         }
 696
 697 #ifdef CONFIG_PM
 698         if (padapter->pwrctrlpriv.bSupportRemoteWakeup) {
 699                 dvobj->pusbdev->do_remote_wakeup = 1;
 700                 pusb_intf->needs_remote_wakeup = 1;
 701                 device_init_wakeup(&pusb_intf->dev, 1);
 702                 DBG_88E("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n");
 703                 DBG_88E("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",
 704                         device_may_wakeup(&pusb_intf->dev));
 705         }
 706 #endif
 707
 708         /* 2012-07-11 Move here to prevent the 8723AS-VAU BT auto
 709          * suspend influence */
 710         if (usb_autopm_get_interface(pusb_intf) < 0)
 711                         DBG_88E("can't get autopm:\n");
 712
 713         /*  alloc dev name after read efuse. */
 714         rtw_init_netdev_name(pnetdev, padapter->registrypriv.ifname);
 715         rtw_macaddr_cfg(padapter->eeprompriv.mac_addr);
 716 #ifdef CONFIG_88EU_P2P
 717         rtw_init_wifidirect_addrs(padapter, padapter->eeprompriv.mac_addr,
 718                                   padapter->eeprompriv.mac_addr);
 719 #endif
 720         memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
 721         DBG_88E("MAC Address from pnetdev->dev_addr =  %pM\n",
 722                 pnetdev->dev_addr);
 723
 724         /* step 6. Tell the network stack we exist */
 725         if (register_netdev(pnetdev) != 0) {
 726                 RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("register_netdev() failed\n"));
 727                 goto free_hal_data;
 728         }
 729
 730         DBG_88E("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
 731                 , padapter->bDriverStopped
 732                 , padapter->bSurpriseRemoved
 733                 , padapter->bup
 734                 , padapter->hw_init_completed
 735         );
 736
 737         status = _SUCCESS;
 738
 739 free_hal_data:
 740         if (status != _SUCCESS && padapter->HalData)
 741                 kfree(padapter->HalData);
 742 handle_dualmac:
 743         if (status != _SUCCESS)
 744                 rtw_handle_dualmac(padapter, 0);
 745 free_adapter:
 746         if (status != _SUCCESS) {
 747                 if (pnetdev)
 748                         rtw_free_netdev(pnetdev);
 749                 else if (padapter)
 750                         rtw_vmfree((u8 *)padapter, sizeof(*padapter));
 751                 padapter = NULL;
 752         }
 753 exit:
 754         return padapter;
 755 }
 756
 757 static void rtw_usb_if1_deinit(struct adapter *if1)
 758 {
 759         struct net_device *pnetdev = if1->pnetdev;
 760         struct mlme_priv *pmlmepriv = &if1->mlmepriv;
 761
 762         if (check_fwstate(pmlmepriv, _FW_LINKED))
 763                 rtw_disassoc_cmd(if1, 0, false);
 764
 765 #ifdef CONFIG_88EU_AP_MODE
 766         free_mlme_ap_info(if1);
 767 #endif
 768
 769         if (if1->DriverState != DRIVER_DISAPPEAR) {
 770                 if (pnetdev) {
 771                         /* will call netdev_close() */
 772                         unregister_netdev(pnetdev);
 773                         rtw_proc_remove_one(pnetdev);
 774                 }
 775         }
 776         rtw_cancel_all_timer(if1);
 777
 778         rtw_dev_unload(if1);
 779         DBG_88E("+r871xu_dev_remove, hw_init_completed=%d\n",
 780                 if1->hw_init_completed);
 781         rtw_handle_dualmac(if1, 0);
 782         rtw_free_drv_sw(if1);
 783         if (pnetdev)
 784                 rtw_free_netdev(pnetdev);
 785 }
 786
 787 static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device_id *pdid)
 788 {
 789         struct adapter *if1 = NULL;
 790         int status;
 791         struct dvobj_priv *dvobj;
 792
 793         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+rtw_drv_init\n"));
 794
 795         /* step 0. */
 796         process_spec_devid(pdid);
 797
 798         /* Initialize dvobj_priv */
 799         dvobj = usb_dvobj_init(pusb_intf);
 800         if (dvobj == NULL) {
 801                 RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 802                          ("initialize device object priv Failed!\n"));
 803                 goto exit;
 804         }
 805
 806         if1 = rtw_usb_if1_init(dvobj, pusb_intf, pdid);
 807         if (if1 == NULL) {
 808                 DBG_88E("rtw_init_primarystruct adapter Failed!\n");
 809                 goto free_dvobj;
 810         }
 811
 812         if (ui_pid[1] != 0) {
 813                 DBG_88E("ui_pid[1]:%d\n", ui_pid[1]);
 814                 rtw_signal_process(ui_pid[1], SIGUSR2);
 815         }
 816
 817         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-871x_drv - drv_init, success!\n"));
 818
 819         status = _SUCCESS;
 820
 821         if (status != _SUCCESS && if1)
 822                 rtw_usb_if1_deinit(if1);
 823 free_dvobj:
 824         if (status != _SUCCESS)
 825                 usb_dvobj_deinit(pusb_intf);
 826 exit:
 827         return status == _SUCCESS ? 0 : -ENODEV;
 828 }
 829
 830 /*
 831  * dev_remove() - our device is being removed
 832 */
 833 /* rmmod module & unplug(SurpriseRemoved) will call r871xu_dev_remove() => how to recognize both */
 834 static void rtw_dev_remove(struct usb_interface *pusb_intf)
 835 {
 836         struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
 837         struct adapter *padapter = dvobj->if1;
 838
 839 _func_enter_;
 840
 841         DBG_88E("+rtw_dev_remove\n");
 842         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+dev_remove()\n"));
 843
 844         if (usb_drv->drv_registered)
 845                 padapter->bSurpriseRemoved = true;
 846
 847         rtw_pm_set_ips(padapter, IPS_NONE);
 848         rtw_pm_set_lps(padapter, PS_MODE_ACTIVE);
 849
 850         LeaveAllPowerSaveMode(padapter);
 851
 852         rtw_usb_if1_deinit(padapter);
 853
 854         usb_dvobj_deinit(pusb_intf);
 855
 856         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-dev_remove()\n"));
 857         DBG_88E("-r871xu_dev_remove, done\n");
 858 _func_exit_;
 859
 860         return;
 861 }
 862
 863 static int __init rtw_drv_entry(void)
 864 {
 865         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+rtw_drv_entry\n"));
 866
 867         DBG_88E(DRV_NAME " driver version=%s\n", DRIVERVERSION);
 868         DBG_88E("build time: %s %s\n", __DATE__, __TIME__);
 869
 870         rtw_suspend_lock_init();
 871
 872         _rtw_mutex_init(&usb_drv->hw_init_mutex);
 873
 874         usb_drv->drv_registered = true;
 875         return usb_register(&usb_drv->usbdrv);
 876 }
 877
 878 static void __exit rtw_drv_halt(void)
 879 {
 880         RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+rtw_drv_halt\n"));
 881         DBG_88E("+rtw_drv_halt\n");
 882
 883         rtw_suspend_lock_uninit();
 884
 885         usb_drv->drv_registered = false;
 886         usb_deregister(&usb_drv->usbdrv);
 887
 888         _rtw_mutex_free(&usb_drv->hw_init_mutex);
 889         DBG_88E("-rtw_drv_halt\n");
 890 }
 891
 892 module_init(rtw_drv_entry);
 893 module_exit(rtw_drv_halt);