drivers/staging/rtl8723au/os_dep/usb_intf.c - nest-learning-thermostat/5.7.1/linux-imx-ul - Git at Google

 /******************************************************************************
  *
  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify it
  * under the terms of version 2 of the GNU General Public License as
  * published by the Free Software Foundation.
  *
  * This program is distributed in the hope that it will be useful, but WITHOUT
  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  * more details.
  *
  ******************************************************************************/
 #define _HCI_INTF_C_

 #include <osdep_service.h>
 #include <drv_types.h>
 #include <recv_osdep.h>
 #include <xmit_osdep.h>
 #include <hal_intf.h>
 #include <rtw_version.h>
 #include <osdep_intf.h>
 #include <usb_ops.h>
 #include <rtl8723a_hal.h>

 static int rtw_suspend(struct usb_interface *intf, pm_message_t message);
 static int rtw_resume(struct usb_interface *intf);
 static int rtw_drv_init(struct usb_interface *pusb_intf,
 			const struct usb_device_id *pdid);
 static void rtw_disconnect(struct usb_interface *pusb_intf);

 #define USB_VENDER_ID_REALTEK		0x0BDA

 #define RTL8723A_USB_IDS \
 	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x8724,	\
 	 0xff, 0xff, 0xff)}, /* 8723AU 1*1 */ \
 	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x1724,	\
 	 0xff, 0xff, 0xff)}, /* 8723AU 1*1 */ \
 	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x0724,	\
 	 0xff, 0xff, 0xff)}, /* 8723AU 1*1 */

 static struct usb_device_id rtl8723a_usb_id_tbl[] = {
 	RTL8723A_USB_IDS
 	{}	/* Terminating entry */
 };

 MODULE_DEVICE_TABLE(usb, rtl8723a_usb_id_tbl);

 static struct usb_driver rtl8723a_usb_drv = {
 	.name = (char *)"rtl8723au",
 	.probe = rtw_drv_init,
 	.disconnect = rtw_disconnect,
 	.id_table = rtl8723a_usb_id_tbl,
 	.suspend = rtw_suspend,
 	.resume = rtw_resume,
 	.reset_resume  = rtw_resume,
 };

 static struct usb_driver *usb_drv = &rtl8723a_usb_drv;

 static int rtw_init_intf_priv(struct dvobj_priv *dvobj)
 {
 	mutex_init(&dvobj->usb_vendor_req_mutex);

 	return _SUCCESS;
 }

 static int rtw_deinit_intf_priv(struct dvobj_priv *dvobj)
 {
 	mutex_destroy(&dvobj->usb_vendor_req_mutex);

 	return _SUCCESS;
 }

 static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf)
 {
 	struct dvobj_priv *pdvobjpriv;
 	struct usb_host_config	 *phost_conf;
 	struct usb_config_descriptor *pconf_desc;
 	struct usb_host_interface *phost_iface;
 	struct usb_interface_descriptor *piface_desc;
 	struct usb_endpoint_descriptor *pendp_desc;
 	struct usb_device *pusbd;
 	int i, status = _FAIL;

 	pdvobjpriv = kzalloc(sizeof(*pdvobjpriv), GFP_KERNEL);
 	if (!pdvobjpriv)
 		goto exit;

 	mutex_init(&pdvobjpriv->hw_init_mutex);
 	mutex_init(&pdvobjpriv->h2c_fwcmd_mutex);
 	mutex_init(&pdvobjpriv->setch_mutex);
 	mutex_init(&pdvobjpriv->setbw_mutex);

 	pdvobjpriv->pusbintf = usb_intf;
 	pusbd = interface_to_usbdev(usb_intf);
 	pdvobjpriv->pusbdev = pusbd;
 	usb_set_intfdata(usb_intf, pdvobjpriv);

 	pdvobjpriv->RtNumInPipes = 0;
 	pdvobjpriv->RtNumOutPipes = 0;

 	phost_conf = pusbd->actconfig;
 	pconf_desc = &phost_conf->desc;

 	phost_iface = &usb_intf->altsetting[0];
 	piface_desc = &phost_iface->desc;

 	pdvobjpriv->NumInterfaces = pconf_desc->bNumInterfaces;
 	pdvobjpriv->InterfaceNumber = piface_desc->bInterfaceNumber;
 	pdvobjpriv->nr_endpoint = piface_desc->bNumEndpoints;

 	for (i = 0; i < pdvobjpriv->nr_endpoint; i++) {
 		pendp_desc = &phost_iface->endpoint[i].desc;

 		DBG_8723A("\nusb_endpoint_descriptor(%d):\n", i);
 		DBG_8723A("bLength =%x\n", pendp_desc->bLength);
 		DBG_8723A("bDescriptorType =%x\n", pendp_desc->bDescriptorType);
 		DBG_8723A("bEndpointAddress =%x\n",
 			  pendp_desc->bEndpointAddress);
 		DBG_8723A("wMaxPacketSize =%d\n",
 			  le16_to_cpu(pendp_desc->wMaxPacketSize));
 		DBG_8723A("bInterval =%x\n", pendp_desc->bInterval);

 		if (usb_endpoint_is_bulk_in(pendp_desc)) {
 			DBG_8723A("usb_endpoint_is_bulk_in = %x\n",
 				  usb_endpoint_num(pendp_desc));
 			pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] =
 				usb_endpoint_num(pendp_desc);
 			pdvobjpriv->RtNumInPipes++;
 		} else if (usb_endpoint_is_int_in(pendp_desc)) {
 			DBG_8723A("usb_endpoint_is_int_in = %x, Interval = "
 				  "%x\n", usb_endpoint_num(pendp_desc),
 				  pendp_desc->bInterval);
 			pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] =
 				usb_endpoint_num(pendp_desc);
 			pdvobjpriv->RtNumInPipes++;
 		} else if (usb_endpoint_is_bulk_out(pendp_desc)) {
 			DBG_8723A("usb_endpoint_is_bulk_out = %x\n",
 				  usb_endpoint_num(pendp_desc));
 			pdvobjpriv->RtOutPipe[pdvobjpriv->RtNumOutPipes] =
 				usb_endpoint_num(pendp_desc);
 			pdvobjpriv->RtNumOutPipes++;
 		}
 		pdvobjpriv->ep_num[i] = usb_endpoint_num(pendp_desc);
 	}
 	DBG_8723A("nr_endpoint =%d, in_num =%d, out_num =%d\n\n",
 		  pdvobjpriv->nr_endpoint, pdvobjpriv->RtNumInPipes,
 		  pdvobjpriv->RtNumOutPipes);

 	if (pusbd->speed == USB_SPEED_HIGH) {
 		pdvobjpriv->ishighspeed = true;
 		DBG_8723A("USB_SPEED_HIGH\n");
 	} else {
 		pdvobjpriv->ishighspeed = false;
 		DBG_8723A("NON USB_SPEED_HIGH\n");
 	}

 	if (rtw_init_intf_priv(pdvobjpriv) == _FAIL) {
 		RT_TRACE(_module_os_intfs_c_, _drv_err_,
 			 "Can't INIT rtw_init_intf_priv\n");
 		goto free_dvobj;
 	}
 	/* 3 misc */
 	rtw_reset_continual_urb_error(pdvobjpriv);
 	usb_get_dev(pusbd);
 	status = _SUCCESS;
 free_dvobj:
 	if (status != _SUCCESS && pdvobjpriv) {
 		usb_set_intfdata(usb_intf, NULL);
 		mutex_destroy(&pdvobjpriv->hw_init_mutex);
 		mutex_destroy(&pdvobjpriv->h2c_fwcmd_mutex);
 		mutex_destroy(&pdvobjpriv->setch_mutex);
 		mutex_destroy(&pdvobjpriv->setbw_mutex);
 		kfree(pdvobjpriv);
 		pdvobjpriv = NULL;
 	}
 exit:
 	return pdvobjpriv;
 }

 static void usb_dvobj_deinit(struct usb_interface *usb_intf)
 {
 	struct dvobj_priv *dvobj = usb_get_intfdata(usb_intf);

 	usb_set_intfdata(usb_intf, NULL);
 	if (dvobj) {
 		/* Modify condition for 92DU DMDP 2010.11.18, by Thomas */
 		if ((dvobj->NumInterfaces != 2 && dvobj->NumInterfaces != 3) ||
 		    (dvobj->InterfaceNumber == 1)) {
 			if (interface_to_usbdev(usb_intf)->state !=
 			    USB_STATE_NOTATTACHED) {
 				/* If we didn't unplug usb dongle and
 				 * remove/insert module, driver fails on
 				 * sitesurvey for the first time when
 				 * device is up .
 				 * Reset usb port for sitesurvey fail issue.
 				 */
 				DBG_8723A("usb attached..., try to reset usb device\n");
 				usb_reset_device(interface_to_usbdev(usb_intf));
 			}
 		}
 		rtw_deinit_intf_priv(dvobj);
 		mutex_destroy(&dvobj->hw_init_mutex);
 		mutex_destroy(&dvobj->h2c_fwcmd_mutex);
 		mutex_destroy(&dvobj->setch_mutex);
 		mutex_destroy(&dvobj->setbw_mutex);
 		kfree(dvobj);
 	}
 	usb_put_dev(interface_to_usbdev(usb_intf));
 }

 void rtl8723a_usb_intf_stop(struct rtw_adapter *padapter)
 {
 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+usb_intf_stop\n");

 	/* disable_hw_interrupt */
 	if (!padapter->bSurpriseRemoved) {
 		/* device still exists, so driver can do i/o operation
 		 * TODO:
 		 */
 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 			 "SurpriseRemoved == false\n");
 	}

 	/* cancel in irp */
 	rtl8723au_inirp_deinit(padapter);

 	/* cancel out irp */
 	rtl8723au_write_port_cancel(padapter);

 	/* todo:cancel other irps */
 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-usb_intf_stop\n");
 }

 static void rtw_dev_unload(struct rtw_adapter *padapter)
 {
 	struct submit_ctx *pack_tx_ops = &padapter->xmitpriv.ack_tx_ops;

 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_dev_unload\n");

 	if (padapter->bup) {
 		DBG_8723A("===> rtw_dev_unload\n");

 		padapter->bDriverStopped = true;
 		if (padapter->xmitpriv.ack_tx)
 			rtw23a_sctx_done_err(&pack_tx_ops,
 					     RTW_SCTX_DONE_DRV_STOP);

 		/* s3. */
 		rtl8723a_usb_intf_stop(padapter);

 		/* s4. */
 		flush_workqueue(padapter->cmdpriv.wq);

 		/* s5. */
 		if (!padapter->bSurpriseRemoved) {
 			rtl8723au_hal_deinit(padapter);
 			padapter->bSurpriseRemoved = true;
 		}
 		padapter->bup = false;
 	} else {
 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 			 "r871x_dev_unload():padapter->bup == false\n");
 	}
 	DBG_8723A("<=== rtw_dev_unload\n");
 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-rtw_dev_unload\n");
 }

 static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
 {
 	struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
 	struct rtw_adapter *padapter = dvobj->if1;
 	struct net_device *pnetdev = padapter->pnetdev;
 	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
 	struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
 	int ret = 0;
 	unsigned long start_time = jiffies;

 	DBG_8723A("==> %s (%s:%d)\n", __func__, current->comm, current->pid);

 	if ((!padapter->bup) || (padapter->bDriverStopped) ||
 	    (padapter->bSurpriseRemoved)) {
 		DBG_8723A("padapter->bup =%d bDriverStopped =%d bSurpriseRemoved = %d\n",
 			  padapter->bup, padapter->bDriverStopped,
 			  padapter->bSurpriseRemoved);
 		goto exit;
 	}
 	pwrpriv->bInSuspend = true;
 	rtw_cancel_all_timer23a(padapter);
 	LeaveAllPowerSaveMode23a(padapter);

 	down(&pwrpriv->lock);
 	/* padapter->net_closed = true; */
 	/* s1. */
 	if (pnetdev) {
 		netif_carrier_off(pnetdev);
 		netif_tx_stop_all_queues(pnetdev);
 	}

 	/* s2. */
 	rtw_disassoc_cmd23a(padapter, 0, false);

 	if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) &&
 	    check_fwstate(pmlmepriv, _FW_LINKED)) {
 		DBG_8723A("%s:%d %s(%pM), length:%d assoc_ssid.length:%d\n",
 			  __func__, __LINE__,
 			  pmlmepriv->cur_network.network.Ssid.ssid,
 			  pmlmepriv->cur_network.network.MacAddress,
 			  pmlmepriv->cur_network.network.Ssid.ssid_len,
 			  pmlmepriv->assoc_ssid.ssid_len);

 		rtw_set_roaming(padapter, 1);
 	}
 	/* s2-2.  indicate disconnect to os */
 	rtw_indicate_disconnect23a(padapter);
 	/* s2-3. */
 	rtw_free_assoc_resources23a(padapter, 1);
 	/* s2-4. */
 	rtw_free_network_queue23a(padapter);

 	rtw_dev_unload(padapter);
 	up(&pwrpriv->lock);

 	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
 		rtw_cfg80211_indicate_scan_done(
 			wdev_to_priv(padapter->rtw_wdev), true);

 	if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
 		rtw_indicate_disconnect23a(padapter);

 exit:
 	DBG_8723A("<===  %s return %d.............. in %dms\n", __func__,
 		  ret, jiffies_to_msecs(jiffies - start_time));

 	return ret;
 }

 static int rtw_resume(struct usb_interface *pusb_intf)
 {
 	struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
 	struct rtw_adapter *padapter = dvobj->if1;
 	struct net_device *pnetdev;
 	struct pwrctrl_priv *pwrpriv = NULL;
 	int ret = -1;
 	unsigned long start_time = jiffies;

 	DBG_8723A("==> %s (%s:%d)\n", __func__, current->comm, current->pid);

 	if (!padapter)
 		goto exit;
 	pnetdev = padapter->pnetdev;
 	pwrpriv = &padapter->pwrctrlpriv;

 	down(&pwrpriv->lock);
 	rtw_reset_drv_sw23a(padapter);
 	pwrpriv->bkeepfwalive = false;

 	DBG_8723A("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
 	if (pm_netdev_open23a(pnetdev, true) != 0) {
 		up(&pwrpriv->lock);
 		goto exit;
 	}

 	netif_device_attach(pnetdev);
 	netif_carrier_on(pnetdev);

 	up(&pwrpriv->lock);

 	if (padapter->pid[1] != 0) {
 		DBG_8723A("pid[1]:%d\n", padapter->pid[1]);
 		kill_pid(find_vpid(padapter->pid[1]), SIGUSR2, 1);
 	}

 	rtw23a_roaming(padapter, NULL);

 	ret = 0;
 exit:
 	if (pwrpriv)
 		pwrpriv->bInSuspend = false;
 	DBG_8723A("<===  %s return %d.............. in %dms\n", __func__,
 		  ret, jiffies_to_msecs(jiffies - start_time));

 	return ret;
 }

 /*
  * drv_init() - a device potentially for us
  *
  * notes: drv_init() is called when the bus driver has located a card
  * for us to support.
  *        We accept the new device by returning 0.
  */
 static struct rtw_adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
 					    struct usb_interface *pusb_intf,
 					    const struct usb_device_id *pdid)
 {
 	struct rtw_adapter *padapter = NULL;
 	struct net_device *pnetdev = NULL;
 	int status = _FAIL;

 	pnetdev = rtw_init_netdev23a(padapter);
 	if (!pnetdev)
 		goto free_adapter;
 	padapter = netdev_priv(pnetdev);

 	padapter->dvobj = dvobj;
 	padapter->bDriverStopped = true;
 	dvobj->if1 = padapter;
 	dvobj->padapters[dvobj->iface_nums++] = padapter;
 	padapter->iface_id = IFACE_ID0;

 	rtl8723au_set_hw_type(padapter);

 	SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));

 	if (rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj)))
 		goto free_adapter;

 	/* step 2. allocate HalData */
 	padapter->HalData = kzalloc(sizeof(struct hal_data_8723a), GFP_KERNEL);
 	if (!padapter->HalData)
 		goto free_wdev;

 	/* step read_chip_version */
 	rtl8723a_read_chip_version(padapter);

 	/* step usb endpoint mapping */
 	if (!rtl8723au_chip_configure(padapter))
 		goto free_hal_data;

 	/* step read efuse/eeprom data and get mac_addr */
 	rtl8723a_read_adapter_info(padapter);

 	/* step 5. */
 	if (rtw_init_drv_sw23a(padapter) == _FAIL) {
 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 			 "Initialize driver software resource Failed!\n");
 		goto free_hal_data;
 	}

 #ifdef CONFIG_PM
 	if (padapter->pwrctrlpriv.bSupportRemoteWakeup) {
 		dvobj->pusbdev->do_remote_wakeup = 1;
 		pusb_intf->needs_remote_wakeup = 1;
 		device_init_wakeup(&pusb_intf->dev, 1);
 		DBG_8723A("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n");
 		DBG_8723A("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",
 			  device_may_wakeup(&pusb_intf->dev));
 	}
 #endif
 	/* 2012-07-11 Move here to prevent the 8723AS-VAU BT
 	 * auto suspend influence
 	 */
 	if (usb_autopm_get_interface(pusb_intf) < 0)
 		DBG_8723A("can't get autopm:\n");
 #ifdef	CONFIG_8723AU_BT_COEXIST
 	padapter->pwrctrlpriv.autopm_cnt = 1;
 #endif

 	/* If the eeprom mac address is corrupted, assign a random address */
 	if (is_broadcast_ether_addr(padapter->eeprompriv.mac_addr) ||
 	    is_zero_ether_addr(padapter->eeprompriv.mac_addr))
 		eth_random_addr(padapter->eeprompriv.mac_addr);

 	DBG_8723A("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n",
 		  padapter->bDriverStopped, padapter->bSurpriseRemoved,
 		  padapter->bup, padapter->hw_init_completed
 	);
 	status = _SUCCESS;

 free_hal_data:
 	if (status != _SUCCESS)
 		kfree(padapter->HalData);
 free_wdev:
 	if (status != _SUCCESS) {
 		rtw_wdev_unregister(padapter->rtw_wdev);
 		rtw_wdev_free(padapter->rtw_wdev);
 	}
 free_adapter:
 	if (status != _SUCCESS) {
 		if (pnetdev)
 			free_netdev(pnetdev);
 		padapter = NULL;
 	}
 	return padapter;
 }

 static void rtw_usb_if1_deinit(struct rtw_adapter *if1)
 {
 	struct net_device *pnetdev = if1->pnetdev;
 	struct mlme_priv *pmlmepriv = &if1->mlmepriv;

 	if (check_fwstate(pmlmepriv, _FW_LINKED))
 		rtw_disassoc_cmd23a(if1, 0, false);

 #ifdef CONFIG_8723AU_AP_MODE
 	free_mlme_ap_info23a(if1);
 #endif

 	if (pnetdev)
 		unregister_netdev(pnetdev); /* will call netdev_close() */

 	rtw_cancel_all_timer23a(if1);

 	rtw_dev_unload(if1);

 	DBG_8723A("+r871xu_dev_remove, hw_init_completed =%d\n",
 		  if1->hw_init_completed);

 	if (if1->rtw_wdev) {
 		rtw_wdev_unregister(if1->rtw_wdev);
 		rtw_wdev_free(if1->rtw_wdev);
 	}

 #ifdef CONFIG_8723AU_BT_COEXIST
 	if (1 == if1->pwrctrlpriv.autopm_cnt) {
 		usb_autopm_put_interface(adapter_to_dvobj(if1)->pusbintf);
 		if1->pwrctrlpriv.autopm_cnt--;
 	}
 #endif

 	rtw_free_drv_sw23a(if1);

 	if (pnetdev)
 		free_netdev(pnetdev);
 }

 static int rtw_drv_init(struct usb_interface *pusb_intf,
 			const struct usb_device_id *pdid)
 {
 	struct rtw_adapter *if1 = NULL;
 	struct dvobj_priv *dvobj;
 	int status = _FAIL;

 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_init\n");

 	/* Initialize dvobj_priv */
 	dvobj = usb_dvobj_init(pusb_intf);
 	if (!dvobj) {
 		RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 			 "initialize device object priv Failed!\n");
 		goto exit;
 	}

 	if1 = rtw_usb_if1_init(dvobj, pusb_intf, pdid);
 	if (!if1) {
 		DBG_8723A("rtw_init_primary_adapter Failed!\n");
 		goto free_dvobj;
 	}

 	/* dev_alloc_name && register_netdev */
 	status = rtw_drv_register_netdev(if1);
 	if (status != _SUCCESS)
 		goto free_if1;
 	RT_TRACE(_module_hci_intfs_c_, _drv_err_,
 		 "-871x_drv - drv_init, success!\n");

 	status = _SUCCESS;

 free_if1:
 	if (status != _SUCCESS && if1)
 		rtw_usb_if1_deinit(if1);
 free_dvobj:
 	if (status != _SUCCESS)
 		usb_dvobj_deinit(pusb_intf);
 exit:
 	return status == _SUCCESS ? 0 : -ENODEV;
 }

 /* dev_remove() - our device is being removed */
 static void rtw_disconnect(struct usb_interface *pusb_intf)
 {
 	struct dvobj_priv *dvobj;
 	struct rtw_adapter *padapter;
 	struct net_device *pnetdev;
 	struct mlme_priv *pmlmepriv;

 	dvobj = usb_get_intfdata(pusb_intf);
 	if (!dvobj)
 		return;

 	padapter = dvobj->if1;
 	pnetdev = padapter->pnetdev;
 	pmlmepriv = &padapter->mlmepriv;

 	usb_set_intfdata(pusb_intf, NULL);

 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+dev_remove()\n");

 	rtw_pm_set_ips23a(padapter, IPS_NONE);
 	rtw_pm_set_lps23a(padapter, PS_MODE_ACTIVE);

 	LeaveAllPowerSaveMode23a(padapter);

 	rtw_usb_if1_deinit(padapter);

 	usb_dvobj_deinit(pusb_intf);

 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-dev_remove()\n");
 	DBG_8723A("-r871xu_dev_remove, done\n");
 }

 static int __init rtw_drv_entry(void)
 {
 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_entry\n");
 	return usb_register(usb_drv);
 }

 static void __exit rtw_drv_halt(void)
 {
 	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_halt\n");
 	DBG_8723A("+rtw_drv_halt\n");

 	usb_deregister(usb_drv);

 	DBG_8723A("-rtw_drv_halt\n");
 }

 module_init(rtw_drv_entry);
 module_exit(rtw_drv_halt);
	/******************************************************************************
	*
	* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
	*
	* This program is free software; you can redistribute it and/or modify it
	* under the terms of version 2 of the GNU General Public License as
	* published by the Free Software Foundation.
	*
	* This program is distributed in the hope that it will be useful, but WITHOUT
	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	* more details.
	*
	******************************************************************************/
	#define _HCI_INTF_C_

	#include <osdep_service.h>
	#include <drv_types.h>
	#include <recv_osdep.h>
	#include <xmit_osdep.h>
	#include <hal_intf.h>
	#include <rtw_version.h>
	#include <osdep_intf.h>
	#include <usb_ops.h>
	#include <rtl8723a_hal.h>

	static int rtw_suspend(struct usb_interface *intf, pm_message_t message);
	static int rtw_resume(struct usb_interface *intf);
	static int rtw_drv_init(struct usb_interface *pusb_intf,
	const struct usb_device_id *pdid);
	static void rtw_disconnect(struct usb_interface *pusb_intf);

	#define USB_VENDER_ID_REALTEK 0x0BDA

	#define RTL8723A_USB_IDS \
	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x8724, \
	0xff, 0xff, 0xff)}, /* 8723AU 11 / \
	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x1724, \
	0xff, 0xff, 0xff)}, /* 8723AU 11 / \
	{USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x0724, \
	0xff, 0xff, 0xff)}, /* 8723AU 11 /

	static struct usb_device_id rtl8723a_usb_id_tbl[] = {
	RTL8723A_USB_IDS
	{} /* Terminating entry */
	};

	MODULE_DEVICE_TABLE(usb, rtl8723a_usb_id_tbl);

	static struct usb_driver rtl8723a_usb_drv = {
	.name = (char *)"rtl8723au",
	.probe = rtw_drv_init,
	.disconnect = rtw_disconnect,
	.id_table = rtl8723a_usb_id_tbl,
	.suspend = rtw_suspend,
	.resume = rtw_resume,
	.reset_resume = rtw_resume,
	};

	static struct usb_driver *usb_drv = &rtl8723a_usb_drv;

	static int rtw_init_intf_priv(struct dvobj_priv *dvobj)
	{
	mutex_init(&dvobj->usb_vendor_req_mutex);

	return _SUCCESS;
	}

	static int rtw_deinit_intf_priv(struct dvobj_priv *dvobj)
	{
	mutex_destroy(&dvobj->usb_vendor_req_mutex);

	return _SUCCESS;
	}

	static struct dvobj_priv usb_dvobj_init(struct usb_interface usb_intf)
	{
	struct dvobj_priv *pdvobjpriv;
	struct usb_host_config *phost_conf;
	struct usb_config_descriptor *pconf_desc;
	struct usb_host_interface *phost_iface;
	struct usb_interface_descriptor *piface_desc;
	struct usb_endpoint_descriptor *pendp_desc;
	struct usb_device *pusbd;
	int i, status = _FAIL;

	pdvobjpriv = kzalloc(sizeof(*pdvobjpriv), GFP_KERNEL);
	if (!pdvobjpriv)
	goto exit;

	mutex_init(&pdvobjpriv->hw_init_mutex);
	mutex_init(&pdvobjpriv->h2c_fwcmd_mutex);
	mutex_init(&pdvobjpriv->setch_mutex);
	mutex_init(&pdvobjpriv->setbw_mutex);

	pdvobjpriv->pusbintf = usb_intf;
	pusbd = interface_to_usbdev(usb_intf);
	pdvobjpriv->pusbdev = pusbd;
	usb_set_intfdata(usb_intf, pdvobjpriv);

	pdvobjpriv->RtNumInPipes = 0;
	pdvobjpriv->RtNumOutPipes = 0;

	phost_conf = pusbd->actconfig;
	pconf_desc = &phost_conf->desc;

	phost_iface = &usb_intf->altsetting[0];
	piface_desc = &phost_iface->desc;

	pdvobjpriv->NumInterfaces = pconf_desc->bNumInterfaces;
	pdvobjpriv->InterfaceNumber = piface_desc->bInterfaceNumber;
	pdvobjpriv->nr_endpoint = piface_desc->bNumEndpoints;

	for (i = 0; i < pdvobjpriv->nr_endpoint; i++) {
	pendp_desc = &phost_iface->endpoint[i].desc;

	DBG_8723A("\nusb_endpoint_descriptor(%d):\n", i);
	DBG_8723A("bLength =%x\n", pendp_desc->bLength);
	DBG_8723A("bDescriptorType =%x\n", pendp_desc->bDescriptorType);
	DBG_8723A("bEndpointAddress =%x\n",
	pendp_desc->bEndpointAddress);
	DBG_8723A("wMaxPacketSize =%d\n",
	le16_to_cpu(pendp_desc->wMaxPacketSize));
	DBG_8723A("bInterval =%x\n", pendp_desc->bInterval);

	if (usb_endpoint_is_bulk_in(pendp_desc)) {
	DBG_8723A("usb_endpoint_is_bulk_in = %x\n",
	usb_endpoint_num(pendp_desc));
	pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] =
	usb_endpoint_num(pendp_desc);
	pdvobjpriv->RtNumInPipes++;
	} else if (usb_endpoint_is_int_in(pendp_desc)) {
	DBG_8723A("usb_endpoint_is_int_in = %x, Interval = "
	"%x\n", usb_endpoint_num(pendp_desc),
	pendp_desc->bInterval);
	pdvobjpriv->RtInPipe[pdvobjpriv->RtNumInPipes] =
	usb_endpoint_num(pendp_desc);
	pdvobjpriv->RtNumInPipes++;
	} else if (usb_endpoint_is_bulk_out(pendp_desc)) {
	DBG_8723A("usb_endpoint_is_bulk_out = %x\n",
	usb_endpoint_num(pendp_desc));
	pdvobjpriv->RtOutPipe[pdvobjpriv->RtNumOutPipes] =
	usb_endpoint_num(pendp_desc);
	pdvobjpriv->RtNumOutPipes++;
	}
	pdvobjpriv->ep_num[i] = usb_endpoint_num(pendp_desc);
	}
	DBG_8723A("nr_endpoint =%d, in_num =%d, out_num =%d\n\n",
	pdvobjpriv->nr_endpoint, pdvobjpriv->RtNumInPipes,
	pdvobjpriv->RtNumOutPipes);

	if (pusbd->speed == USB_SPEED_HIGH) {
	pdvobjpriv->ishighspeed = true;
	DBG_8723A("USB_SPEED_HIGH\n");
	} else {
	pdvobjpriv->ishighspeed = false;
	DBG_8723A("NON USB_SPEED_HIGH\n");
	}

	if (rtw_init_intf_priv(pdvobjpriv) == _FAIL) {
	RT_TRACE(_module_os_intfs_c_, _drv_err_,
	"Can't INIT rtw_init_intf_priv\n");
	goto free_dvobj;
	}
	/* 3 misc */
	rtw_reset_continual_urb_error(pdvobjpriv);
	usb_get_dev(pusbd);
	status = _SUCCESS;
	free_dvobj:
	if (status != _SUCCESS && pdvobjpriv) {
	usb_set_intfdata(usb_intf, NULL);
	mutex_destroy(&pdvobjpriv->hw_init_mutex);
	mutex_destroy(&pdvobjpriv->h2c_fwcmd_mutex);
	mutex_destroy(&pdvobjpriv->setch_mutex);
	mutex_destroy(&pdvobjpriv->setbw_mutex);
	kfree(pdvobjpriv);
	pdvobjpriv = NULL;
	}
	exit:
	return pdvobjpriv;
	}

	static void usb_dvobj_deinit(struct usb_interface *usb_intf)
	{
	struct dvobj_priv *dvobj = usb_get_intfdata(usb_intf);

	usb_set_intfdata(usb_intf, NULL);
	if (dvobj) {
	/* Modify condition for 92DU DMDP 2010.11.18, by Thomas */
	if ((dvobj->NumInterfaces != 2 && dvobj->NumInterfaces != 3) \|\|
	(dvobj->InterfaceNumber == 1)) {
	if (interface_to_usbdev(usb_intf)->state !=
	USB_STATE_NOTATTACHED) {
	/* If we didn't unplug usb dongle and
	* remove/insert module, driver fails on
	* sitesurvey for the first time when
	* device is up .
	* Reset usb port for sitesurvey fail issue.
	*/
	DBG_8723A("usb attached..., try to reset usb device\n");
	usb_reset_device(interface_to_usbdev(usb_intf));
	}
	}
	rtw_deinit_intf_priv(dvobj);
	mutex_destroy(&dvobj->hw_init_mutex);
	mutex_destroy(&dvobj->h2c_fwcmd_mutex);
	mutex_destroy(&dvobj->setch_mutex);
	mutex_destroy(&dvobj->setbw_mutex);
	kfree(dvobj);
	}
	usb_put_dev(interface_to_usbdev(usb_intf));
	}

	void rtl8723a_usb_intf_stop(struct rtw_adapter *padapter)
	{
	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+usb_intf_stop\n");

	/* disable_hw_interrupt */
	if (!padapter->bSurpriseRemoved) {
	/* device still exists, so driver can do i/o operation
	* TODO:
	*/
	RT_TRACE(_module_hci_intfs_c_, _drv_err_,
	"SurpriseRemoved == false\n");
	}

	/* cancel in irp */
	rtl8723au_inirp_deinit(padapter);

	/* cancel out irp */
	rtl8723au_write_port_cancel(padapter);

	/* todo:cancel other irps */
	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-usb_intf_stop\n");
	}

	static void rtw_dev_unload(struct rtw_adapter *padapter)
	{
	struct submit_ctx *pack_tx_ops = &padapter->xmitpriv.ack_tx_ops;

	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_dev_unload\n");

	if (padapter->bup) {
	DBG_8723A("===> rtw_dev_unload\n");

	padapter->bDriverStopped = true;
	if (padapter->xmitpriv.ack_tx)
	rtw23a_sctx_done_err(&pack_tx_ops,
	RTW_SCTX_DONE_DRV_STOP);

	/* s3. */
	rtl8723a_usb_intf_stop(padapter);

	/* s4. */
	flush_workqueue(padapter->cmdpriv.wq);

	/* s5. */
	if (!padapter->bSurpriseRemoved) {
	rtl8723au_hal_deinit(padapter);
	padapter->bSurpriseRemoved = true;
	}
	padapter->bup = false;
	} else {
	RT_TRACE(_module_hci_intfs_c_, _drv_err_,
	"r871x_dev_unload():padapter->bup == false\n");
	}
	DBG_8723A("<=== rtw_dev_unload\n");
	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-rtw_dev_unload\n");
	}

	static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
	{
	struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
	struct rtw_adapter *padapter = dvobj->if1;
	struct net_device *pnetdev = padapter->pnetdev;
	struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
	struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
	int ret = 0;
	unsigned long start_time = jiffies;

	DBG_8723A("==> %s (%s:%d)\n", __func__, current->comm, current->pid);

	if ((!padapter->bup) \|\| (padapter->bDriverStopped) \|\|
	(padapter->bSurpriseRemoved)) {
	DBG_8723A("padapter->bup =%d bDriverStopped =%d bSurpriseRemoved = %d\n",
	padapter->bup, padapter->bDriverStopped,
	padapter->bSurpriseRemoved);
	goto exit;
	}
	pwrpriv->bInSuspend = true;
	rtw_cancel_all_timer23a(padapter);
	LeaveAllPowerSaveMode23a(padapter);

	down(&pwrpriv->lock);
	/* padapter->net_closed = true; */
	/* s1. */
	if (pnetdev) {
	netif_carrier_off(pnetdev);
	netif_tx_stop_all_queues(pnetdev);
	}

	/* s2. */
	rtw_disassoc_cmd23a(padapter, 0, false);

	if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) &&
	check_fwstate(pmlmepriv, _FW_LINKED)) {
	DBG_8723A("%s:%d %s(%pM), length:%d assoc_ssid.length:%d\n",
	__func__, __LINE__,
	pmlmepriv->cur_network.network.Ssid.ssid,
	pmlmepriv->cur_network.network.MacAddress,
	pmlmepriv->cur_network.network.Ssid.ssid_len,
	pmlmepriv->assoc_ssid.ssid_len);

	rtw_set_roaming(padapter, 1);
	}
	/* s2-2. indicate disconnect to os */
	rtw_indicate_disconnect23a(padapter);
	/* s2-3. */
	rtw_free_assoc_resources23a(padapter, 1);
	/* s2-4. */
	rtw_free_network_queue23a(padapter);

	rtw_dev_unload(padapter);
	up(&pwrpriv->lock);

	if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY))
	rtw_cfg80211_indicate_scan_done(
	wdev_to_priv(padapter->rtw_wdev), true);

	if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING))
	rtw_indicate_disconnect23a(padapter);

	exit:
	DBG_8723A("<=== %s return %d.............. in %dms\n", __func__,
	ret, jiffies_to_msecs(jiffies - start_time));

	return ret;
	}

	static int rtw_resume(struct usb_interface *pusb_intf)
	{
	struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
	struct rtw_adapter *padapter = dvobj->if1;
	struct net_device *pnetdev;
	struct pwrctrl_priv *pwrpriv = NULL;
	int ret = -1;
	unsigned long start_time = jiffies;

	DBG_8723A("==> %s (%s:%d)\n", __func__, current->comm, current->pid);

	if (!padapter)
	goto exit;
	pnetdev = padapter->pnetdev;
	pwrpriv = &padapter->pwrctrlpriv;

	down(&pwrpriv->lock);
	rtw_reset_drv_sw23a(padapter);
	pwrpriv->bkeepfwalive = false;

	DBG_8723A("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
	if (pm_netdev_open23a(pnetdev, true) != 0) {
	up(&pwrpriv->lock);
	goto exit;
	}

	netif_device_attach(pnetdev);
	netif_carrier_on(pnetdev);

	up(&pwrpriv->lock);

	if (padapter->pid[1] != 0) {
	DBG_8723A("pid[1]:%d\n", padapter->pid[1]);
	kill_pid(find_vpid(padapter->pid[1]), SIGUSR2, 1);
	}

	rtw23a_roaming(padapter, NULL);

	ret = 0;
	exit:
	if (pwrpriv)
	pwrpriv->bInSuspend = false;
	DBG_8723A("<=== %s return %d.............. in %dms\n", __func__,
	ret, jiffies_to_msecs(jiffies - start_time));

	return ret;
	}

	/*
	* drv_init() - a device potentially for us
	*
	* notes: drv_init() is called when the bus driver has located a card
	* for us to support.
	* We accept the new device by returning 0.
	*/
	static struct rtw_adapter rtw_usb_if1_init(struct dvobj_priv dvobj,
	struct usb_interface *pusb_intf,
	const struct usb_device_id *pdid)
	{
	struct rtw_adapter *padapter = NULL;
	struct net_device *pnetdev = NULL;
	int status = _FAIL;

	pnetdev = rtw_init_netdev23a(padapter);
	if (!pnetdev)
	goto free_adapter;
	padapter = netdev_priv(pnetdev);

	padapter->dvobj = dvobj;
	padapter->bDriverStopped = true;
	dvobj->if1 = padapter;
	dvobj->padapters[dvobj->iface_nums++] = padapter;
	padapter->iface_id = IFACE_ID0;

	rtl8723au_set_hw_type(padapter);

	SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));

	if (rtw_wdev_alloc(padapter, dvobj_to_dev(dvobj)))
	goto free_adapter;

	/* step 2. allocate HalData */
	padapter->HalData = kzalloc(sizeof(struct hal_data_8723a), GFP_KERNEL);
	if (!padapter->HalData)
	goto free_wdev;

	/* step read_chip_version */
	rtl8723a_read_chip_version(padapter);

	/* step usb endpoint mapping */
	if (!rtl8723au_chip_configure(padapter))
	goto free_hal_data;

	/* step read efuse/eeprom data and get mac_addr */
	rtl8723a_read_adapter_info(padapter);

	/* step 5. */
	if (rtw_init_drv_sw23a(padapter) == _FAIL) {
	RT_TRACE(_module_hci_intfs_c_, _drv_err_,
	"Initialize driver software resource Failed!\n");
	goto free_hal_data;
	}

	#ifdef CONFIG_PM
	if (padapter->pwrctrlpriv.bSupportRemoteWakeup) {
	dvobj->pusbdev->do_remote_wakeup = 1;
	pusb_intf->needs_remote_wakeup = 1;
	device_init_wakeup(&pusb_intf->dev, 1);
	DBG_8723A("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n");
	DBG_8723A("\n padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",
	device_may_wakeup(&pusb_intf->dev));
	}
	#endif
	/* 2012-07-11 Move here to prevent the 8723AS-VAU BT
	* auto suspend influence
	*/
	if (usb_autopm_get_interface(pusb_intf) < 0)
	DBG_8723A("can't get autopm:\n");
	#ifdef CONFIG_8723AU_BT_COEXIST
	padapter->pwrctrlpriv.autopm_cnt = 1;
	#endif

	/* If the eeprom mac address is corrupted, assign a random address */
	if (is_broadcast_ether_addr(padapter->eeprompriv.mac_addr) \|\|
	is_zero_ether_addr(padapter->eeprompriv.mac_addr))
	eth_random_addr(padapter->eeprompriv.mac_addr);

	DBG_8723A("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n",
	padapter->bDriverStopped, padapter->bSurpriseRemoved,
	padapter->bup, padapter->hw_init_completed
	);
	status = _SUCCESS;

	free_hal_data:
	if (status != _SUCCESS)
	kfree(padapter->HalData);
	free_wdev:
	if (status != _SUCCESS) {
	rtw_wdev_unregister(padapter->rtw_wdev);
	rtw_wdev_free(padapter->rtw_wdev);
	}
	free_adapter:
	if (status != _SUCCESS) {
	if (pnetdev)
	free_netdev(pnetdev);
	padapter = NULL;
	}
	return padapter;
	}

	static void rtw_usb_if1_deinit(struct rtw_adapter *if1)
	{
	struct net_device *pnetdev = if1->pnetdev;
	struct mlme_priv *pmlmepriv = &if1->mlmepriv;

	if (check_fwstate(pmlmepriv, _FW_LINKED))
	rtw_disassoc_cmd23a(if1, 0, false);

	#ifdef CONFIG_8723AU_AP_MODE
	free_mlme_ap_info23a(if1);
	#endif

	if (pnetdev)
	unregister_netdev(pnetdev); /* will call netdev_close() */

	rtw_cancel_all_timer23a(if1);

	rtw_dev_unload(if1);

	DBG_8723A("+r871xu_dev_remove, hw_init_completed =%d\n",
	if1->hw_init_completed);

	if (if1->rtw_wdev) {
	rtw_wdev_unregister(if1->rtw_wdev);
	rtw_wdev_free(if1->rtw_wdev);
	}

	#ifdef CONFIG_8723AU_BT_COEXIST
	if (1 == if1->pwrctrlpriv.autopm_cnt) {
	usb_autopm_put_interface(adapter_to_dvobj(if1)->pusbintf);
	if1->pwrctrlpriv.autopm_cnt--;
	}
	#endif

	rtw_free_drv_sw23a(if1);

	if (pnetdev)
	free_netdev(pnetdev);
	}

	static int rtw_drv_init(struct usb_interface *pusb_intf,
	const struct usb_device_id *pdid)
	{
	struct rtw_adapter *if1 = NULL;
	struct dvobj_priv *dvobj;
	int status = _FAIL;

	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_init\n");

	/* Initialize dvobj_priv */
	dvobj = usb_dvobj_init(pusb_intf);
	if (!dvobj) {
	RT_TRACE(_module_hci_intfs_c_, _drv_err_,
	"initialize device object priv Failed!\n");
	goto exit;
	}

	if1 = rtw_usb_if1_init(dvobj, pusb_intf, pdid);
	if (!if1) {
	DBG_8723A("rtw_init_primary_adapter Failed!\n");
	goto free_dvobj;
	}

	/* dev_alloc_name && register_netdev */
	status = rtw_drv_register_netdev(if1);
	if (status != _SUCCESS)
	goto free_if1;
	RT_TRACE(_module_hci_intfs_c_, _drv_err_,
	"-871x_drv - drv_init, success!\n");

	status = _SUCCESS;

	free_if1:
	if (status != _SUCCESS && if1)
	rtw_usb_if1_deinit(if1);
	free_dvobj:
	if (status != _SUCCESS)
	usb_dvobj_deinit(pusb_intf);
	exit:
	return status == _SUCCESS ? 0 : -ENODEV;
	}

	/* dev_remove() - our device is being removed */
	static void rtw_disconnect(struct usb_interface *pusb_intf)
	{
	struct dvobj_priv *dvobj;
	struct rtw_adapter *padapter;
	struct net_device *pnetdev;
	struct mlme_priv *pmlmepriv;

	dvobj = usb_get_intfdata(pusb_intf);
	if (!dvobj)
	return;

	padapter = dvobj->if1;
	pnetdev = padapter->pnetdev;
	pmlmepriv = &padapter->mlmepriv;

	usb_set_intfdata(pusb_intf, NULL);

	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+dev_remove()\n");

	rtw_pm_set_ips23a(padapter, IPS_NONE);
	rtw_pm_set_lps23a(padapter, PS_MODE_ACTIVE);

	LeaveAllPowerSaveMode23a(padapter);

	rtw_usb_if1_deinit(padapter);

	usb_dvobj_deinit(pusb_intf);

	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "-dev_remove()\n");
	DBG_8723A("-r871xu_dev_remove, done\n");
	}

	static int __init rtw_drv_entry(void)
	{
	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_entry\n");
	return usb_register(usb_drv);
	}

	static void __exit rtw_drv_halt(void)
	{
	RT_TRACE(_module_hci_intfs_c_, _drv_err_, "+rtw_drv_halt\n");
	DBG_8723A("+rtw_drv_halt\n");

	usb_deregister(usb_drv);

	DBG_8723A("-rtw_drv_halt\n");
	}

	module_init(rtw_drv_entry);
	module_exit(rtw_drv_halt);