db15438cd5
Remove unnecessary forward declaration of rtusb_probe() and rtusb_disconnect() Signed-off-by: Simon Horman <horms@verge.net.au> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
884 lines
26 KiB
C
884 lines
26 KiB
C
/*
|
|
*************************************************************************
|
|
* Ralink Tech Inc.
|
|
* 5F., No.36, Taiyuan St., Jhubei City,
|
|
* Hsinchu County 302,
|
|
* Taiwan, R.O.C.
|
|
*
|
|
* (c) Copyright 2002-2007, Ralink Technology, Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify *
|
|
* it under the terms of the GNU General Public License as published by *
|
|
* the Free Software Foundation; either version 2 of the License, or *
|
|
* (at your option) any later version. *
|
|
* *
|
|
* 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. *
|
|
* *
|
|
* You should have received a copy of the GNU General Public License *
|
|
* along with this program; if not, write to the *
|
|
* Free Software Foundation, Inc., *
|
|
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
|
|
* *
|
|
*************************************************************************/
|
|
|
|
#include "rt_config.h"
|
|
|
|
/* Following information will be show when you run 'modinfo' */
|
|
/* *** If you have a solution for the bug in current version of driver, please mail to me. */
|
|
/* Otherwise post to forum in ralinktech's web site(www.ralinktech.com) and let all users help you. *** */
|
|
MODULE_AUTHOR("Paul Lin <paul_lin@ralinktech.com>");
|
|
MODULE_DESCRIPTION("RT2870/RT3070 Wireless Lan Linux Driver");
|
|
MODULE_LICENSE("GPL");
|
|
#ifdef MODULE_VERSION
|
|
MODULE_VERSION(STA_DRIVER_VERSION);
|
|
#endif
|
|
|
|
/* module table */
|
|
struct usb_device_id rtusb_usb_id[] = {
|
|
#ifdef RT2870
|
|
{USB_DEVICE(0x148F, 0x2770)}, /* Ralink */
|
|
{USB_DEVICE(0x148F, 0x2870)}, /* Ralink */
|
|
{USB_DEVICE(0x07B8, 0x2870)}, /* AboCom */
|
|
{USB_DEVICE(0x07B8, 0x2770)}, /* AboCom */
|
|
{USB_DEVICE(0x0DF6, 0x0039)}, /* Sitecom 2770 */
|
|
{USB_DEVICE(0x083A, 0x7512)}, /* Arcadyan 2770 */
|
|
{USB_DEVICE(0x0789, 0x0162)}, /* Logitec 2870 */
|
|
{USB_DEVICE(0x0789, 0x0163)}, /* Logitec 2870 */
|
|
{USB_DEVICE(0x0789, 0x0164)}, /* Logitec 2870 */
|
|
{USB_DEVICE(0x177f, 0x0302)}, /* lsusb */
|
|
{USB_DEVICE(0x0B05, 0x1731)}, /* Asus */
|
|
{USB_DEVICE(0x0B05, 0x1732)}, /* Asus */
|
|
{USB_DEVICE(0x0B05, 0x1742)}, /* Asus */
|
|
{USB_DEVICE(0x0DF6, 0x0017)}, /* Sitecom */
|
|
{USB_DEVICE(0x0DF6, 0x002B)}, /* Sitecom */
|
|
{USB_DEVICE(0x0DF6, 0x002C)}, /* Sitecom */
|
|
{USB_DEVICE(0x0DF6, 0x002D)}, /* Sitecom */
|
|
{USB_DEVICE(0x14B2, 0x3C06)}, /* Conceptronic */
|
|
{USB_DEVICE(0x14B2, 0x3C28)}, /* Conceptronic */
|
|
{USB_DEVICE(0x2019, 0xED06)}, /* Planex Communications, Inc. */
|
|
{USB_DEVICE(0x07D1, 0x3C09)}, /* D-Link */
|
|
{USB_DEVICE(0x07D1, 0x3C11)}, /* D-Link */
|
|
{USB_DEVICE(0x14B2, 0x3C07)}, /* AL */
|
|
{USB_DEVICE(0x050D, 0x8053)}, /* Belkin */
|
|
{USB_DEVICE(0x14B2, 0x3C23)}, /* Airlink */
|
|
{USB_DEVICE(0x14B2, 0x3C27)}, /* Airlink */
|
|
{USB_DEVICE(0x07AA, 0x002F)}, /* Corega */
|
|
{USB_DEVICE(0x07AA, 0x003C)}, /* Corega */
|
|
{USB_DEVICE(0x07AA, 0x003F)}, /* Corega */
|
|
{USB_DEVICE(0x1044, 0x800B)}, /* Gigabyte */
|
|
{USB_DEVICE(0x15A9, 0x0006)}, /* Sparklan */
|
|
{USB_DEVICE(0x083A, 0xB522)}, /* SMC */
|
|
{USB_DEVICE(0x083A, 0xA618)}, /* SMC */
|
|
{USB_DEVICE(0x083A, 0x8522)}, /* Arcadyan */
|
|
{USB_DEVICE(0x083A, 0x7522)}, /* Arcadyan */
|
|
{USB_DEVICE(0x0CDE, 0x0022)}, /* ZCOM */
|
|
{USB_DEVICE(0x0586, 0x3416)}, /* Zyxel */
|
|
{USB_DEVICE(0x0CDE, 0x0025)}, /* Zyxel */
|
|
{USB_DEVICE(0x1740, 0x9701)}, /* EnGenius */
|
|
{USB_DEVICE(0x1740, 0x9702)}, /* EnGenius */
|
|
{USB_DEVICE(0x0471, 0x200f)}, /* Philips */
|
|
{USB_DEVICE(0x14B2, 0x3C25)}, /* Draytek */
|
|
{USB_DEVICE(0x13D3, 0x3247)}, /* AzureWave */
|
|
{USB_DEVICE(0x083A, 0x6618)}, /* Accton */
|
|
{USB_DEVICE(0x15c5, 0x0008)}, /* Amit */
|
|
{USB_DEVICE(0x0E66, 0x0001)}, /* Hawking */
|
|
{USB_DEVICE(0x0E66, 0x0003)}, /* Hawking */
|
|
{USB_DEVICE(0x129B, 0x1828)}, /* Siemens */
|
|
{USB_DEVICE(0x157E, 0x300E)}, /* U-Media */
|
|
{USB_DEVICE(0x050d, 0x805c)},
|
|
{USB_DEVICE(0x050d, 0x815c)},
|
|
{USB_DEVICE(0x1482, 0x3C09)}, /* Abocom */
|
|
{USB_DEVICE(0x14B2, 0x3C09)}, /* Alpha */
|
|
{USB_DEVICE(0x04E8, 0x2018)}, /* samsung */
|
|
{USB_DEVICE(0x5A57, 0x0280)}, /* Zinwell */
|
|
{USB_DEVICE(0x5A57, 0x0282)}, /* Zinwell */
|
|
{USB_DEVICE(0x7392, 0x7718)},
|
|
{USB_DEVICE(0x7392, 0x7717)},
|
|
{USB_DEVICE(0x1737, 0x0070)}, /* Linksys WUSB100 */
|
|
{USB_DEVICE(0x1737, 0x0071)}, /* Linksys WUSB600N */
|
|
{USB_DEVICE(0x0411, 0x00e8)}, /* Buffalo WLI-UC-G300N */
|
|
{USB_DEVICE(0x050d, 0x815c)}, /* Belkin F5D8053 */
|
|
#endif /* RT2870 // */
|
|
#ifdef RT3070
|
|
{USB_DEVICE(0x148F, 0x3070)}, /* Ralink 3070 */
|
|
{USB_DEVICE(0x148F, 0x3071)}, /* Ralink 3071 */
|
|
{USB_DEVICE(0x148F, 0x3072)}, /* Ralink 3072 */
|
|
{USB_DEVICE(0x0DB0, 0x3820)}, /* Ralink 3070 */
|
|
{USB_DEVICE(0x0DF6, 0x003E)}, /* Sitecom 3070 */
|
|
{USB_DEVICE(0x0DF6, 0x0042)}, /* Sitecom 3072 */
|
|
{USB_DEVICE(0x14B2, 0x3C12)}, /* AL 3070 */
|
|
{USB_DEVICE(0x18C5, 0x0012)}, /* Corega 3070 */
|
|
{USB_DEVICE(0x083A, 0x7511)}, /* Arcadyan 3070 */
|
|
{USB_DEVICE(0x1740, 0x9703)}, /* EnGenius 3070 */
|
|
{USB_DEVICE(0x1740, 0x9705)}, /* EnGenius 3071 */
|
|
{USB_DEVICE(0x1740, 0x9706)}, /* EnGenius 3072 */
|
|
{USB_DEVICE(0x13D3, 0x3273)}, /* AzureWave 3070 */
|
|
{USB_DEVICE(0x1044, 0x800D)}, /* Gigabyte GN-WB32L 3070 */
|
|
{USB_DEVICE(0x2019, 0xAB25)}, /* Planex Communications, Inc. RT3070 */
|
|
{USB_DEVICE(0x07B8, 0x3070)}, /* AboCom 3070 */
|
|
{USB_DEVICE(0x07B8, 0x3071)}, /* AboCom 3071 */
|
|
{USB_DEVICE(0x07B8, 0x3072)}, /* Abocom 3072 */
|
|
{USB_DEVICE(0x7392, 0x7711)}, /* Edimax 3070 */
|
|
{USB_DEVICE(0x1A32, 0x0304)}, /* Quanta 3070 */
|
|
{USB_DEVICE(0x1EDA, 0x2310)}, /* AirTies 3070 */
|
|
{USB_DEVICE(0x07D1, 0x3C0A)}, /* D-Link 3072 */
|
|
{USB_DEVICE(0x07D1, 0x3C0D)}, /* D-Link 3070 */
|
|
{USB_DEVICE(0x07D1, 0x3C0E)}, /* D-Link 3070 */
|
|
{USB_DEVICE(0x07D1, 0x3C0F)}, /* D-Link 3070 */
|
|
{USB_DEVICE(0x1D4D, 0x000C)}, /* Pegatron Corporation 3070 */
|
|
{USB_DEVICE(0x1D4D, 0x000E)}, /* Pegatron Corporation 3070 */
|
|
{USB_DEVICE(0x5A57, 0x5257)}, /* Zinwell 3070 */
|
|
{USB_DEVICE(0x5A57, 0x0283)}, /* Zinwell 3072 */
|
|
{USB_DEVICE(0x04BB, 0x0945)}, /* I-O DATA 3072 */
|
|
{USB_DEVICE(0x203D, 0x1480)}, /* Encore 3070 */
|
|
#endif /* RT3070 // */
|
|
{USB_DEVICE(0x0DF6, 0x003F)}, /* Sitecom WL-608 */
|
|
{USB_DEVICE(0x1737, 0x0077)}, /* Linksys WUSB54GC-EU v3 */
|
|
{USB_DEVICE(0x2001, 0x3C09)}, /* D-Link */
|
|
{USB_DEVICE(0x2001, 0x3C0A)}, /* D-Link 3072 */
|
|
{USB_DEVICE(0x2019, 0xED14)}, /* Planex Communications, Inc. */
|
|
{} /* Terminating entry */
|
|
};
|
|
|
|
int const rtusb_usb_id_len =
|
|
sizeof(rtusb_usb_id) / sizeof(struct usb_device_id);
|
|
|
|
MODULE_DEVICE_TABLE(usb, rtusb_usb_id);
|
|
|
|
static void rt2870_disconnect(struct usb_device *dev, struct rt_rtmp_adapter *pAd);
|
|
|
|
static int __devinit rt2870_probe(IN struct usb_interface *intf,
|
|
IN struct usb_device *usb_dev,
|
|
IN const struct usb_device_id *dev_id,
|
|
struct rt_rtmp_adapter ** ppAd);
|
|
|
|
#ifndef PF_NOFREEZE
|
|
#define PF_NOFREEZE 0
|
|
#endif
|
|
|
|
extern int rt28xx_close(IN struct net_device *net_dev);
|
|
extern int rt28xx_open(struct net_device *net_dev);
|
|
|
|
static BOOLEAN USBDevConfigInit(IN struct usb_device *dev,
|
|
IN struct usb_interface *intf,
|
|
struct rt_rtmp_adapter *pAd);
|
|
|
|
/*
|
|
========================================================================
|
|
Routine Description:
|
|
Check the chipset vendor/product ID.
|
|
|
|
Arguments:
|
|
_dev_p Point to the PCI or USB device
|
|
|
|
Return Value:
|
|
TRUE Check ok
|
|
FALSE Check fail
|
|
|
|
Note:
|
|
========================================================================
|
|
*/
|
|
BOOLEAN RT28XXChipsetCheck(IN void *_dev_p)
|
|
{
|
|
struct usb_interface *intf = (struct usb_interface *)_dev_p;
|
|
struct usb_device *dev_p = interface_to_usbdev(intf);
|
|
u32 i;
|
|
|
|
for (i = 0; i < rtusb_usb_id_len; i++) {
|
|
if (dev_p->descriptor.idVendor == rtusb_usb_id[i].idVendor &&
|
|
dev_p->descriptor.idProduct == rtusb_usb_id[i].idProduct) {
|
|
printk("rt2870: idVendor = 0x%x, idProduct = 0x%x\n",
|
|
dev_p->descriptor.idVendor,
|
|
dev_p->descriptor.idProduct);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (i == rtusb_usb_id_len) {
|
|
printk("rt2870: Error! Device Descriptor not matching!\n");
|
|
return FALSE;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/**************************************************************************/
|
|
/**************************************************************************/
|
|
/*tested for kernel 2.6series */
|
|
/**************************************************************************/
|
|
/**************************************************************************/
|
|
|
|
#ifdef CONFIG_PM
|
|
static int rt2870_suspend(struct usb_interface *intf, pm_message_t state);
|
|
static int rt2870_resume(struct usb_interface *intf);
|
|
#endif /* CONFIG_PM // */
|
|
|
|
static BOOLEAN USBDevConfigInit(IN struct usb_device *dev,
|
|
IN struct usb_interface *intf,
|
|
struct rt_rtmp_adapter *pAd)
|
|
{
|
|
struct usb_host_interface *iface_desc;
|
|
unsigned long BulkOutIdx;
|
|
u32 i;
|
|
|
|
/* get the active interface descriptor */
|
|
iface_desc = intf->cur_altsetting;
|
|
|
|
/* get # of enpoints */
|
|
pAd->NumberOfPipes = iface_desc->desc.bNumEndpoints;
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("NumEndpoints=%d\n", iface_desc->desc.bNumEndpoints));
|
|
|
|
/* Configure Pipes */
|
|
BulkOutIdx = 0;
|
|
|
|
for (i = 0; i < pAd->NumberOfPipes; i++) {
|
|
if ((iface_desc->endpoint[i].desc.bmAttributes ==
|
|
USB_ENDPOINT_XFER_BULK) &&
|
|
((iface_desc->endpoint[i].desc.bEndpointAddress &
|
|
USB_ENDPOINT_DIR_MASK) == USB_DIR_IN)) {
|
|
pAd->BulkInEpAddr =
|
|
iface_desc->endpoint[i].desc.bEndpointAddress;
|
|
pAd->BulkInMaxPacketSize =
|
|
le2cpu16(iface_desc->endpoint[i].desc.
|
|
wMaxPacketSize);
|
|
|
|
DBGPRINT_RAW(RT_DEBUG_TRACE,
|
|
("BULK IN MaxPacketSize = %d\n",
|
|
pAd->BulkInMaxPacketSize));
|
|
DBGPRINT_RAW(RT_DEBUG_TRACE,
|
|
("EP address = 0x%2x\n",
|
|
iface_desc->endpoint[i].desc.
|
|
bEndpointAddress));
|
|
} else
|
|
if ((iface_desc->endpoint[i].desc.bmAttributes ==
|
|
USB_ENDPOINT_XFER_BULK)
|
|
&&
|
|
((iface_desc->endpoint[i].desc.
|
|
bEndpointAddress & USB_ENDPOINT_DIR_MASK) ==
|
|
USB_DIR_OUT)) {
|
|
/* there are 6 bulk out EP. EP6 highest priority. */
|
|
/* EP1-4 is EDCA. EP5 is HCCA. */
|
|
pAd->BulkOutEpAddr[BulkOutIdx++] =
|
|
iface_desc->endpoint[i].desc.bEndpointAddress;
|
|
pAd->BulkOutMaxPacketSize =
|
|
le2cpu16(iface_desc->endpoint[i].desc.
|
|
wMaxPacketSize);
|
|
|
|
DBGPRINT_RAW(RT_DEBUG_TRACE,
|
|
("BULK OUT MaxPacketSize = %d\n",
|
|
pAd->BulkOutMaxPacketSize));
|
|
DBGPRINT_RAW(RT_DEBUG_TRACE,
|
|
("EP address = 0x%2x \n",
|
|
iface_desc->endpoint[i].desc.
|
|
bEndpointAddress));
|
|
}
|
|
}
|
|
|
|
if (!(pAd->BulkInEpAddr && pAd->BulkOutEpAddr[0])) {
|
|
printk
|
|
("%s: Could not find both bulk-in and bulk-out endpoints\n",
|
|
__FUNCTION__);
|
|
return FALSE;
|
|
}
|
|
|
|
pAd->config = &dev->config->desc;
|
|
usb_set_intfdata(intf, pAd);
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
static int __devinit rtusb_probe(struct usb_interface *intf,
|
|
const struct usb_device_id *id)
|
|
{
|
|
struct rt_rtmp_adapter *pAd;
|
|
struct usb_device *dev;
|
|
int rv;
|
|
|
|
dev = interface_to_usbdev(intf);
|
|
dev = usb_get_dev(dev);
|
|
|
|
rv = rt2870_probe(intf, dev, id, &pAd);
|
|
if (rv != 0)
|
|
usb_put_dev(dev);
|
|
|
|
return rv;
|
|
}
|
|
|
|
static void rtusb_disconnect(struct usb_interface *intf)
|
|
{
|
|
struct usb_device *dev = interface_to_usbdev(intf);
|
|
struct rt_rtmp_adapter *pAd;
|
|
|
|
pAd = usb_get_intfdata(intf);
|
|
usb_set_intfdata(intf, NULL);
|
|
|
|
rt2870_disconnect(dev, pAd);
|
|
}
|
|
|
|
struct usb_driver rtusb_driver = {
|
|
.name = "rt2870",
|
|
.probe = rtusb_probe,
|
|
.disconnect = rtusb_disconnect,
|
|
.id_table = rtusb_usb_id,
|
|
|
|
#ifdef CONFIG_PM
|
|
suspend:rt2870_suspend,
|
|
resume:rt2870_resume,
|
|
#endif
|
|
};
|
|
|
|
#ifdef CONFIG_PM
|
|
|
|
void RT2870RejectPendingPackets(struct rt_rtmp_adapter *pAd)
|
|
{
|
|
/* clear PS packets */
|
|
/* clear TxSw packets */
|
|
}
|
|
|
|
static int rt2870_suspend(struct usb_interface *intf, pm_message_t state)
|
|
{
|
|
struct net_device *net_dev;
|
|
struct rt_rtmp_adapter *pAd = usb_get_intfdata(intf);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("===> rt2870_suspend()\n"));
|
|
net_dev = pAd->net_dev;
|
|
netif_device_detach(net_dev);
|
|
|
|
pAd->PM_FlgSuspend = 1;
|
|
if (netif_running(net_dev)) {
|
|
RTUSBCancelPendingBulkInIRP(pAd);
|
|
RTUSBCancelPendingBulkOutIRP(pAd);
|
|
}
|
|
DBGPRINT(RT_DEBUG_TRACE, ("<=== rt2870_suspend()\n"));
|
|
return 0;
|
|
}
|
|
|
|
static int rt2870_resume(struct usb_interface *intf)
|
|
{
|
|
struct net_device *net_dev;
|
|
struct rt_rtmp_adapter *pAd = usb_get_intfdata(intf);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("===> rt2870_resume()\n"));
|
|
|
|
pAd->PM_FlgSuspend = 0;
|
|
net_dev = pAd->net_dev;
|
|
netif_device_attach(net_dev);
|
|
netif_start_queue(net_dev);
|
|
netif_carrier_on(net_dev);
|
|
netif_wake_queue(net_dev);
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("<=== rt2870_resume()\n"));
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_PM // */
|
|
|
|
/* Init driver module */
|
|
int __init rtusb_init(void)
|
|
{
|
|
printk("rtusb init --->\n");
|
|
return usb_register(&rtusb_driver);
|
|
}
|
|
|
|
/* Deinit driver module */
|
|
void __exit rtusb_exit(void)
|
|
{
|
|
usb_deregister(&rtusb_driver);
|
|
printk("<--- rtusb exit\n");
|
|
}
|
|
|
|
module_init(rtusb_init);
|
|
module_exit(rtusb_exit);
|
|
|
|
/*--------------------------------------------------------------------- */
|
|
/* function declarations */
|
|
/*--------------------------------------------------------------------- */
|
|
|
|
/*
|
|
========================================================================
|
|
Routine Description:
|
|
MLME kernel thread.
|
|
|
|
Arguments:
|
|
*Context the pAd, driver control block pointer
|
|
|
|
Return Value:
|
|
0 close the thread
|
|
|
|
Note:
|
|
========================================================================
|
|
*/
|
|
int MlmeThread(IN void *Context)
|
|
{
|
|
struct rt_rtmp_adapter *pAd;
|
|
struct rt_rtmp_os_task *pTask;
|
|
int status;
|
|
status = 0;
|
|
|
|
pTask = (struct rt_rtmp_os_task *)Context;
|
|
pAd = (struct rt_rtmp_adapter *)pTask->priv;
|
|
|
|
RtmpOSTaskCustomize(pTask);
|
|
|
|
while (!pTask->task_killed) {
|
|
#ifdef KTHREAD_SUPPORT
|
|
RTMP_WAIT_EVENT_INTERRUPTIBLE(pAd, pTask);
|
|
#else
|
|
RTMP_SEM_EVENT_WAIT(&(pTask->taskSema), status);
|
|
|
|
/* unlock the device pointers */
|
|
if (status != 0) {
|
|
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS);
|
|
break;
|
|
}
|
|
#endif
|
|
|
|
/* lock the device pointers , need to check if required */
|
|
/*down(&(pAd->usbdev_semaphore)); */
|
|
|
|
if (!pAd->PM_FlgSuspend)
|
|
MlmeHandler(pAd);
|
|
}
|
|
|
|
/* notify the exit routine that we're actually exiting now
|
|
*
|
|
* complete()/wait_for_completion() is similar to up()/down(),
|
|
* except that complete() is safe in the case where the structure
|
|
* is getting deleted in a parallel mode of execution (i.e. just
|
|
* after the down() -- that's necessary for the thread-shutdown
|
|
* case.
|
|
*
|
|
* complete_and_exit() goes even further than this -- it is safe in
|
|
* the case that the thread of the caller is going away (not just
|
|
* the structure) -- this is necessary for the module-remove case.
|
|
* This is important in preemption kernels, which transfer the flow
|
|
* of execution immediately upon a complete().
|
|
*/
|
|
DBGPRINT(RT_DEBUG_TRACE, ("<---%s\n", __FUNCTION__));
|
|
#ifndef KTHREAD_SUPPORT
|
|
pTask->taskPID = THREAD_PID_INIT_VALUE;
|
|
complete_and_exit(&pTask->taskComplete, 0);
|
|
#endif
|
|
return 0;
|
|
|
|
}
|
|
|
|
/*
|
|
========================================================================
|
|
Routine Description:
|
|
USB command kernel thread.
|
|
|
|
Arguments:
|
|
*Context the pAd, driver control block pointer
|
|
|
|
Return Value:
|
|
0 close the thread
|
|
|
|
Note:
|
|
========================================================================
|
|
*/
|
|
int RTUSBCmdThread(IN void *Context)
|
|
{
|
|
struct rt_rtmp_adapter *pAd;
|
|
struct rt_rtmp_os_task *pTask;
|
|
int status;
|
|
status = 0;
|
|
|
|
pTask = (struct rt_rtmp_os_task *)Context;
|
|
pAd = (struct rt_rtmp_adapter *)pTask->priv;
|
|
|
|
RtmpOSTaskCustomize(pTask);
|
|
|
|
NdisAcquireSpinLock(&pAd->CmdQLock);
|
|
pAd->CmdQ.CmdQState = RTMP_TASK_STAT_RUNNING;
|
|
NdisReleaseSpinLock(&pAd->CmdQLock);
|
|
|
|
while (pAd && pAd->CmdQ.CmdQState == RTMP_TASK_STAT_RUNNING) {
|
|
#ifdef KTHREAD_SUPPORT
|
|
RTMP_WAIT_EVENT_INTERRUPTIBLE(pAd, pTask);
|
|
#else
|
|
/* lock the device pointers */
|
|
RTMP_SEM_EVENT_WAIT(&(pTask->taskSema), status);
|
|
|
|
if (status != 0) {
|
|
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS);
|
|
break;
|
|
}
|
|
#endif
|
|
|
|
if (pAd->CmdQ.CmdQState == RTMP_TASK_STAT_STOPED)
|
|
break;
|
|
|
|
if (!pAd->PM_FlgSuspend)
|
|
CMDHandler(pAd);
|
|
}
|
|
|
|
if (pAd && !pAd->PM_FlgSuspend) { /* Clear the CmdQElements. */
|
|
struct rt_cmdqelmt *pCmdQElmt = NULL;
|
|
|
|
NdisAcquireSpinLock(&pAd->CmdQLock);
|
|
pAd->CmdQ.CmdQState = RTMP_TASK_STAT_STOPED;
|
|
while (pAd->CmdQ.size) {
|
|
RTUSBDequeueCmd(&pAd->CmdQ, &pCmdQElmt);
|
|
if (pCmdQElmt) {
|
|
if (pCmdQElmt->CmdFromNdis == TRUE) {
|
|
if (pCmdQElmt->buffer != NULL)
|
|
os_free_mem(pAd,
|
|
pCmdQElmt->buffer);
|
|
os_free_mem(pAd, (u8 *)pCmdQElmt);
|
|
} else {
|
|
if ((pCmdQElmt->buffer != NULL)
|
|
&& (pCmdQElmt->bufferlength != 0))
|
|
os_free_mem(pAd,
|
|
pCmdQElmt->buffer);
|
|
os_free_mem(pAd, (u8 *)pCmdQElmt);
|
|
}
|
|
}
|
|
}
|
|
|
|
NdisReleaseSpinLock(&pAd->CmdQLock);
|
|
}
|
|
/* notify the exit routine that we're actually exiting now
|
|
*
|
|
* complete()/wait_for_completion() is similar to up()/down(),
|
|
* except that complete() is safe in the case where the structure
|
|
* is getting deleted in a parallel mode of execution (i.e. just
|
|
* after the down() -- that's necessary for the thread-shutdown
|
|
* case.
|
|
*
|
|
* complete_and_exit() goes even further than this -- it is safe in
|
|
* the case that the thread of the caller is going away (not just
|
|
* the structure) -- this is necessary for the module-remove case.
|
|
* This is important in preemption kernels, which transfer the flow
|
|
* of execution immediately upon a complete().
|
|
*/
|
|
DBGPRINT(RT_DEBUG_TRACE, ("<---RTUSBCmdThread\n"));
|
|
|
|
#ifndef KTHREAD_SUPPORT
|
|
pTask->taskPID = THREAD_PID_INIT_VALUE;
|
|
complete_and_exit(&pTask->taskComplete, 0);
|
|
#endif
|
|
return 0;
|
|
|
|
}
|
|
|
|
void RTUSBWatchDog(struct rt_rtmp_adapter *pAd)
|
|
{
|
|
struct rt_ht_tx_context *pHTTXContext;
|
|
int idx;
|
|
unsigned long irqFlags;
|
|
PURB pUrb;
|
|
BOOLEAN needDumpSeq = FALSE;
|
|
u32 MACValue;
|
|
u32 TxRxQ_Pcnt;
|
|
|
|
idx = 0;
|
|
RTMP_IO_READ32(pAd, TXRXQ_PCNT, &MACValue);
|
|
if ((MACValue & 0xff) != 0) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("TX QUEUE 0 Not EMPTY(Value=0x%0x)!\n",
|
|
MACValue));
|
|
RTMP_IO_WRITE32(pAd, PBF_CFG, 0xf40012);
|
|
while ((MACValue & 0xff) != 0 && (idx++ < 10)) {
|
|
RTMP_IO_READ32(pAd, TXRXQ_PCNT, &MACValue);
|
|
RTMPusecDelay(1);
|
|
}
|
|
RTMP_IO_WRITE32(pAd, PBF_CFG, 0xf40006);
|
|
}
|
|
|
|
if (pAd->watchDogRxOverFlowCnt >= 2) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("Maybe the Rx Bulk-In hanged! Cancel the pending Rx bulks request!\n"));
|
|
if ((!RTMP_TEST_FLAG
|
|
(pAd,
|
|
(fRTMP_ADAPTER_RESET_IN_PROGRESS |
|
|
fRTMP_ADAPTER_BULKIN_RESET |
|
|
fRTMP_ADAPTER_HALT_IN_PROGRESS |
|
|
fRTMP_ADAPTER_NIC_NOT_EXIST)))) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("Call CMDTHREAD_RESET_BULK_IN to cancel the pending Rx Bulk!\n"));
|
|
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_BULKIN_RESET);
|
|
RTUSBEnqueueInternalCmd(pAd, CMDTHREAD_RESET_BULK_IN,
|
|
NULL, 0);
|
|
needDumpSeq = TRUE;
|
|
}
|
|
pAd->watchDogRxOverFlowCnt = 0;
|
|
}
|
|
|
|
RTUSBReadMACRegister(pAd, 0x438, &TxRxQ_Pcnt);
|
|
|
|
for (idx = 0; idx < NUM_OF_TX_RING; idx++) {
|
|
pUrb = NULL;
|
|
|
|
RTMP_IRQ_LOCK(&pAd->BulkOutLock[idx], irqFlags);
|
|
if ((pAd->BulkOutPending[idx] == TRUE)
|
|
&& pAd->watchDogTxPendingCnt) {
|
|
int actual_length = 0, transfer_buffer_length = 0;
|
|
BOOLEAN isDataPacket = FALSE;
|
|
pAd->watchDogTxPendingCnt[idx]++;
|
|
|
|
if ((pAd->watchDogTxPendingCnt[idx] > 2) &&
|
|
(!RTMP_TEST_FLAG
|
|
(pAd,
|
|
(fRTMP_ADAPTER_RESET_IN_PROGRESS |
|
|
fRTMP_ADAPTER_HALT_IN_PROGRESS |
|
|
fRTMP_ADAPTER_NIC_NOT_EXIST |
|
|
fRTMP_ADAPTER_BULKOUT_RESET)))
|
|
) {
|
|
/* FIXME: Following code just support single bulk out. If you wanna support multiple bulk out. Modify it! */
|
|
pHTTXContext =
|
|
(struct rt_ht_tx_context *)(&pAd->TxContext[idx]);
|
|
if (pHTTXContext->IRPPending) { /* Check TxContext. */
|
|
pUrb = pHTTXContext->pUrb;
|
|
|
|
actual_length = pUrb->actual_length;
|
|
transfer_buffer_length =
|
|
pUrb->transfer_buffer_length;
|
|
isDataPacket = TRUE;
|
|
} else if (idx == MGMTPIPEIDX) {
|
|
struct rt_tx_context *pMLMEContext, *pNULLContext,
|
|
*pPsPollContext;
|
|
|
|
/*Check MgmtContext. */
|
|
pMLMEContext =
|
|
(struct rt_tx_context *)(pAd->MgmtRing.
|
|
Cell[pAd->MgmtRing.
|
|
TxDmaIdx].
|
|
AllocVa);
|
|
pPsPollContext =
|
|
(struct rt_tx_context *)(&pAd->PsPollContext);
|
|
pNULLContext =
|
|
(struct rt_tx_context *)(&pAd->NullContext);
|
|
|
|
if (pMLMEContext->IRPPending) {
|
|
ASSERT(pMLMEContext->
|
|
IRPPending);
|
|
pUrb = pMLMEContext->pUrb;
|
|
} else if (pNULLContext->IRPPending) {
|
|
ASSERT(pNULLContext->
|
|
IRPPending);
|
|
pUrb = pNULLContext->pUrb;
|
|
} else if (pPsPollContext->IRPPending) {
|
|
ASSERT(pPsPollContext->
|
|
IRPPending);
|
|
pUrb = pPsPollContext->pUrb;
|
|
}
|
|
}
|
|
|
|
RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[idx],
|
|
irqFlags);
|
|
|
|
printk(KERN_INFO "%d:%lu LTL=%d , TL=%d L:%d\n",
|
|
idx, pAd->watchDogTxPendingCnt[idx],
|
|
pAd->TransferedLength[idx],
|
|
actual_length, transfer_buffer_length);
|
|
|
|
if (pUrb) {
|
|
if ((isDataPacket
|
|
&& pAd->TransferedLength[idx] ==
|
|
actual_length
|
|
&& pAd->TransferedLength[idx] <
|
|
transfer_buffer_length
|
|
&& actual_length != 0
|
|
/* && TxRxQ_Pcnt==0 */
|
|
&& pAd->watchDogTxPendingCnt[idx] >
|
|
3)
|
|
|| isDataPacket == FALSE
|
|
|| pAd->watchDogTxPendingCnt[idx] >
|
|
6) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("Maybe the Tx Bulk-Out hanged! Cancel the pending Tx bulks request of idx(%d)!\n",
|
|
idx));
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("Unlink the pending URB!\n"));
|
|
/* unlink it now */
|
|
RTUSB_UNLINK_URB(pUrb);
|
|
/* Sleep 200 microseconds to give cancellation time to work */
|
|
/*RTMPusecDelay(200); */
|
|
needDumpSeq = TRUE;
|
|
}
|
|
} else {
|
|
DBGPRINT(RT_DEBUG_ERROR,
|
|
("Unknown bulkOut URB maybe hanged!\n"));
|
|
}
|
|
} else {
|
|
RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[idx],
|
|
irqFlags);
|
|
}
|
|
|
|
if (isDataPacket == TRUE)
|
|
pAd->TransferedLength[idx] = actual_length;
|
|
} else {
|
|
RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[idx], irqFlags);
|
|
}
|
|
}
|
|
|
|
/* For Sigma debug, dump the ba_reordering sequence. */
|
|
if ((needDumpSeq == TRUE) && (pAd->CommonCfg.bDisableReordering == 0)) {
|
|
u16 Idx;
|
|
struct rt_ba_rec_entry *pBAEntry = NULL;
|
|
u8 count = 0;
|
|
struct reordering_mpdu *mpdu_blk;
|
|
|
|
Idx = pAd->MacTab.Content[BSSID_WCID].BARecWcidArray[0];
|
|
|
|
pBAEntry = &pAd->BATable.BARecEntry[Idx];
|
|
if ((pBAEntry->list.qlen > 0) && (pBAEntry->list.next != NULL)) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("NICUpdateRawCounters():The Queueing pkt in reordering buffer:\n"));
|
|
NdisAcquireSpinLock(&pBAEntry->RxReRingLock);
|
|
mpdu_blk = pBAEntry->list.next;
|
|
while (mpdu_blk) {
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("\t%d:Seq-%d, bAMSDU-%d!\n", count,
|
|
mpdu_blk->Sequence,
|
|
mpdu_blk->bAMSDU));
|
|
mpdu_blk = mpdu_blk->next;
|
|
count++;
|
|
}
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE,
|
|
("\npBAEntry->LastIndSeq=%d!\n",
|
|
pBAEntry->LastIndSeq));
|
|
NdisReleaseSpinLock(&pBAEntry->RxReRingLock);
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
========================================================================
|
|
Routine Description:
|
|
Release allocated resources.
|
|
|
|
Arguments:
|
|
*dev Point to the PCI or USB device
|
|
pAd driver control block pointer
|
|
|
|
Return Value:
|
|
None
|
|
|
|
Note:
|
|
========================================================================
|
|
*/
|
|
static void rt2870_disconnect(struct usb_device *dev, struct rt_rtmp_adapter *pAd)
|
|
{
|
|
DBGPRINT(RT_DEBUG_ERROR,
|
|
("rtusb_disconnect: unregister usbnet usb-%s-%s\n",
|
|
dev->bus->bus_name, dev->devpath));
|
|
if (!pAd) {
|
|
usb_put_dev(dev);
|
|
printk("rtusb_disconnect: pAd == NULL!\n");
|
|
return;
|
|
}
|
|
RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST);
|
|
|
|
/* for debug, wait to show some messages to /proc system */
|
|
udelay(1);
|
|
|
|
RtmpPhyNetDevExit(pAd, pAd->net_dev);
|
|
|
|
/* FIXME: Shall we need following delay and flush the schedule?? */
|
|
udelay(1);
|
|
flush_scheduled_work();
|
|
udelay(1);
|
|
|
|
/* free the root net_device */
|
|
RtmpOSNetDevFree(pAd->net_dev);
|
|
|
|
RtmpRaDevCtrlExit(pAd);
|
|
|
|
/* release a use of the usb device structure */
|
|
usb_put_dev(dev);
|
|
udelay(1);
|
|
|
|
DBGPRINT(RT_DEBUG_ERROR, (" RTUSB disconnect successfully\n"));
|
|
}
|
|
|
|
static int __devinit rt2870_probe(IN struct usb_interface *intf,
|
|
IN struct usb_device *usb_dev,
|
|
IN const struct usb_device_id *dev_id,
|
|
struct rt_rtmp_adapter ** ppAd)
|
|
{
|
|
struct net_device *net_dev = NULL;
|
|
struct rt_rtmp_adapter *pAd = (struct rt_rtmp_adapter *)NULL;
|
|
int status, rv;
|
|
void *handle;
|
|
struct rt_rtmp_os_netdev_op_hook netDevHook;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("===>rt2870_probe()!\n"));
|
|
|
|
/* Check chipset vendor/product ID */
|
|
/*if (RT28XXChipsetCheck(_dev_p) == FALSE) */
|
|
/* goto err_out; */
|
|
|
|
/*RtmpDevInit============================================= */
|
|
/* Allocate struct rt_rtmp_adapter adapter structure */
|
|
handle = kmalloc(sizeof(struct os_cookie), GFP_KERNEL);
|
|
if (handle == NULL) {
|
|
printk
|
|
("rt2870_probe(): Allocate memory for os handle failed!\n");
|
|
return -ENOMEM;
|
|
}
|
|
((struct os_cookie *)handle)->pUsb_Dev = usb_dev;
|
|
|
|
rv = RTMPAllocAdapterBlock(handle, &pAd);
|
|
if (rv != NDIS_STATUS_SUCCESS) {
|
|
kfree(handle);
|
|
goto err_out;
|
|
}
|
|
/*USBDevInit============================================== */
|
|
if (USBDevConfigInit(usb_dev, intf, pAd) == FALSE)
|
|
goto err_out_free_radev;
|
|
|
|
RtmpRaDevCtrlInit(pAd, RTMP_DEV_INF_USB);
|
|
|
|
/*NetDevInit============================================== */
|
|
net_dev = RtmpPhyNetDevInit(pAd, &netDevHook);
|
|
if (net_dev == NULL)
|
|
goto err_out_free_radev;
|
|
|
|
/* Here are the net_device structure with usb specific parameters. */
|
|
/* for supporting Network Manager.
|
|
* Set the sysfs physical device reference for the network logical device if set prior to registration will
|
|
* cause a symlink during initialization.
|
|
*/
|
|
SET_NETDEV_DEV(net_dev, &(usb_dev->dev));
|
|
|
|
pAd->StaCfg.OriDevType = net_dev->type;
|
|
|
|
/*All done, it's time to register the net device to linux kernel. */
|
|
/* Register this device */
|
|
status = RtmpOSNetDevAttach(net_dev, &netDevHook);
|
|
if (status != 0)
|
|
goto err_out_free_netdev;
|
|
|
|
#ifdef KTHREAD_SUPPORT
|
|
init_waitqueue_head(&pAd->mlmeTask.kthread_q);
|
|
init_waitqueue_head(&pAd->timerTask.kthread_q);
|
|
init_waitqueue_head(&pAd->cmdQTask.kthread_q);
|
|
#endif
|
|
|
|
*ppAd = pAd;
|
|
|
|
DBGPRINT(RT_DEBUG_TRACE, ("<===rt2870_probe()!\n"));
|
|
|
|
return 0;
|
|
|
|
/* --------------------------- ERROR HANDLE --------------------------- */
|
|
err_out_free_netdev:
|
|
RtmpOSNetDevFree(net_dev);
|
|
|
|
err_out_free_radev:
|
|
RTMPFreeAdapter(pAd);
|
|
|
|
err_out:
|
|
*ppAd = NULL;
|
|
|
|
return -1;
|
|
|
|
}
|