| /* |
| ************************************************************************* |
| * 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. * |
| * * |
| ************************************************************************* |
| |
| Module Name: |
| rtusb_io.c |
| |
| Abstract: |
| |
| Revision History: |
| Who When What |
| -------- ---------- ---------------------------------------------- |
| Name Date Modification logs |
| Paul Lin 06-25-2004 created |
| */ |
| |
| #include "../rt_config.h" |
| |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: NIC initialization complete |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| |
| NTSTATUS RTUSBFirmwareRun( |
| IN PRTMP_ADAPTER pAd) |
| { |
| NTSTATUS Status; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| USBD_TRANSFER_DIRECTION_OUT, |
| DEVICE_VENDOR_REQUEST_OUT, |
| 0x01, |
| 0x8, |
| 0, |
| NULL, |
| 0); |
| |
| return Status; |
| } |
| |
| |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: Write Firmware to NIC. |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBFirmwareWrite( |
| IN PRTMP_ADAPTER pAd, |
| IN PUCHAR pFwImage, |
| IN ULONG FwLen) |
| { |
| UINT32 MacReg; |
| NTSTATUS Status; |
| // ULONG i; |
| USHORT writeLen; |
| |
| Status = RTUSBReadMACRegister(pAd, MAC_CSR0, &MacReg); |
| |
| |
| writeLen = FwLen; |
| RTUSBMultiWrite(pAd, FIRMWARE_IMAGE_BASE, pFwImage, writeLen); |
| |
| Status = RTUSBWriteMACRegister(pAd, 0x7014, 0xffffffff); |
| Status = RTUSBWriteMACRegister(pAd, 0x701c, 0xffffffff); |
| Status = RTUSBFirmwareRun(pAd); |
| |
| return Status; |
| } |
| |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: Get current firmware operation mode (Return Value) |
| |
| Arguments: |
| |
| Return Value: |
| 0 or 1 = Downloaded by host driver |
| others = Driver doesn't download firmware |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBFirmwareOpmode( |
| IN PRTMP_ADAPTER pAd, |
| OUT PUINT32 pValue) |
| { |
| NTSTATUS Status; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| (USBD_TRANSFER_DIRECTION_IN | USBD_SHORT_TRANSFER_OK), |
| DEVICE_VENDOR_REQUEST_IN, |
| 0x1, |
| 0x11, |
| 0, |
| pValue, |
| 4); |
| return Status; |
| } |
| NTSTATUS RTUSBVenderReset( |
| IN PRTMP_ADAPTER pAd) |
| { |
| NTSTATUS Status; |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("-->RTUSBVenderReset\n")); |
| Status = RTUSB_VendorRequest( |
| pAd, |
| USBD_TRANSFER_DIRECTION_OUT, |
| DEVICE_VENDOR_REQUEST_OUT, |
| 0x01, |
| 0x1, |
| 0, |
| NULL, |
| 0); |
| |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("<--RTUSBVenderReset\n")); |
| return Status; |
| } |
| /* |
| ======================================================================== |
| |
| Routine Description: Read various length data from RT2573 |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBMultiRead( |
| IN PRTMP_ADAPTER pAd, |
| IN USHORT Offset, |
| OUT PUCHAR pData, |
| IN USHORT length) |
| { |
| NTSTATUS Status; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| (USBD_TRANSFER_DIRECTION_IN | USBD_SHORT_TRANSFER_OK), |
| DEVICE_VENDOR_REQUEST_IN, |
| 0x7, |
| 0, |
| Offset, |
| pData, |
| length); |
| |
| return Status; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: Write various length data to RT2573 |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBMultiWrite_OneByte( |
| IN PRTMP_ADAPTER pAd, |
| IN USHORT Offset, |
| IN PUCHAR pData) |
| { |
| NTSTATUS Status; |
| |
| // TODO: In 2870, use this funciton carefully cause it's not stable. |
| Status = RTUSB_VendorRequest( |
| pAd, |
| USBD_TRANSFER_DIRECTION_OUT, |
| DEVICE_VENDOR_REQUEST_OUT, |
| 0x6, |
| 0, |
| Offset, |
| pData, |
| 1); |
| |
| return Status; |
| } |
| |
| NTSTATUS RTUSBMultiWrite( |
| IN PRTMP_ADAPTER pAd, |
| IN USHORT Offset, |
| IN PUCHAR pData, |
| IN USHORT length) |
| { |
| NTSTATUS Status; |
| |
| |
| USHORT index = 0,Value; |
| PUCHAR pSrc = pData; |
| USHORT resude = 0; |
| |
| resude = length % 2; |
| length += resude; |
| do |
| { |
| Value =(USHORT)( *pSrc | (*(pSrc + 1) << 8)); |
| Status = RTUSBSingleWrite(pAd,Offset + index,Value); |
| index +=2; |
| length -= 2; |
| pSrc = pSrc + 2; |
| }while(length > 0); |
| |
| return Status; |
| } |
| |
| |
| NTSTATUS RTUSBSingleWrite( |
| IN RTMP_ADAPTER *pAd, |
| IN USHORT Offset, |
| IN USHORT Value) |
| { |
| NTSTATUS Status; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| USBD_TRANSFER_DIRECTION_OUT, |
| DEVICE_VENDOR_REQUEST_OUT, |
| 0x2, |
| Value, |
| Offset, |
| NULL, |
| 0); |
| |
| return Status; |
| |
| } |
| |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: Read 32-bit MAC register |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBReadMACRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN USHORT Offset, |
| OUT PUINT32 pValue) |
| { |
| NTSTATUS Status; |
| UINT32 localVal; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| (USBD_TRANSFER_DIRECTION_IN | USBD_SHORT_TRANSFER_OK), |
| DEVICE_VENDOR_REQUEST_IN, |
| 0x7, |
| 0, |
| Offset, |
| &localVal, |
| 4); |
| |
| *pValue = le2cpu32(localVal); |
| |
| |
| if (Status < 0) |
| *pValue = 0xffffffff; |
| |
| return Status; |
| } |
| |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: Write 32-bit MAC register |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBWriteMACRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN USHORT Offset, |
| IN UINT32 Value) |
| { |
| NTSTATUS Status; |
| UINT32 localVal; |
| |
| localVal = Value; |
| |
| Status = RTUSBSingleWrite(pAd, Offset, (USHORT)(localVal & 0xffff)); |
| Status = RTUSBSingleWrite(pAd, Offset + 2, (USHORT)((localVal & 0xffff0000) >> 16)); |
| |
| return Status; |
| } |
| |
| |
| |
| #if 1 |
| /* |
| ======================================================================== |
| |
| Routine Description: Read 8-bit BBP register |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBReadBBPRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN UCHAR Id, |
| IN PUCHAR pValue) |
| { |
| BBP_CSR_CFG_STRUC BbpCsr; |
| UINT i = 0; |
| NTSTATUS status; |
| |
| // Verify the busy condition |
| do |
| { |
| status = RTUSBReadMACRegister(pAd, BBP_CSR_CFG, &BbpCsr.word); |
| if(status >= 0) |
| { |
| if (!(BbpCsr.field.Busy == BUSY)) |
| break; |
| } |
| printk("RTUSBReadBBPRegister(BBP_CSR_CFG_1):retry count=%d!\n", i); |
| i++; |
| } |
| while ((i < RETRY_LIMIT) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))); |
| |
| if ((i == RETRY_LIMIT) || (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| // |
| // Read failed then Return Default value. |
| // |
| *pValue = pAd->BbpWriteLatch[Id]; |
| |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("Retry count exhausted or device removed!!!\n")); |
| return STATUS_UNSUCCESSFUL; |
| } |
| |
| // Prepare for write material |
| BbpCsr.word = 0; |
| BbpCsr.field.fRead = 1; |
| BbpCsr.field.Busy = 1; |
| BbpCsr.field.RegNum = Id; |
| RTUSBWriteMACRegister(pAd, BBP_CSR_CFG, BbpCsr.word); |
| |
| i = 0; |
| // Verify the busy condition |
| do |
| { |
| status = RTUSBReadMACRegister(pAd, BBP_CSR_CFG, &BbpCsr.word); |
| if (status >= 0) |
| { |
| if (!(BbpCsr.field.Busy == BUSY)) |
| { |
| *pValue = (UCHAR)BbpCsr.field.Value; |
| break; |
| } |
| } |
| printk("RTUSBReadBBPRegister(BBP_CSR_CFG_2):retry count=%d!\n", i); |
| i++; |
| } |
| while ((i < RETRY_LIMIT) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))); |
| |
| if ((i == RETRY_LIMIT) || (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| // |
| // Read failed then Return Default value. |
| // |
| *pValue = pAd->BbpWriteLatch[Id]; |
| |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("Retry count exhausted or device removed!!!\n")); |
| return STATUS_UNSUCCESSFUL; |
| } |
| |
| return STATUS_SUCCESS; |
| } |
| #else |
| /* |
| ======================================================================== |
| |
| Routine Description: Read 8-bit BBP register via firmware |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBReadBBPRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN UCHAR Id, |
| IN PUCHAR pValue) |
| { |
| BBP_CSR_CFG_STRUC BbpCsr; |
| int i, k; |
| for (i=0; i<MAX_BUSY_COUNT; i++) |
| { |
| RTUSBReadMACRegister(pAd, H2M_BBP_AGENT, &BbpCsr.word); |
| if (BbpCsr.field.Busy == BUSY) |
| { |
| continue; |
| } |
| BbpCsr.word = 0; |
| BbpCsr.field.fRead = 1; |
| BbpCsr.field.BBP_RW_MODE = 1; |
| BbpCsr.field.Busy = 1; |
| BbpCsr.field.RegNum = Id; |
| RTUSBWriteMACRegister(pAd, H2M_BBP_AGENT, BbpCsr.word); |
| AsicSendCommandToMcu(pAd, 0x80, 0xff, 0x0, 0x0); |
| for (k=0; k<MAX_BUSY_COUNT; k++) |
| { |
| RTUSBReadMACRegister(pAd, H2M_BBP_AGENT, &BbpCsr.word); |
| if (BbpCsr.field.Busy == IDLE) |
| break; |
| } |
| if ((BbpCsr.field.Busy == IDLE) && |
| (BbpCsr.field.RegNum == Id)) |
| { |
| *pValue = (UCHAR)BbpCsr.field.Value; |
| break; |
| } |
| } |
| if (BbpCsr.field.Busy == BUSY) |
| { |
| DBGPRINT_ERR(("BBP read R%d=0x%x fail\n", Id, BbpCsr.word)); |
| *pValue = pAd->BbpWriteLatch[Id]; |
| return STATUS_UNSUCCESSFUL; |
| } |
| return STATUS_SUCCESS; |
| } |
| #endif |
| |
| #if 1 |
| /* |
| ======================================================================== |
| |
| Routine Description: Write 8-bit BBP register |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBWriteBBPRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN UCHAR Id, |
| IN UCHAR Value) |
| { |
| BBP_CSR_CFG_STRUC BbpCsr; |
| UINT i = 0; |
| NTSTATUS status; |
| // Verify the busy condition |
| do |
| { |
| status = RTUSBReadMACRegister(pAd, BBP_CSR_CFG, &BbpCsr.word); |
| if (status >= 0) |
| { |
| if (!(BbpCsr.field.Busy == BUSY)) |
| break; |
| } |
| printk("RTUSBWriteBBPRegister(BBP_CSR_CFG):retry count=%d!\n", i); |
| i++; |
| } |
| while ((i < RETRY_LIMIT) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))); |
| |
| if ((i == RETRY_LIMIT) || (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("Retry count exhausted or device removed!!!\n")); |
| return STATUS_UNSUCCESSFUL; |
| } |
| |
| // Prepare for write material |
| BbpCsr.word = 0; |
| BbpCsr.field.fRead = 0; |
| BbpCsr.field.Value = Value; |
| BbpCsr.field.Busy = 1; |
| BbpCsr.field.RegNum = Id; |
| RTUSBWriteMACRegister(pAd, BBP_CSR_CFG, BbpCsr.word); |
| |
| pAd->BbpWriteLatch[Id] = Value; |
| |
| return STATUS_SUCCESS; |
| } |
| #else |
| /* |
| ======================================================================== |
| |
| Routine Description: Write 8-bit BBP register via firmware |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| |
| NTSTATUS RTUSBWriteBBPRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN UCHAR Id, |
| IN UCHAR Value) |
| |
| { |
| BBP_CSR_CFG_STRUC BbpCsr; |
| int BusyCnt; |
| for (BusyCnt=0; BusyCnt<MAX_BUSY_COUNT; BusyCnt++) |
| { |
| RTMP_IO_READ32(pAd, H2M_BBP_AGENT, &BbpCsr.word); |
| if (BbpCsr.field.Busy == BUSY) |
| continue; |
| BbpCsr.word = 0; |
| BbpCsr.field.fRead = 0; |
| BbpCsr.field.BBP_RW_MODE = 1; |
| BbpCsr.field.Busy = 1; |
| BbpCsr.field.Value = Value; |
| BbpCsr.field.RegNum = Id; |
| RTMP_IO_WRITE32(pAd, H2M_BBP_AGENT, BbpCsr.word); |
| AsicSendCommandToMcu(pAd, 0x80, 0xff, 0x0, 0x0); |
| pAd->BbpWriteLatch[Id] = Value; |
| break; |
| } |
| if (BusyCnt == MAX_BUSY_COUNT) |
| { |
| DBGPRINT_ERR(("BBP write R%d=0x%x fail\n", Id, BbpCsr.word)); |
| return STATUS_UNSUCCESSFUL; |
| } |
| return STATUS_SUCCESS; |
| } |
| #endif |
| /* |
| ======================================================================== |
| |
| Routine Description: Write RF register through MAC |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBWriteRFRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN UINT32 Value) |
| { |
| PHY_CSR4_STRUC PhyCsr4; |
| UINT i = 0; |
| NTSTATUS status; |
| |
| NdisZeroMemory(&PhyCsr4, sizeof(PHY_CSR4_STRUC)); |
| do |
| { |
| status = RTUSBReadMACRegister(pAd, RF_CSR_CFG0, &PhyCsr4.word); |
| if (status >= 0) |
| { |
| if (!(PhyCsr4.field.Busy)) |
| break; |
| } |
| printk("RTUSBWriteRFRegister(RF_CSR_CFG0):retry count=%d!\n", i); |
| i++; |
| } |
| while ((i < RETRY_LIMIT) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))); |
| |
| if ((i == RETRY_LIMIT) || (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("Retry count exhausted or device removed!!!\n")); |
| return STATUS_UNSUCCESSFUL; |
| } |
| |
| RTUSBWriteMACRegister(pAd, RF_CSR_CFG0, Value); |
| |
| return STATUS_SUCCESS; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: Write RT3070 RF register through MAC |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RT30xxWriteRFRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN UCHAR RegID, |
| IN UCHAR Value) |
| { |
| RF_CSR_CFG_STRUC rfcsr; |
| UINT i = 0; |
| |
| do |
| { |
| RTUSBReadMACRegister(pAd, RF_CSR_CFG, &rfcsr.word); |
| |
| if (!rfcsr.field.RF_CSR_KICK) |
| break; |
| i++; |
| } |
| while ((i < RETRY_LIMIT) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))); |
| |
| if ((i == RETRY_LIMIT) || (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("Retry count exhausted or device removed!!!\n")); |
| return STATUS_UNSUCCESSFUL; |
| } |
| |
| rfcsr.field.RF_CSR_WR = 1; |
| rfcsr.field.RF_CSR_KICK = 1; |
| rfcsr.field.TESTCSR_RFACC_REGNUM = RegID; |
| rfcsr.field.RF_CSR_DATA = Value; |
| |
| RTUSBWriteMACRegister(pAd, RF_CSR_CFG, rfcsr.word); |
| |
| return STATUS_SUCCESS; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: Read RT3070 RF register through MAC |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RT30xxReadRFRegister( |
| IN PRTMP_ADAPTER pAd, |
| IN UCHAR RegID, |
| IN PUCHAR pValue) |
| { |
| RF_CSR_CFG_STRUC rfcsr; |
| UINT i=0, k; |
| |
| for (i=0; i<MAX_BUSY_COUNT; i++) |
| { |
| RTUSBReadMACRegister(pAd, RF_CSR_CFG, &rfcsr.word); |
| |
| if (rfcsr.field.RF_CSR_KICK == BUSY) |
| { |
| continue; |
| } |
| rfcsr.word = 0; |
| rfcsr.field.RF_CSR_WR = 0; |
| rfcsr.field.RF_CSR_KICK = 1; |
| rfcsr.field.TESTCSR_RFACC_REGNUM = RegID; |
| RTUSBWriteMACRegister(pAd, RF_CSR_CFG, rfcsr.word); |
| for (k=0; k<MAX_BUSY_COUNT; k++) |
| { |
| RTUSBReadMACRegister(pAd, RF_CSR_CFG, &rfcsr.word); |
| |
| if (rfcsr.field.RF_CSR_KICK == IDLE) |
| break; |
| } |
| if ((rfcsr.field.RF_CSR_KICK == IDLE) && |
| (rfcsr.field.TESTCSR_RFACC_REGNUM == RegID)) |
| { |
| *pValue = (UCHAR)rfcsr.field.RF_CSR_DATA; |
| break; |
| } |
| } |
| if (rfcsr.field.RF_CSR_KICK == BUSY) |
| { |
| DBGPRINT_ERR(("RF read R%d=0x%x fail\n", RegID, rfcsr.word)); |
| return STATUS_UNSUCCESSFUL; |
| } |
| |
| return STATUS_SUCCESS; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBReadEEPROM( |
| IN PRTMP_ADAPTER pAd, |
| IN USHORT Offset, |
| OUT PUCHAR pData, |
| IN USHORT length) |
| { |
| NTSTATUS Status = STATUS_SUCCESS; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| (USBD_TRANSFER_DIRECTION_IN | USBD_SHORT_TRANSFER_OK), |
| DEVICE_VENDOR_REQUEST_IN, |
| 0x9, |
| 0, |
| Offset, |
| pData, |
| length); |
| |
| return Status; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBWriteEEPROM( |
| IN PRTMP_ADAPTER pAd, |
| IN USHORT Offset, |
| IN PUCHAR pData, |
| IN USHORT length) |
| { |
| NTSTATUS Status = STATUS_SUCCESS; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| USBD_TRANSFER_DIRECTION_OUT, |
| DEVICE_VENDOR_REQUEST_OUT, |
| 0x8, |
| 0, |
| Offset, |
| pData, |
| length); |
| |
| return Status; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| VOID RTUSBPutToSleep( |
| IN PRTMP_ADAPTER pAd) |
| { |
| UINT32 value; |
| |
| // Timeout 0x40 x 50us |
| value = (SLEEPCID<<16)+(OWNERMCU<<24)+ (0x40<<8)+1; |
| RTUSBWriteMACRegister(pAd, 0x7010, value); |
| RTUSBWriteMACRegister(pAd, 0x404, 0x30); |
| //RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS); |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("Sleep Mailbox testvalue %x\n", value)); |
| |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSBWakeUp( |
| IN PRTMP_ADAPTER pAd) |
| { |
| NTSTATUS Status; |
| |
| Status = RTUSB_VendorRequest( |
| pAd, |
| USBD_TRANSFER_DIRECTION_OUT, |
| DEVICE_VENDOR_REQUEST_OUT, |
| 0x01, |
| 0x09, |
| 0, |
| NULL, |
| 0); |
| |
| return Status; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| VOID RTUSBInitializeCmdQ( |
| IN PCmdQ cmdq) |
| { |
| cmdq->head = NULL; |
| cmdq->tail = NULL; |
| cmdq->size = 0; |
| cmdq->CmdQState = RT2870_THREAD_INITED; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NDIS_STATUS RTUSBEnqueueCmdFromNdis( |
| IN PRTMP_ADAPTER pAd, |
| IN NDIS_OID Oid, |
| IN BOOLEAN SetInformation, |
| IN PVOID pInformationBuffer, |
| IN UINT32 InformationBufferLength) |
| { |
| NDIS_STATUS status; |
| PCmdQElmt cmdqelmt = NULL; |
| POS_COOKIE pObj = (POS_COOKIE) pAd->OS_Cookie; |
| |
| |
| CHECK_PID_LEGALITY(pObj->RTUSBCmdThr_pid) |
| return (NDIS_STATUS_RESOURCES); |
| |
| status = RTMPAllocateMemory((PVOID *)&cmdqelmt, sizeof(CmdQElmt)); |
| if ((status != NDIS_STATUS_SUCCESS) || (cmdqelmt == NULL)) |
| return (NDIS_STATUS_RESOURCES); |
| |
| cmdqelmt->buffer = NULL; |
| if (pInformationBuffer != NULL) |
| { |
| status = RTMPAllocateMemory((PVOID *)&cmdqelmt->buffer, InformationBufferLength); |
| if ((status != NDIS_STATUS_SUCCESS) || (cmdqelmt->buffer == NULL)) |
| { |
| kfree(cmdqelmt); |
| return (NDIS_STATUS_RESOURCES); |
| } |
| else |
| { |
| NdisMoveMemory(cmdqelmt->buffer, pInformationBuffer, InformationBufferLength); |
| cmdqelmt->bufferlength = InformationBufferLength; |
| } |
| } |
| else |
| cmdqelmt->bufferlength = 0; |
| |
| cmdqelmt->command = Oid; |
| cmdqelmt->CmdFromNdis = TRUE; |
| if (SetInformation == TRUE) |
| cmdqelmt->SetOperation = TRUE; |
| else |
| cmdqelmt->SetOperation = FALSE; |
| |
| NdisAcquireSpinLock(&pAd->CmdQLock); |
| if (pAd->CmdQ.CmdQState & RT2870_THREAD_CAN_DO_INSERT) |
| { |
| EnqueueCmd((&pAd->CmdQ), cmdqelmt); |
| status = NDIS_STATUS_SUCCESS; |
| } |
| else |
| { |
| status = NDIS_STATUS_FAILURE; |
| } |
| NdisReleaseSpinLock(&pAd->CmdQLock); |
| |
| if (status == NDIS_STATUS_FAILURE) |
| { |
| if (cmdqelmt->buffer) |
| NdisFreeMemory(cmdqelmt->buffer, cmdqelmt->bufferlength, 0); |
| NdisFreeMemory(cmdqelmt, sizeof(CmdQElmt), 0); |
| } |
| else |
| RTUSBCMDUp(pAd); |
| |
| |
| return(NDIS_STATUS_SUCCESS); |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NDIS_STATUS RTUSBEnqueueInternalCmd( |
| IN PRTMP_ADAPTER pAd, |
| IN NDIS_OID Oid, |
| IN PVOID pInformationBuffer, |
| IN UINT32 InformationBufferLength) |
| { |
| NDIS_STATUS status; |
| PCmdQElmt cmdqelmt = NULL; |
| |
| |
| status = RTMPAllocateMemory((PVOID *)&cmdqelmt, sizeof(CmdQElmt)); |
| if ((status != NDIS_STATUS_SUCCESS) || (cmdqelmt == NULL)) |
| return (NDIS_STATUS_RESOURCES); |
| NdisZeroMemory(cmdqelmt, sizeof(CmdQElmt)); |
| |
| if(InformationBufferLength > 0) |
| { |
| status = RTMPAllocateMemory((PVOID *)&cmdqelmt->buffer, InformationBufferLength); |
| if ((status != NDIS_STATUS_SUCCESS) || (cmdqelmt->buffer == NULL)) |
| { |
| NdisFreeMemory(cmdqelmt, sizeof(CmdQElmt), 0); |
| return (NDIS_STATUS_RESOURCES); |
| } |
| else |
| { |
| NdisMoveMemory(cmdqelmt->buffer, pInformationBuffer, InformationBufferLength); |
| cmdqelmt->bufferlength = InformationBufferLength; |
| } |
| } |
| else |
| { |
| cmdqelmt->buffer = NULL; |
| cmdqelmt->bufferlength = 0; |
| } |
| |
| cmdqelmt->command = Oid; |
| cmdqelmt->CmdFromNdis = FALSE; |
| |
| if (cmdqelmt != NULL) |
| { |
| NdisAcquireSpinLock(&pAd->CmdQLock); |
| if (pAd->CmdQ.CmdQState & RT2870_THREAD_CAN_DO_INSERT) |
| { |
| EnqueueCmd((&pAd->CmdQ), cmdqelmt); |
| status = NDIS_STATUS_SUCCESS; |
| } |
| else |
| { |
| status = NDIS_STATUS_FAILURE; |
| } |
| NdisReleaseSpinLock(&pAd->CmdQLock); |
| |
| if (status == NDIS_STATUS_FAILURE) |
| { |
| if (cmdqelmt->buffer) |
| NdisFreeMemory(cmdqelmt->buffer, cmdqelmt->bufferlength, 0); |
| NdisFreeMemory(cmdqelmt, sizeof(CmdQElmt), 0); |
| } |
| else |
| RTUSBCMDUp(pAd); |
| } |
| return(NDIS_STATUS_SUCCESS); |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| IRQL = |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| VOID RTUSBDequeueCmd( |
| IN PCmdQ cmdq, |
| OUT PCmdQElmt *pcmdqelmt) |
| { |
| *pcmdqelmt = cmdq->head; |
| |
| if (*pcmdqelmt != NULL) |
| { |
| cmdq->head = cmdq->head->next; |
| cmdq->size--; |
| if (cmdq->size == 0) |
| cmdq->tail = NULL; |
| } |
| } |
| |
| /* |
| ======================================================================== |
| usb_control_msg - Builds a control urb, sends it off and waits for completion |
| @dev: pointer to the usb device to send the message to |
| @pipe: endpoint "pipe" to send the message to |
| @request: USB message request value |
| @requesttype: USB message request type value |
| @value: USB message value |
| @index: USB message index value |
| @data: pointer to the data to send |
| @size: length in bytes of the data to send |
| @timeout: time in jiffies to wait for the message to complete before |
| timing out (if 0 the wait is forever) |
| Context: !in_interrupt () |
| |
| This function sends a simple control message to a specified endpoint |
| and waits for the message to complete, or timeout. |
| If successful, it returns the number of bytes transferred, otherwise a negative error number. |
| |
| Don't use this function from within an interrupt context, like a |
| bottom half handler. If you need an asynchronous message, or need to send |
| a message from within interrupt context, use usb_submit_urb() |
| If a thread in your driver uses this call, make sure your disconnect() |
| method can wait for it to complete. Since you don't have a handle on |
| the URB used, you can't cancel the request. |
| |
| |
| Routine Description: |
| |
| Arguments: |
| |
| Return Value: |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSB_VendorRequest( |
| IN PRTMP_ADAPTER pAd, |
| IN UINT32 TransferFlags, |
| IN UCHAR RequestType, |
| IN UCHAR Request, |
| IN USHORT Value, |
| IN USHORT Index, |
| IN PVOID TransferBuffer, |
| IN UINT32 TransferBufferLength) |
| { |
| int ret; |
| POS_COOKIE pObj = (POS_COOKIE) pAd->OS_Cookie; |
| |
| if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("device disconnected\n")); |
| return -1; |
| } |
| else if (in_interrupt()) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("in_interrupt, RTUSB_VendorRequest Request%02x Value%04x Offset%04x\n",Request,Value,Index)); |
| |
| return -1; |
| } |
| else |
| { |
| #define MAX_RETRY_COUNT 10 |
| |
| int retryCount = 0; |
| void *tmpBuf = TransferBuffer; |
| |
| // Acquire Control token |
| #ifdef INF_AMAZON_SE |
| //Semaphore fix INF_AMAZON_SE hang |
| //pAd->UsbVendorReqBuf is the swap for DEVICE_VENDOR_REQUEST_IN to fix dma bug. |
| ret = down_interruptible(&(pAd->UsbVendorReq_semaphore)); |
| if (pAd->UsbVendorReqBuf) |
| { |
| ASSERT(TransferBufferLength <MAX_PARAM_BUFFER_SIZE); |
| |
| tmpBuf = (void *)pAd->UsbVendorReqBuf; |
| NdisZeroMemory(pAd->UsbVendorReqBuf, TransferBufferLength); |
| |
| if (RequestType == DEVICE_VENDOR_REQUEST_OUT) |
| NdisMoveMemory(tmpBuf, TransferBuffer, TransferBufferLength); |
| } |
| #endif // INF_AMAZON_SE // |
| do { |
| if( RequestType == DEVICE_VENDOR_REQUEST_OUT) |
| ret=usb_control_msg(pObj->pUsb_Dev, usb_sndctrlpipe( pObj->pUsb_Dev, 0 ), Request, RequestType, Value,Index, tmpBuf, TransferBufferLength, CONTROL_TIMEOUT_JIFFIES); |
| else if(RequestType == DEVICE_VENDOR_REQUEST_IN) |
| ret=usb_control_msg(pObj->pUsb_Dev, usb_rcvctrlpipe( pObj->pUsb_Dev, 0 ), Request, RequestType, Value,Index, tmpBuf, TransferBufferLength, CONTROL_TIMEOUT_JIFFIES); |
| else |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("vendor request direction is failed\n")); |
| ret = -1; |
| } |
| |
| retryCount++; |
| if (ret < 0) { |
| printk("#\n"); |
| RTMPusecDelay(5000); |
| } |
| } while((ret < 0) && (retryCount < MAX_RETRY_COUNT)); |
| |
| #ifdef INF_AMAZON_SE |
| if ((pAd->UsbVendorReqBuf) && (RequestType == DEVICE_VENDOR_REQUEST_IN)) |
| NdisMoveMemory(TransferBuffer, tmpBuf, TransferBufferLength); |
| up(&(pAd->UsbVendorReq_semaphore)); |
| #endif // INF_AMAZON_SE // |
| |
| if (ret < 0) { |
| // DBGPRINT(RT_DEBUG_ERROR, ("USBVendorRequest failed ret=%d \n",ret)); |
| DBGPRINT(RT_DEBUG_ERROR, ("RTUSB_VendorRequest failed(%d),TxFlags=0x%x, ReqType=%s, Req=0x%x, Index=0x%x\n", |
| ret, TransferFlags, (RequestType == DEVICE_VENDOR_REQUEST_OUT ? "OUT" : "IN"), Request, Index)); |
| if (Request == 0x2) |
| DBGPRINT(RT_DEBUG_ERROR, ("\tRequest Value=0x%04x!\n", Value)); |
| |
| if ((TransferBuffer!= NULL) && (TransferBufferLength > 0)) |
| hex_dump("Failed TransferBuffer value", TransferBuffer, TransferBufferLength); |
| } |
| |
| #if 0 |
| // retry |
| if (ret < 0) { |
| int temp_i=0; |
| DBGPRINT(RT_DEBUG_ERROR, ("USBVendorRequest failed ret=%d, \n",ret)); |
| ret = 0; |
| do |
| { |
| if( RequestType == DEVICE_VENDOR_REQUEST_OUT) |
| ret=usb_control_msg(pObj->pUsb_Dev, usb_sndctrlpipe( pObj->pUsb_Dev, 0 ), Request, RequestType, Value,Index, TransferBuffer, TransferBufferLength, CONTROL_TIMEOUT_JIFFIES); |
| else if(RequestType == DEVICE_VENDOR_REQUEST_IN) |
| ret=usb_control_msg(pObj->pUsb_Dev, usb_rcvctrlpipe( pObj->pUsb_Dev, 0 ), Request, RequestType, Value,Index, TransferBuffer, TransferBufferLength, CONTROL_TIMEOUT_JIFFIES); |
| temp_i++; |
| } while( (ret < 0) && (temp_i <= 1) ); |
| |
| if( ret >= 0) |
| return ret; |
| |
| } |
| #endif |
| |
| } |
| return ret; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| Creates an IRP to submite an IOCTL_INTERNAL_USB_RESET_PORT |
| synchronously. Callers of this function must be running at |
| PASSIVE LEVEL. |
| |
| Arguments: |
| |
| Return Value: |
| |
| Note: |
| |
| ======================================================================== |
| */ |
| NTSTATUS RTUSB_ResetDevice( |
| IN PRTMP_ADAPTER pAd) |
| { |
| NTSTATUS Status = TRUE; |
| |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("--->USB_ResetDevice\n")); |
| //RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_RESET_IN_PROGRESS); |
| return Status; |
| } |
| |
| VOID CMDHandler( |
| IN PRTMP_ADAPTER pAd) |
| { |
| PCmdQElmt cmdqelmt; |
| PUCHAR pData; |
| NDIS_STATUS NdisStatus = NDIS_STATUS_SUCCESS; |
| // ULONG Now = 0; |
| NTSTATUS ntStatus; |
| // unsigned long IrqFlags; |
| |
| while (pAd->CmdQ.size > 0) |
| { |
| NdisStatus = NDIS_STATUS_SUCCESS; |
| |
| NdisAcquireSpinLock(&pAd->CmdQLock); |
| RTUSBDequeueCmd(&pAd->CmdQ, &cmdqelmt); |
| NdisReleaseSpinLock(&pAd->CmdQLock); |
| |
| if (cmdqelmt == NULL) |
| break; |
| |
| pData = cmdqelmt->buffer; |
| |
| if(!(RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST) || RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS))) |
| { |
| switch (cmdqelmt->command) |
| { |
| case CMDTHREAD_CHECK_GPIO: |
| { |
| #ifdef CONFIG_STA_SUPPORT |
| UINT32 data; |
| #endif // CONFIG_STA_SUPPORT // |
| #ifdef RALINK_ATE |
| if(ATE_ON(pAd)) |
| { |
| DBGPRINT(RT_DEBUG_TRACE, ("The driver is in ATE mode now\n")); |
| break; |
| } |
| #endif // RALINK_ATE // |
| |
| #ifdef CONFIG_STA_SUPPORT |
| |
| |
| IF_DEV_CONFIG_OPMODE_ON_STA(pAd) |
| { |
| // Read GPIO pin2 as Hardware controlled radio state |
| |
| RTUSBReadMACRegister( pAd, GPIO_CTRL_CFG, &data); |
| |
| if (data & 0x04) |
| { |
| pAd->StaCfg.bHwRadio = TRUE; |
| } |
| else |
| { |
| pAd->StaCfg.bHwRadio = FALSE; |
| } |
| |
| if(pAd->StaCfg.bRadio != (pAd->StaCfg.bHwRadio && pAd->StaCfg.bSwRadio)) |
| { |
| pAd->StaCfg.bRadio = (pAd->StaCfg.bHwRadio && pAd->StaCfg.bSwRadio); |
| if(pAd->StaCfg.bRadio == TRUE) |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("!!! Radio On !!!\n")); |
| |
| MlmeRadioOn(pAd); |
| // Update extra information |
| pAd->ExtraInfo = EXTRA_INFO_CLEAR; |
| } |
| else |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("!!! Radio Off !!!\n")); |
| |
| MlmeRadioOff(pAd); |
| // Update extra information |
| pAd->ExtraInfo = HW_RADIO_OFF; |
| } |
| } |
| } |
| #endif // CONFIG_STA_SUPPORT // |
| } |
| break; |
| |
| #ifdef CONFIG_STA_SUPPORT |
| case CMDTHREAD_QKERIODIC_EXECUT: |
| { |
| StaQuickResponeForRateUpExec(NULL, pAd, NULL, NULL); |
| } |
| break; |
| #endif // CONFIG_STA_SUPPORT // |
| |
| case CMDTHREAD_RESET_BULK_OUT: |
| { |
| UINT32 MACValue; |
| UCHAR Index; |
| int ret=0; |
| PHT_TX_CONTEXT pHTTXContext; |
| // RTMP_TX_RING *pTxRing; |
| unsigned long IrqFlags; |
| #ifdef RALINK_ATE |
| PTX_CONTEXT pNullContext = &(pAd->NullContext); |
| #endif // RALINK_ATE // |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("CmdThread : CMDTHREAD_RESET_BULK_OUT(ResetPipeid=0x%0x)===>\n", pAd->bulkResetPipeid)); |
| // All transfers must be aborted or cancelled before attempting to reset the pipe. |
| //RTUSBCancelPendingBulkOutIRP(pAd); |
| // Wait 10ms to let previous packet that are already in HW FIFO to clear. by MAXLEE 12-25-2007 |
| Index = 0; |
| do |
| { |
| RTUSBReadMACRegister(pAd, TXRXQ_PCNT, &MACValue); |
| if ((MACValue & 0xf00000/*0x800000*/) == 0) |
| break; |
| Index++; |
| RTMPusecDelay(10000); |
| }while(Index < 100); |
| MACValue = 0; |
| RTUSBReadMACRegister(pAd, USB_DMA_CFG, &MACValue); |
| // To prevent Read Register error, we 2nd check the validity. |
| if ((MACValue & 0xc00000) == 0) |
| RTUSBReadMACRegister(pAd, USB_DMA_CFG, &MACValue); |
| // To prevent Read Register error, we 3rd check the validity. |
| if ((MACValue & 0xc00000) == 0) |
| RTUSBReadMACRegister(pAd, USB_DMA_CFG, &MACValue); |
| MACValue |= 0x80000; |
| RTUSBWriteMACRegister(pAd, USB_DMA_CFG, MACValue); |
| |
| // Wait 1ms to prevent next URB to bulkout before HW reset. by MAXLEE 12-25-2007 |
| RTMPusecDelay(1000); |
| |
| MACValue &= (~0x80000); |
| RTUSBWriteMACRegister(pAd, USB_DMA_CFG, MACValue); |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("\tSet 0x2a0 bit19. Clear USB DMA TX path\n")); |
| |
| // Wait 5ms to prevent next URB to bulkout before HW reset. by MAXLEE 12-25-2007 |
| //RTMPusecDelay(5000); |
| |
| if ((pAd->bulkResetPipeid & BULKOUT_MGMT_RESET_FLAG) == BULKOUT_MGMT_RESET_FLAG) |
| { |
| RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET); |
| if (pAd->MgmtRing.TxSwFreeIdx < MGMT_RING_SIZE /* pMLMEContext->bWaitingBulkOut == TRUE */) |
| { |
| RTUSB_SET_BULK_FLAG(pAd, fRTUSB_BULK_OUT_MLME); |
| } |
| RTUSBKickBulkOut(pAd); |
| |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("\tTX MGMT RECOVER Done!\n")); |
| } |
| else |
| { |
| pHTTXContext = &(pAd->TxContext[pAd->bulkResetPipeid]); |
| //NdisAcquireSpinLock(&pAd->BulkOutLock[pAd->bulkResetPipeid]); |
| RTMP_INT_LOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| if ( pAd->BulkOutPending[pAd->bulkResetPipeid] == FALSE) |
| { |
| pAd->BulkOutPending[pAd->bulkResetPipeid] = TRUE; |
| pHTTXContext->IRPPending = TRUE; |
| pAd->watchDogTxPendingCnt[pAd->bulkResetPipeid] = 1; |
| |
| // no matter what, clean the flag |
| RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET); |
| |
| //NdisReleaseSpinLock(&pAd->BulkOutLock[pAd->bulkResetPipeid]); |
| RTMP_INT_UNLOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| /*-----------------------------------------------------------------------------------------------*/ |
| #ifdef RALINK_ATE |
| if(ATE_ON(pAd)) |
| { |
| pNullContext->IRPPending = TRUE; |
| // |
| // If driver is still in ATE TXFRAME mode, |
| // keep on transmitting ATE frames. |
| // |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("pAd->ate.Mode == %d\npAd->ContinBulkOut == %d\npAd->BulkOutRemained == %d\n", pAd->ate.Mode, pAd->ContinBulkOut, atomic_read(&pAd->BulkOutRemained))); |
| if((pAd->ate.Mode == ATE_TXFRAME) && ((pAd->ContinBulkOut == TRUE) || (atomic_read(&pAd->BulkOutRemained) > 0))) |
| { |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("After CMDTHREAD_RESET_BULK_OUT, continue to bulk out frames !\n")); |
| |
| // Init Tx context descriptor |
| RTUSBInitTxDesc(pAd, pNullContext, 0/* pAd->bulkResetPipeid */, (usb_complete_t)ATE_RTUSBBulkOutDataPacketComplete); |
| |
| if((ret = RTUSB_SUBMIT_URB(pNullContext->pUrb))!=0) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("ATE_RTUSBBulkOutDataPacket: Submit Tx URB failed %d\n", ret)); |
| } |
| |
| pAd->BulkOutReq++; |
| } |
| } |
| else |
| #endif // RALINK_ATE // |
| /*-----------------------------------------------------------------------------------------------*/ |
| { |
| RTUSBInitHTTxDesc(pAd, pHTTXContext, pAd->bulkResetPipeid, pHTTXContext->BulkOutSize, (usb_complete_t)RTUSBBulkOutDataPacketComplete); |
| |
| if((ret = RTUSB_SUBMIT_URB(pHTTXContext->pUrb))!=0) |
| { |
| RTMP_INT_LOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| pAd->BulkOutPending[pAd->bulkResetPipeid] = FALSE; |
| pHTTXContext->IRPPending = FALSE; |
| pAd->watchDogTxPendingCnt[pAd->bulkResetPipeid] = 0; |
| RTMP_INT_UNLOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| |
| DBGPRINT(RT_DEBUG_ERROR, ("CmdThread : CMDTHREAD_RESET_BULK_OUT: Submit Tx URB failed %d\n", ret)); |
| } |
| else |
| { |
| RTMP_IRQ_LOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| DBGPRINT_RAW(RT_DEBUG_TRACE,("\tCMDTHREAD_RESET_BULK_OUT: TxContext[%d]:CWPos=%ld, NBPos=%ld, ENBPos=%ld, bCopy=%d, pending=%d!\n", |
| pAd->bulkResetPipeid, pHTTXContext->CurWritePosition, pHTTXContext->NextBulkOutPosition, |
| pHTTXContext->ENextBulkOutPosition, pHTTXContext->bCopySavePad, pAd->BulkOutPending[pAd->bulkResetPipeid])); |
| DBGPRINT_RAW(RT_DEBUG_TRACE,("\t\tBulkOut Req=0x%lx, Complete=0x%lx, Other=0x%lx\n", |
| pAd->BulkOutReq, pAd->BulkOutComplete, pAd->BulkOutCompleteOther)); |
| RTMP_IRQ_UNLOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("\tCMDTHREAD_RESET_BULK_OUT: Submit Tx DATA URB for failed BulkReq(0x%lx) Done, status=%d!\n", pAd->bulkResetReq[pAd->bulkResetPipeid], pHTTXContext->pUrb->status)); |
| |
| } |
| } |
| } |
| else |
| { |
| //NdisReleaseSpinLock(&pAd->BulkOutLock[pAd->bulkResetPipeid]); |
| //RTMP_INT_UNLOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("CmdThread : TX DATA RECOVER FAIL for BulkReq(0x%lx) because BulkOutPending[%d] is TRUE!\n", pAd->bulkResetReq[pAd->bulkResetPipeid], pAd->bulkResetPipeid)); |
| if (pAd->bulkResetPipeid == 0) |
| { |
| UCHAR pendingContext = 0; |
| PHT_TX_CONTEXT pHTTXContext = (PHT_TX_CONTEXT)(&pAd->TxContext[pAd->bulkResetPipeid ]); |
| PTX_CONTEXT pMLMEContext = (PTX_CONTEXT)(pAd->MgmtRing.Cell[pAd->MgmtRing.TxDmaIdx].AllocVa); |
| PTX_CONTEXT pNULLContext = (PTX_CONTEXT)(&pAd->PsPollContext); |
| PTX_CONTEXT pPsPollContext = (PTX_CONTEXT)(&pAd->NullContext); |
| |
| if (pHTTXContext->IRPPending) |
| pendingContext |= 1; |
| else if (pMLMEContext->IRPPending) |
| pendingContext |= 2; |
| else if (pNULLContext->IRPPending) |
| pendingContext |= 4; |
| else if (pPsPollContext->IRPPending) |
| pendingContext |= 8; |
| else |
| pendingContext = 0; |
| |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("\tTX Occupied by %d!\n", pendingContext)); |
| } |
| |
| // no matter what, clean the flag |
| RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_BULKOUT_RESET); |
| |
| RTMP_INT_UNLOCK(&pAd->BulkOutLock[pAd->bulkResetPipeid], IrqFlags); |
| |
| RTUSB_SET_BULK_FLAG(pAd, (fRTUSB_BULK_OUT_DATA_NORMAL << pAd->bulkResetPipeid)); |
| } |
| |
| RTMPDeQueuePacket(pAd, FALSE, NUM_OF_TX_RING, MAX_TX_PROCESS); |
| //RTUSBKickBulkOut(pAd); |
| } |
| |
| } |
| /* |
| // Don't cancel BULKIN. |
| while ((atomic_read(&pAd->PendingRx) > 0) && |
| (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| if (atomic_read(&pAd->PendingRx) > 0) |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("BulkIn IRP Pending!!cancel it!\n")); |
| RTUSBCancelPendingBulkInIRP(pAd); |
| } |
| RTMPusecDelay(100000); |
| } |
| |
| if ((atomic_read(&pAd->PendingRx) == 0) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_HALT_IN_PROGRESS))) |
| { |
| UCHAR i; |
| RTUSBRxPacket(pAd); |
| pAd->NextRxBulkInReadIndex = 0; // Next Rx Read index |
| pAd->NextRxBulkInIndex = 0; // Rx Bulk pointer |
| for (i = 0; i < (RX_RING_SIZE); i++) |
| { |
| PRX_CONTEXT pRxContext = &(pAd->RxContext[i]); |
| |
| pRxContext->pAd = pAd; |
| pRxContext->InUse = FALSE; |
| pRxContext->IRPPending = FALSE; |
| pRxContext->Readable = FALSE; |
| pRxContext->ReorderInUse = FALSE; |
| |
| } |
| RTUSBBulkReceive(pAd); |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("RTUSBBulkReceive\n")); |
| }*/ |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("CmdThread : CMDTHREAD_RESET_BULK_OUT<===\n")); |
| break; |
| |
| case CMDTHREAD_RESET_BULK_IN: |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("CmdThread : CMDTHREAD_RESET_BULK_IN === >\n")); |
| |
| // All transfers must be aborted or cancelled before attempting to reset the pipe. |
| { |
| UINT32 MACValue; |
| /*-----------------------------------------------------------------------------------------------*/ |
| #ifdef RALINK_ATE |
| if (ATE_ON(pAd)) |
| { |
| if((pAd->PendingRx > 0) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("ATE : BulkIn IRP Pending!!!\n")); |
| ATE_RTUSBCancelPendingBulkInIRP(pAd); |
| RTMPusecDelay(100000); |
| pAd->PendingRx = 0; |
| } |
| } |
| else |
| #endif // RALINK_ATE // |
| /*-----------------------------------------------------------------------------------------------*/ |
| { |
| //while ((atomic_read(&pAd->PendingRx) > 0) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| if((pAd->PendingRx > 0) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("BulkIn IRP Pending!!!\n")); |
| RTUSBCancelPendingBulkInIRP(pAd); |
| RTMPusecDelay(100000); |
| pAd->PendingRx = 0; |
| } |
| } |
| |
| // Wait 10ms before reading register. |
| RTMPusecDelay(10000); |
| ntStatus = RTUSBReadMACRegister(pAd, MAC_CSR0, &MACValue); |
| |
| if ((NT_SUCCESS(ntStatus) == TRUE) && |
| (!(RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS | fRTMP_ADAPTER_RADIO_OFF | |
| fRTMP_ADAPTER_HALT_IN_PROGRESS | fRTMP_ADAPTER_NIC_NOT_EXIST))))) |
| { |
| UCHAR i; |
| |
| if (RTMP_TEST_FLAG(pAd, (fRTMP_ADAPTER_RESET_IN_PROGRESS | fRTMP_ADAPTER_RADIO_OFF | |
| fRTMP_ADAPTER_HALT_IN_PROGRESS | fRTMP_ADAPTER_NIC_NOT_EXIST))) |
| break; |
| pAd->NextRxBulkInPosition = pAd->RxContext[pAd->NextRxBulkInIndex].BulkInOffset; |
| DBGPRINT(RT_DEBUG_TRACE, ("BULK_IN_RESET: NBIIdx=0x%x,NBIRIdx=0x%x, BIRPos=0x%lx. BIReq=x%lx, BIComplete=0x%lx, BICFail0x%lx\n", |
| pAd->NextRxBulkInIndex, pAd->NextRxBulkInReadIndex, pAd->NextRxBulkInPosition, pAd->BulkInReq, pAd->BulkInComplete, pAd->BulkInCompleteFail)); |
| for (i = 0; i < RX_RING_SIZE; i++) |
| { |
| DBGPRINT(RT_DEBUG_TRACE, ("\tRxContext[%d]: IRPPending=%d, InUse=%d, Readable=%d!\n" |
| , i, pAd->RxContext[i].IRPPending, pAd->RxContext[i].InUse, pAd->RxContext[i].Readable)); |
| } |
| /* |
| |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("==========================================\n")); |
| |
| pAd->NextRxBulkInReadIndex = 0; // Next Rx Read index |
| pAd->NextRxBulkInIndex = 0; // Rx Bulk pointer |
| for (i = 0; i < (RX_RING_SIZE); i++) |
| { |
| PRX_CONTEXT pRxContext = &(pAd->RxContext[i]); |
| |
| pRxContext->pAd = pAd; |
| pRxContext->InUse = FALSE; |
| pRxContext->IRPPending = FALSE; |
| pRxContext->Readable = FALSE; |
| pRxContext->ReorderInUse = FALSE; |
| |
| }*/ |
| RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_BULKIN_RESET); |
| for (i = 0; i < pAd->CommonCfg.NumOfBulkInIRP; i++) |
| { |
| //RTUSBBulkReceive(pAd); |
| PRX_CONTEXT pRxContext; |
| PURB pUrb; |
| int ret = 0; |
| unsigned long IrqFlags; |
| |
| |
| RTMP_IRQ_LOCK(&pAd->BulkInLock, IrqFlags); |
| pRxContext = &(pAd->RxContext[pAd->NextRxBulkInIndex]); |
| if ((pAd->PendingRx > 0) || (pRxContext->Readable == TRUE) || (pRxContext->InUse == TRUE)) |
| { |
| RTMP_IRQ_UNLOCK(&pAd->BulkInLock, IrqFlags); |
| break; |
| } |
| pRxContext->InUse = TRUE; |
| pRxContext->IRPPending = TRUE; |
| pAd->PendingRx++; |
| pAd->BulkInReq++; |
| RTMP_IRQ_UNLOCK(&pAd->BulkInLock, IrqFlags); |
| |
| // Init Rx context descriptor |
| RTUSBInitRxDesc(pAd, pRxContext); |
| pUrb = pRxContext->pUrb; |
| if ((ret = RTUSB_SUBMIT_URB(pUrb))!=0) |
| { // fail |
| |
| RTMP_IRQ_LOCK(&pAd->BulkInLock, IrqFlags); |
| pRxContext->InUse = FALSE; |
| pRxContext->IRPPending = FALSE; |
| pAd->PendingRx--; |
| pAd->BulkInReq--; |
| RTMP_IRQ_UNLOCK(&pAd->BulkInLock, IrqFlags); |
| DBGPRINT(RT_DEBUG_ERROR, ("CMDTHREAD_RESET_BULK_IN: Submit Rx URB failed(%d), status=%d\n", ret, pUrb->status)); |
| } |
| else |
| { // success |
| #if 0 |
| RTMP_IRQ_LOCK(&pAd->BulkInLock, IrqFlags); |
| pRxContext->IRPPending = TRUE; |
| //NdisInterlockedIncrement(&pAd->PendingRx); |
| pAd->PendingRx++; |
| RTMP_IRQ_UNLOCK(&pAd->BulkInLock, IrqFlags); |
| pAd->BulkInReq++; |
| #endif |
| //printk("BIDone, Pend=%d,BIIdx=%d,BIRIdx=%d!\n", pAd->PendingRx, pAd->NextRxBulkInIndex, pAd->NextRxBulkInReadIndex); |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("CMDTHREAD_RESET_BULK_IN: Submit Rx URB Done, status=%d!\n", pUrb->status)); |
| ASSERT((pRxContext->InUse == pRxContext->IRPPending)); |
| } |
| } |
| |
| } |
| else |
| { |
| // Card must be removed |
| if (NT_SUCCESS(ntStatus) != TRUE) |
| { |
| RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST); |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("CMDTHREAD_RESET_BULK_IN: Read Register Failed!Card must be removed!!\n\n")); |
| } |
| else |
| { |
| DBGPRINT_RAW(RT_DEBUG_ERROR, ("CMDTHREAD_RESET_BULK_IN: Cannot do bulk in because flags(0x%lx) on !\n", pAd->Flags)); |
| } |
| } |
| } |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("CmdThread : CMDTHREAD_RESET_BULK_IN <===\n")); |
| break; |
| |
| case CMDTHREAD_SET_ASIC_WCID: |
| { |
| RT_SET_ASIC_WCID SetAsicWcid; |
| USHORT offset; |
| UINT32 MACValue, MACRValue = 0; |
| SetAsicWcid = *((PRT_SET_ASIC_WCID)(pData)); |
| |
| if (SetAsicWcid.WCID >= MAX_LEN_OF_MAC_TABLE) |
| return; |
| |
| offset = MAC_WCID_BASE + ((UCHAR)SetAsicWcid.WCID)*HW_WCID_ENTRY_SIZE; |
| |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("CmdThread : CMDTHREAD_SET_ASIC_WCID : WCID = %ld, SetTid = %lx, DeleteTid = %lx.\n", SetAsicWcid.WCID, SetAsicWcid.SetTid, SetAsicWcid.DeleteTid)); |
| MACValue = (pAd->MacTab.Content[SetAsicWcid.WCID].Addr[3]<<24)+(pAd->MacTab.Content[SetAsicWcid.WCID].Addr[2]<<16)+(pAd->MacTab.Content[SetAsicWcid.WCID].Addr[1]<<8)+(pAd->MacTab.Content[SetAsicWcid.WCID].Addr[0]); |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("1-MACValue= %x,\n", MACValue)); |
| RTUSBWriteMACRegister(pAd, offset, MACValue); |
| // Read bitmask |
| RTUSBReadMACRegister(pAd, offset+4, &MACRValue); |
| if ( SetAsicWcid.DeleteTid != 0xffffffff) |
| MACRValue &= (~SetAsicWcid.DeleteTid); |
| if (SetAsicWcid.SetTid != 0xffffffff) |
| MACRValue |= (SetAsicWcid.SetTid); |
| MACRValue &= 0xffff0000; |
| |
| MACValue = (pAd->MacTab.Content[SetAsicWcid.WCID].Addr[5]<<8)+pAd->MacTab.Content[SetAsicWcid.WCID].Addr[4]; |
| MACValue |= MACRValue; |
| RTUSBWriteMACRegister(pAd, offset+4, MACValue); |
| |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("2-MACValue= %x,\n", MACValue)); |
| } |
| break; |
| |
| case CMDTHREAD_SET_ASIC_WCID_CIPHER: |
| { |
| #ifdef CONFIG_STA_SUPPORT |
| RT_SET_ASIC_WCID_ATTRI SetAsicWcidAttri; |
| USHORT offset; |
| UINT32 MACRValue = 0; |
| SHAREDKEY_MODE_STRUC csr1; |
| SetAsicWcidAttri = *((PRT_SET_ASIC_WCID_ATTRI)(pData)); |
| |
| if (SetAsicWcidAttri.WCID >= MAX_LEN_OF_MAC_TABLE) |
| return; |
| |
| offset = MAC_WCID_ATTRIBUTE_BASE + ((UCHAR)SetAsicWcidAttri.WCID)*HW_WCID_ATTRI_SIZE; |
| |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("Cmd : CMDTHREAD_SET_ASIC_WCID_CIPHER : WCID = %ld, Cipher = %lx.\n", SetAsicWcidAttri.WCID, SetAsicWcidAttri.Cipher)); |
| // Read bitmask |
| RTUSBReadMACRegister(pAd, offset, &MACRValue); |
| MACRValue = 0; |
| MACRValue |= (((UCHAR)SetAsicWcidAttri.Cipher) << 1); |
| |
| RTUSBWriteMACRegister(pAd, offset, MACRValue); |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("2-offset = %x , MACValue= %x,\n", offset, MACRValue)); |
| |
| offset = PAIRWISE_IVEIV_TABLE_BASE + ((UCHAR)SetAsicWcidAttri.WCID)*HW_IVEIV_ENTRY_SIZE; |
| MACRValue = 0; |
| if ( (SetAsicWcidAttri.Cipher <= CIPHER_WEP128)) |
| MACRValue |= ( pAd->StaCfg.DefaultKeyId << 30); |
| else |
| MACRValue |= (0x20000000); |
| RTUSBWriteMACRegister(pAd, offset, MACRValue); |
| DBGPRINT_RAW(RT_DEBUG_TRACE, ("2-offset = %x , MACValue= %x,\n", offset, MACRValue)); |
| |
| // |
| // Update cipher algorithm. WSTA always use BSS0 |
| // |
| // for adhoc mode only ,because wep status slow than add key, when use zero config |
| if (pAd->StaCfg.BssType == BSS_ADHOC ) |
| { |
| offset = MAC_WCID_ATTRIBUTE_BASE; |
| |
| RTUSBReadMACRegister(pAd, offset, &MACRValue); |
| MACRValue &= (~0xe); |
| MACRValue |= (((UCHAR)SetAsicWcidAttri.Cipher) << 1); |
| |
| RTUSBWriteMACRegister(pAd, offset, MACRValue); |
| |
| //Update group key cipher,,because wep status slow than add key, when use zero config |
| RTUSBReadMACRegister(pAd, SHARED_KEY_MODE_BASE+4*(0/2), &csr1.word); |
| |
| csr1.field.Bss0Key0CipherAlg = SetAsicWcidAttri.Cipher; |
| csr1.field.Bss0Key1CipherAlg = SetAsicWcidAttri.Cipher; |
| |
| RTUSBWriteMACRegister(pAd, SHARED_KEY_MODE_BASE+4*(0/2), csr1.word); |
| } |
| #endif // CONFIG_STA_SUPPORT // |
| } |
| break; |
| |
| #ifdef CONFIG_STA_SUPPORT |
| #ifdef QOS_DLS_SUPPORT |
| // avoid in interrupt when write key |
| case RT_CMD_SET_KEY_TABLE: //General call for AsicAddPairwiseKeyEntry() |
| { |
| RT_ADD_PAIRWISE_KEY_ENTRY KeyInfo; |
| KeyInfo = *((PRT_ADD_PAIRWISE_KEY_ENTRY)(pData)); |
| AsicAddPairwiseKeyEntry(pAd, |
| KeyInfo.MacAddr, |
| (UCHAR)KeyInfo.MacTabMatchWCID, |
| &KeyInfo.CipherKey); |
| } |
| break; |
| |
| case RT_CMD_SET_RX_WCID_TABLE: //General call for RTMPAddWcidAttributeEntry() |
| { |
| PMAC_TABLE_ENTRY pEntry ; |
| pEntry = (PMAC_TABLE_ENTRY)(pData); |
| RTMPAddWcidAttributeEntry(pAd, |
| BSS0, |
| 0, |
| pEntry->PairwiseKey.CipherAlg, |
| pEntry); |
| } |
| break; |
| #endif // QOS_DLS_SUPPORT // |
| #endif // CONFIG_STA_SUPPORT // |
| |
| case CMDTHREAD_SET_CLIENT_MAC_ENTRY: |
| { |
| MAC_TABLE_ENTRY *pEntry; |
| pEntry = (MAC_TABLE_ENTRY *)pData; |
| |
| |
| #ifdef CONFIG_STA_SUPPORT |
| IF_DEV_CONFIG_OPMODE_ON_STA(pAd) |
| { |
| AsicRemovePairwiseKeyEntry(pAd, pEntry->apidx, (UCHAR)pEntry->Aid); |
| if ((pEntry->AuthMode <= Ndis802_11AuthModeAutoSwitch) && (pEntry->WepStatus == Ndis802_11Encryption1Enabled)) |
| { |
| UINT32 uIV = 0; |
| PUCHAR ptr; |
| |
| ptr = (PUCHAR) &uIV; |
| *(ptr + 3) = (pAd->StaCfg.DefaultKeyId << 6); |
| AsicUpdateWCIDIVEIV(pAd, pEntry->Aid, uIV, 0); |
| AsicUpdateWCIDAttribute(pAd, pEntry->Aid, BSS0, pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].CipherAlg, FALSE); |
| } |
| else if (pEntry->AuthMode == Ndis802_11AuthModeWPANone) |
| { |
| UINT32 uIV = 0; |
| PUCHAR ptr; |
| |
| ptr = (PUCHAR) &uIV; |
| *(ptr + 3) = (pAd->StaCfg.DefaultKeyId << 6); |
| AsicUpdateWCIDIVEIV(pAd, pEntry->Aid, uIV, 0); |
| AsicUpdateWCIDAttribute(pAd, pEntry->Aid, BSS0, pAd->SharedKey[BSS0][pAd->StaCfg.DefaultKeyId].CipherAlg, FALSE); |
| } |
| else |
| { |
| // |
| // Other case, disable engine. |
| // Don't worry WPA key, we will add WPA Key after 4-Way handshaking. |
| // |
| USHORT offset; |
| offset = MAC_WCID_ATTRIBUTE_BASE + (pEntry->Aid * HW_WCID_ATTRI_SIZE); |
| // RX_PKEY_MODE:0 for no security; RX_KEY_TAB:0 for shared key table; BSS_IDX:0 |
| RTUSBWriteMACRegister(pAd, offset, 0); |
| } |
| } |
| #endif // CONFIG_STA_SUPPORT // |
| |
| AsicUpdateRxWCIDTable(pAd, pEntry->Aid, pEntry->Addr); |
| printk("UpdateRxWCIDTable(): Aid=%d, Addr=%02x:%02x:%02x:%02x:%02x:%02x!\n", pEntry->Aid, |
| pEntry->Addr[0], pEntry->Addr[1], pEntry->Addr[2], pEntry->Addr[3], pEntry->Addr[4], pEntry->Addr[5]); |
| } |
| break; |
| |
| case OID_802_11_ADD_WEP: |
| { |
| #ifdef CONFIG_STA_SUPPORT |
| UINT i; |
| UINT32 KeyIdx; |
| PNDIS_802_11_WEP pWepKey; |
| |
| DBGPRINT(RT_DEBUG_TRACE, ("CmdThread::OID_802_11_ADD_WEP \n")); |
| |
| pWepKey = (PNDIS_802_11_WEP)pData; |
| KeyIdx = pWepKey->KeyIndex & 0x0fffffff; |
| |
| // it is a shared key |
| if ((KeyIdx >= 4) || ((pWepKey->KeyLength != 5) && (pWepKey->KeyLength != 13))) |
| { |
| NdisStatus = NDIS_STATUS_INVALID_DATA; |
| DBGPRINT(RT_DEBUG_ERROR, ("CmdThread::OID_802_11_ADD_WEP, INVALID_DATA!!\n")); |
| } |
| else |
| { |
| UCHAR CipherAlg; |
| pAd->SharedKey[BSS0][KeyIdx].KeyLen = (UCHAR) pWepKey->KeyLength; |
| NdisMoveMemory(pAd->SharedKey[BSS0][KeyIdx].Key, &pWepKey->KeyMaterial, pWepKey->KeyLength); |
| CipherAlg = (pAd->SharedKey[BSS0][KeyIdx].KeyLen == 5)? CIPHER_WEP64 : CIPHER_WEP128; |
| |
| // |
| // Change the WEP cipher to CKIP cipher if CKIP KP on. |
| // Funk UI or Meetinghouse UI will add ckip key from this path. |
| // |
| |
| if (pAd->OpMode == OPMODE_STA) |
| { |
| pAd->MacTab.Content[BSSID_WCID].PairwiseKey.CipherAlg = pAd->SharedKey[BSS0][KeyIdx].CipherAlg; |
| pAd->MacTab.Content[BSSID_WCID].PairwiseKey.KeyLen = pAd->SharedKey[BSS0][KeyIdx].KeyLen; |
| } |
| pAd->SharedKey[BSS0][KeyIdx].CipherAlg = CipherAlg; |
| if (pWepKey->KeyIndex & 0x80000000) |
| { |
| // Default key for tx (shared key) |
| UCHAR IVEIV[8]; |
| UINT32 WCIDAttri, Value; |
| USHORT offset, offset2; |
| NdisZeroMemory(IVEIV, 8); |
| pAd->StaCfg.DefaultKeyId = (UCHAR) KeyIdx; |
| // Add BSSID to WCTable. because this is Tx wep key. |
| // WCID Attribute UDF:3, BSSIdx:3, Alg:3, Keytable:1=PAIRWISE KEY, BSSIdx is 0 |
| WCIDAttri = (CipherAlg<<1)|SHAREDKEYTABLE; |
| |
| offset = MAC_WCID_ATTRIBUTE_BASE + (BSSID_WCID* HW_WCID_ATTRI_SIZE); |
| RTUSBWriteMACRegister(pAd, offset, WCIDAttri); |
| // 1. IV/EIV |
| // Specify key index to find shared key. |
| IVEIV[3] = (UCHAR)(KeyIdx<< 6); //WEP Eiv bit off. groupkey index is not 0 |
| offset = PAIRWISE_IVEIV_TABLE_BASE + (BSS0Mcast_WCID * HW_IVEIV_ENTRY_SIZE); |
| offset2 = PAIRWISE_IVEIV_TABLE_BASE + (BSSID_WCID* HW_IVEIV_ENTRY_SIZE); |
| for (i=0; i<8;) |
| { |
| Value = IVEIV[i]; |
| Value += (IVEIV[i+1]<<8); |
| Value += (IVEIV[i+2]<<16); |
| Value += (IVEIV[i+3]<<24); |
| RTUSBWriteMACRegister(pAd, offset+i, Value); |
| RTUSBWriteMACRegister(pAd, offset2+i, Value); |
| i+=4; |
| } |
| |
| // 2. WCID Attribute UDF:3, BSSIdx:3, Alg:3, Keytable:use share key, BSSIdx is 0 |
| WCIDAttri = (pAd->SharedKey[BSS0][KeyIdx].CipherAlg<<1)|SHAREDKEYTABLE; |
| offset = MAC_WCID_ATTRIBUTE_BASE + (BSS0Mcast_WCID* HW_WCID_ATTRI_SIZE); |
| DBGPRINT(RT_DEBUG_TRACE, ("BSS0Mcast_WCID : offset = %x, WCIDAttri = %x\n", offset, WCIDAttri)); |
| RTUSBWriteMACRegister(pAd, offset, WCIDAttri); |
| |
| } |
| AsicAddSharedKeyEntry(pAd, BSS0, (UCHAR)KeyIdx, CipherAlg, pWepKey->KeyMaterial, NULL, NULL); |
| DBGPRINT(RT_DEBUG_TRACE, ("CmdThread::OID_802_11_ADD_WEP (KeyIdx=%d, Len=%d-byte)\n", KeyIdx, pWepKey->KeyLength)); |
| } |
| #endif // CONFIG_STA_SUPPORT // |
| } |
| break; |
| |
| case CMDTHREAD_802_11_COUNTER_MEASURE: |
| break; |
| default: |
| DBGPRINT(RT_DEBUG_ERROR, ("--> Control Thread !! ERROR !! Unknown(cmdqelmt->command=0x%x) !! \n", cmdqelmt->command)); |
| break; |
| } |
| } |
| |
| if (cmdqelmt->CmdFromNdis == TRUE) |
| { |
| if (cmdqelmt->buffer != NULL) |
| NdisFreeMemory(cmdqelmt->buffer, cmdqelmt->bufferlength, 0); |
| |
| NdisFreeMemory(cmdqelmt, sizeof(CmdQElmt), 0); |
| } |
| else |
| { |
| if ((cmdqelmt->buffer != NULL) && (cmdqelmt->bufferlength != 0)) |
| NdisFreeMemory(cmdqelmt->buffer, cmdqelmt->bufferlength, 0); |
| { |
| NdisFreeMemory(cmdqelmt, sizeof(CmdQElmt), 0); |
| } |
| } |
| } /* end of while */ |
| } |
| |