These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / drivers / staging / rtl8188eu / os_dep / usb_intf.c
index ef3c73e..82a7c27 100644 (file)
@@ -17,8 +17,8 @@
  *
  *
  ******************************************************************************/
-#define _HCI_INTF_C_
 
+#define pr_fmt(fmt) "R8188EU: " fmt
 #include <osdep_service.h>
 #include <drv_types.h>
 #include <recv_osdep.h>
 #include <hal_intf.h>
 #include <linux/usb.h>
 #include <linux/vmalloc.h>
+#include <mon.h>
 #include <osdep_intf.h>
 
 #include <usb_ops_linux.h>
 #include <usb_hal.h>
 #include <rtw_ioctl.h>
 
-int ui_pid[3] = {0, 0, 0};
-
 #define USB_VENDER_ID_REALTEK          0x0bda
 
 /* DID_USB_v916_20130116 */
@@ -57,7 +56,6 @@ MODULE_DEVICE_TABLE(usb, rtw_usb_id_tbl);
 static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf)
 {
        int     i;
-       int     status = _FAIL;
        struct dvobj_priv *pdvobjpriv;
        struct usb_host_config          *phost_conf;
        struct usb_config_descriptor    *pconf_desc;
@@ -66,10 +64,9 @@ static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf)
        struct usb_endpoint_descriptor  *pendp_desc;
        struct usb_device       *pusbd;
 
-
        pdvobjpriv = kzalloc(sizeof(*pdvobjpriv), GFP_KERNEL);
        if (pdvobjpriv == NULL)
-               goto exit;
+               return NULL;
 
        pdvobjpriv->pusbintf = usb_intf;
        pusbd = interface_to_usbdev(usb_intf);
@@ -117,20 +114,13 @@ static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf)
        mutex_init(&pdvobjpriv->usb_vendor_req_mutex);
        pdvobjpriv->usb_vendor_req_buf = kzalloc(MAX_USB_IO_CTL_SIZE, GFP_KERNEL);
 
-       if (!pdvobjpriv->usb_vendor_req_buf)
-               goto free_dvobj;
-
-       usb_get_dev(pusbd);
-
-       status = _SUCCESS;
-
-free_dvobj:
-       if (status != _SUCCESS && pdvobjpriv) {
+       if (!pdvobjpriv->usb_vendor_req_buf) {
                usb_set_intfdata(usb_intf, NULL);
                kfree(pdvobjpriv);
-               pdvobjpriv = NULL;
+               return NULL;
        }
-exit:
+       usb_get_dev(pusbd);
+
        return pdvobjpriv;
 }
 
@@ -138,7 +128,6 @@ 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 */
@@ -152,7 +141,7 @@ static void usb_dvobj_deinit(struct usb_interface *usb_intf)
                                 * on sitesurvey for the first time when
                                 * device is up . Reset usb port for sitesurvey
                                 * fail issue. */
-                               DBG_88E("usb attached..., try to reset usb device\n");
+                               pr_debug("usb attached..., try to reset usb device\n");
                                usb_reset_device(interface_to_usbdev(usb_intf));
                        }
                }
@@ -203,7 +192,7 @@ static void rtw_dev_unload(struct adapter *padapter)
        RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+rtw_dev_unload\n"));
 
        if (padapter->bup) {
-               DBG_88E("===> rtw_dev_unload\n");
+               pr_debug("===> rtw_dev_unload\n");
                padapter->bDriverStopped = true;
                if (padapter->xmitpriv.ack_tx)
                        rtw_ack_tx_done(&padapter->xmitpriv, RTW_SCTX_DONE_DRV_STOP);
@@ -226,7 +215,7 @@ static void rtw_dev_unload(struct adapter *padapter)
                         ("r871x_dev_unload():padapter->bup == false\n"));
        }
 
-       DBG_88E("<=== rtw_dev_unload\n");
+       pr_debug("<=== rtw_dev_unload\n");
 
        RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-rtw_dev_unload\n"));
 }
@@ -238,16 +227,13 @@ static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
        struct net_device *pnetdev = padapter->pnetdev;
        struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
        struct pwrctrl_priv *pwrpriv = &padapter->pwrctrlpriv;
-
-       int ret = 0;
        u32 start_time = jiffies;
 
-
-       DBG_88E("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
+       pr_debug("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
 
        if ((!padapter->bup) || (padapter->bDriverStopped) ||
            (padapter->bSurpriseRemoved)) {
-               DBG_88E("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n",
+               pr_debug("padapter->bup=%d bDriverStopped=%d bSurpriseRemoved = %d\n",
                        padapter->bup, padapter->bDriverStopped,
                        padapter->bSurpriseRemoved);
                goto exit;
@@ -269,7 +255,7 @@ static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
 
        if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) &&
            check_fwstate(pmlmepriv, _FW_LINKED)) {
-               DBG_88E("%s:%d %s(%pM), length:%d assoc_ssid.length:%d\n",
+               pr_debug("%s:%d %s(%pM), length:%d assoc_ssid.length:%d\n",
                        __func__, __LINE__,
                        pmlmepriv->cur_network.network.Ssid.Ssid,
                        pmlmepriv->cur_network.network.MacAddress,
@@ -281,7 +267,7 @@ static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
        /* s2-2.  indicate disconnect to os */
        rtw_indicate_disconnect(padapter);
        /* s2-3. */
-       rtw_free_assoc_resources(padapter, 1);
+       rtw_free_assoc_resources(padapter);
        /* s2-4. */
        rtw_free_network_queue(padapter, true);
 
@@ -295,10 +281,10 @@ static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message)
                rtw_indicate_disconnect(padapter);
 
 exit:
-       DBG_88E("<===  %s return %d.............. in %dms\n", __func__
-               , ret, rtw_get_passing_time_ms(start_time));
+       pr_debug("<===  %s .............. in %dms\n", __func__,
+                rtw_get_passing_time_ms(start_time));
 
-       return ret;
+       return 0;
 }
 
 static int rtw_resume_process(struct adapter *padapter)
@@ -308,7 +294,7 @@ static int rtw_resume_process(struct adapter *padapter)
        int ret = -1;
        u32 start_time = jiffies;
 
-       DBG_88E("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
+       pr_debug("==> %s (%s:%d)\n", __func__, current->comm, current->pid);
 
        if (padapter) {
                pnetdev = padapter->pnetdev;
@@ -321,7 +307,7 @@ static int rtw_resume_process(struct adapter *padapter)
        rtw_reset_drv_sw(padapter);
        pwrpriv->bkeepfwalive = false;
 
-       DBG_88E("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
+       pr_debug("bkeepfwalive(%x)\n", pwrpriv->bkeepfwalive);
        if (pm_netdev_open(pnetdev, true) != 0)
                goto exit;
 
@@ -330,21 +316,15 @@ static int rtw_resume_process(struct adapter *padapter)
 
        _exit_pwrlock(&pwrpriv->lock);
 
-       if (padapter->pid[1] != 0) {
-               DBG_88E("pid[1]:%d\n", padapter->pid[1]);
-               rtw_signal_process(padapter->pid[1], SIGUSR2);
-       }
-
        rtw_roaming(padapter, NULL);
 
        ret = 0;
 exit:
        if (pwrpriv)
                pwrpriv->bInSuspend = false;
-       DBG_88E("<===  %s return %d.............. in %dms\n", __func__,
+       pr_debug("<===  %s return %d.............. in %dms\n", __func__,
                ret, rtw_get_passing_time_ms(start_time));
 
-
        return ret;
 }
 
@@ -369,6 +349,7 @@ static struct adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
 {
        struct adapter *padapter = NULL;
        struct net_device *pnetdev = NULL;
+       struct net_device *pmondev;
        int status = _FAIL;
 
        padapter = (struct adapter *)vzalloc(sizeof(*padapter));
@@ -387,6 +368,13 @@ static struct adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
        SET_NETDEV_DEV(pnetdev, dvobj_to_dev(dvobj));
        padapter = rtw_netdev_priv(pnetdev);
 
+       if (padapter->registrypriv.monitor_enable) {
+               pmondev = rtl88eu_mon_init();
+               if (pmondev == NULL)
+                       netdev_warn(pnetdev, "Failed to initialize monitor interface");
+               padapter->pmondev = pmondev;
+       }
+
        /* step 2. hook HalFunc, allocate HalData */
        hal_set_hal_ops(padapter);
 
@@ -414,8 +402,8 @@ static struct adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
                dvobj->pusbdev->do_remote_wakeup = 1;
                pusb_intf->needs_remote_wakeup = 1;
                device_init_wakeup(&pusb_intf->dev, 1);
-               DBG_88E("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n");
-               DBG_88E("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",
+               pr_debug("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~~~~\n");
+               pr_debug("\n  padapter->pwrctrlpriv.bSupportRemoteWakeup~~~[%d]~~~\n",
                        device_may_wakeup(&pusb_intf->dev));
        }
 #endif
@@ -423,13 +411,13 @@ static struct adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
        /* 2012-07-11 Move here to prevent the 8723AS-VAU BT auto
         * suspend influence */
        if (usb_autopm_get_interface(pusb_intf) < 0)
-                       DBG_88E("can't get autopm:\n");
+                       pr_debug("can't get autopm:\n");
 
        /*  alloc dev name after read efuse. */
        rtw_init_netdev_name(pnetdev, padapter->registrypriv.ifname);
        rtw_macaddr_cfg(padapter->eeprompriv.mac_addr);
        memcpy(pnetdev->dev_addr, padapter->eeprompriv.mac_addr, ETH_ALEN);
-       DBG_88E("MAC Address from pnetdev->dev_addr =  %pM\n",
+       pr_debug("MAC Address from pnetdev->dev_addr =  %pM\n",
                pnetdev->dev_addr);
 
        /* step 6. Tell the network stack we exist */
@@ -438,7 +426,7 @@ static struct adapter *rtw_usb_if1_init(struct dvobj_priv *dvobj,
                goto free_hal_data;
        }
 
-       DBG_88E("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
+       pr_debug("bDriverStopped:%d, bSurpriseRemoved:%d, bup:%d, hw_init_completed:%d\n"
                , padapter->bDriverStopped
                , padapter->bSurpriseRemoved
                , padapter->bup
@@ -479,10 +467,11 @@ static void rtw_usb_if1_deinit(struct adapter *if1)
                unregister_netdev(pnetdev);
                rtw_proc_remove_one(pnetdev);
        }
+       rtl88eu_mon_deinit(if1->pmondev);
        rtw_cancel_all_timer(if1);
 
        rtw_dev_unload(if1);
-       DBG_88E("+r871xu_dev_remove, hw_init_completed=%d\n",
+       pr_debug("+r871xu_dev_remove, hw_init_completed=%d\n",
                if1->hw_init_completed);
        rtw_free_drv_sw(if1);
        if (pnetdev)
@@ -492,7 +481,6 @@ static void rtw_usb_if1_deinit(struct adapter *if1)
 static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device_id *pdid)
 {
        struct adapter *if1 = NULL;
-       int status = _FAIL;
        struct dvobj_priv *dvobj;
 
        RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+rtw_drv_init\n"));
@@ -507,24 +495,18 @@ static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device
 
        if1 = rtw_usb_if1_init(dvobj, pusb_intf, pdid);
        if (if1 == NULL) {
-               DBG_88E("rtw_init_primarystruct adapter Failed!\n");
+               pr_debug("rtw_init_primarystruct adapter Failed!\n");
                goto free_dvobj;
        }
 
-       if (ui_pid[1] != 0) {
-               DBG_88E("ui_pid[1]:%d\n", ui_pid[1]);
-               rtw_signal_process(ui_pid[1], SIGUSR2);
-       }
-
        RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-871x_drv - drv_init, success!\n"));
 
-       status = _SUCCESS;
+       return 0;
 
 free_dvobj:
-       if (status != _SUCCESS)
-               usb_dvobj_deinit(pusb_intf);
+       usb_dvobj_deinit(pusb_intf);
 exit:
-       return status == _SUCCESS ? 0 : -ENODEV;
+       return -ENODEV;
 }
 
 /*
@@ -536,8 +518,7 @@ static void rtw_dev_remove(struct usb_interface *pusb_intf)
        struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf);
        struct adapter *padapter = dvobj->if1;
 
-
-       DBG_88E("+rtw_dev_remove\n");
+       pr_debug("+rtw_dev_remove\n");
        RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("+dev_remove()\n"));
 
        if (!pusb_intf->unregistering)
@@ -553,7 +534,7 @@ static void rtw_dev_remove(struct usb_interface *pusb_intf)
        usb_dvobj_deinit(pusb_intf);
 
        RT_TRACE(_module_hci_intfs_c_, _drv_err_, ("-dev_remove()\n"));
-       DBG_88E("-r871xu_dev_remove, done\n");
+       pr_debug("-r871xu_dev_remove, done\n");
 }
 
 static struct usb_driver rtl8188e_usb_drv = {