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