| /* |
| ************************************************************************* |
| * 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: |
| rtmp_mcu.c |
| |
| Abstract: |
| Miniport generic portion header file |
| |
| Revision History: |
| Who When What |
| -------- ---------- ---------------------------------------------- |
| */ |
| |
| #include "../rt_config.h" |
| #include "../firmware.h" |
| |
| //#define BIN_IN_FILE /* use *.bin firmware */ |
| |
| |
| // New 8k byte firmware size for RT3071/RT3072 |
| #define FIRMWAREIMAGE_MAX_LENGTH 0x2000 |
| #define FIRMWAREIMAGE_LENGTH (sizeof (FirmwareImage) / sizeof(UCHAR)) |
| #define FIRMWARE_MAJOR_VERSION 0 |
| |
| #define FIRMWAREIMAGEV1_LENGTH 0x1000 |
| #define FIRMWAREIMAGEV2_LENGTH 0x1000 |
| |
| #ifdef RTMP_MAC_PCI |
| #define FIRMWARE_MINOR_VERSION 2 |
| #endif // RTMP_MAC_PCI // |
| |
| const unsigned short ccitt_16Table[] = { |
| 0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50A5, 0x60C6, 0x70E7, |
| 0x8108, 0x9129, 0xA14A, 0xB16B, 0xC18C, 0xD1AD, 0xE1CE, 0xF1EF, |
| 0x1231, 0x0210, 0x3273, 0x2252, 0x52B5, 0x4294, 0x72F7, 0x62D6, |
| 0x9339, 0x8318, 0xB37B, 0xA35A, 0xD3BD, 0xC39C, 0xF3FF, 0xE3DE, |
| 0x2462, 0x3443, 0x0420, 0x1401, 0x64E6, 0x74C7, 0x44A4, 0x5485, |
| 0xA56A, 0xB54B, 0x8528, 0x9509, 0xE5EE, 0xF5CF, 0xC5AC, 0xD58D, |
| 0x3653, 0x2672, 0x1611, 0x0630, 0x76D7, 0x66F6, 0x5695, 0x46B4, |
| 0xB75B, 0xA77A, 0x9719, 0x8738, 0xF7DF, 0xE7FE, 0xD79D, 0xC7BC, |
| 0x48C4, 0x58E5, 0x6886, 0x78A7, 0x0840, 0x1861, 0x2802, 0x3823, |
| 0xC9CC, 0xD9ED, 0xE98E, 0xF9AF, 0x8948, 0x9969, 0xA90A, 0xB92B, |
| 0x5AF5, 0x4AD4, 0x7AB7, 0x6A96, 0x1A71, 0x0A50, 0x3A33, 0x2A12, |
| 0xDBFD, 0xCBDC, 0xFBBF, 0xEB9E, 0x9B79, 0x8B58, 0xBB3B, 0xAB1A, |
| 0x6CA6, 0x7C87, 0x4CE4, 0x5CC5, 0x2C22, 0x3C03, 0x0C60, 0x1C41, |
| 0xEDAE, 0xFD8F, 0xCDEC, 0xDDCD, 0xAD2A, 0xBD0B, 0x8D68, 0x9D49, |
| 0x7E97, 0x6EB6, 0x5ED5, 0x4EF4, 0x3E13, 0x2E32, 0x1E51, 0x0E70, |
| 0xFF9F, 0xEFBE, 0xDFDD, 0xCFFC, 0xBF1B, 0xAF3A, 0x9F59, 0x8F78, |
| 0x9188, 0x81A9, 0xB1CA, 0xA1EB, 0xD10C, 0xC12D, 0xF14E, 0xE16F, |
| 0x1080, 0x00A1, 0x30C2, 0x20E3, 0x5004, 0x4025, 0x7046, 0x6067, |
| 0x83B9, 0x9398, 0xA3FB, 0xB3DA, 0xC33D, 0xD31C, 0xE37F, 0xF35E, |
| 0x02B1, 0x1290, 0x22F3, 0x32D2, 0x4235, 0x5214, 0x6277, 0x7256, |
| 0xB5EA, 0xA5CB, 0x95A8, 0x8589, 0xF56E, 0xE54F, 0xD52C, 0xC50D, |
| 0x34E2, 0x24C3, 0x14A0, 0x0481, 0x7466, 0x6447, 0x5424, 0x4405, |
| 0xA7DB, 0xB7FA, 0x8799, 0x97B8, 0xE75F, 0xF77E, 0xC71D, 0xD73C, |
| 0x26D3, 0x36F2, 0x0691, 0x16B0, 0x6657, 0x7676, 0x4615, 0x5634, |
| 0xD94C, 0xC96D, 0xF90E, 0xE92F, 0x99C8, 0x89E9, 0xB98A, 0xA9AB, |
| 0x5844, 0x4865, 0x7806, 0x6827, 0x18C0, 0x08E1, 0x3882, 0x28A3, |
| 0xCB7D, 0xDB5C, 0xEB3F, 0xFB1E, 0x8BF9, 0x9BD8, 0xABBB, 0xBB9A, |
| 0x4A75, 0x5A54, 0x6A37, 0x7A16, 0x0AF1, 0x1AD0, 0x2AB3, 0x3A92, |
| 0xFD2E, 0xED0F, 0xDD6C, 0xCD4D, 0xBDAA, 0xAD8B, 0x9DE8, 0x8DC9, |
| 0x7C26, 0x6C07, 0x5C64, 0x4C45, 0x3CA2, 0x2C83, 0x1CE0, 0x0CC1, |
| 0xEF1F, 0xFF3E, 0xCF5D, 0xDF7C, 0xAF9B, 0xBFBA, 0x8FD9, 0x9FF8, |
| 0x6E17, 0x7E36, 0x4E55, 0x5E74, 0x2E93, 0x3EB2, 0x0ED1, 0x1EF0 |
| }; |
| #define ByteCRC16(v, crc) \ |
| (unsigned short)((crc << 8) ^ ccitt_16Table[((crc >> 8) ^ (v)) & 255]) |
| |
| unsigned char BitReverse(unsigned char x) |
| { |
| int i; |
| unsigned char Temp=0; |
| for(i=0; ; i++) |
| { |
| if(x & 0x80) Temp |= 0x80; |
| if(i==7) break; |
| x <<= 1; |
| Temp >>= 1; |
| } |
| return Temp; |
| } |
| |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| erase 8051 firmware image in MAC ASIC |
| |
| Arguments: |
| Adapter Pointer to our adapter |
| |
| IRQL = PASSIVE_LEVEL |
| |
| ======================================================================== |
| */ |
| INT RtmpAsicEraseFirmware( |
| IN PRTMP_ADAPTER pAd) |
| { |
| ULONG i; |
| |
| for(i=0; i<MAX_FIRMWARE_IMAGE_SIZE; i+=4) |
| RTMP_IO_WRITE32(pAd, FIRMWARE_IMAGE_BASE + i, 0); |
| |
| return 0; |
| } |
| |
| /* |
| ======================================================================== |
| |
| Routine Description: |
| Load 8051 firmware file into MAC ASIC |
| |
| Arguments: |
| Adapter Pointer to our adapter |
| |
| Return Value: |
| NDIS_STATUS_SUCCESS firmware image load ok |
| NDIS_STATUS_FAILURE image not found |
| |
| IRQL = PASSIVE_LEVEL |
| |
| ======================================================================== |
| */ |
| NDIS_STATUS RtmpAsicLoadFirmware( |
| IN PRTMP_ADAPTER pAd) |
| { |
| #ifdef BIN_IN_FILE |
| #define NICLF_DEFAULT_USE() \ |
| flg_default_firm_use = TRUE; \ |
| DBGPRINT(RT_DEBUG_OFF, ("%s - Use default firmware!\n", __FUNCTION__)); |
| |
| NDIS_STATUS Status = NDIS_STATUS_SUCCESS; |
| PUCHAR src; |
| RTMP_OS_FD srcf; |
| INT retval, i; |
| PUCHAR pFirmwareImage; |
| INT FileLength = 0; |
| UINT32 MacReg; |
| ULONG Index; |
| ULONG firm; |
| BOOLEAN flg_default_firm_use = FALSE; |
| RTMP_OS_FS_INFO osFSInfo; |
| |
| DBGPRINT(RT_DEBUG_TRACE, ("===> %s\n", __FUNCTION__)); |
| |
| /* init */ |
| pFirmwareImage = NULL; |
| src = RTMP_FIRMWARE_FILE_NAME; |
| |
| RtmpOSFSInfoChange(&osFSInfo, TRUE); |
| |
| pAd->FirmwareVersion = (FIRMWARE_MAJOR_VERSION << 8) + \ |
| FIRMWARE_MINOR_VERSION; |
| |
| |
| /* allocate firmware buffer */ |
| pFirmwareImage = kmalloc(MAX_FIRMWARE_IMAGE_SIZE, MEM_ALLOC_FLAG); |
| if (pFirmwareImage == NULL) |
| { |
| /* allocate fail, use default firmware array in firmware.h */ |
| DBGPRINT(RT_DEBUG_ERROR, ("%s - Allocate memory fail!\n", __FUNCTION__)); |
| NICLF_DEFAULT_USE(); |
| } |
| else |
| { |
| /* allocate ok! zero the firmware buffer */ |
| memset(pFirmwareImage, 0x00, MAX_FIRMWARE_IMAGE_SIZE); |
| } /* End of if */ |
| |
| |
| /* if ok, read firmware file from *.bin file */ |
| if (flg_default_firm_use == FALSE) |
| { |
| do |
| { |
| /* open the bin file */ |
| srcf = RtmpOSFileOpen(src, O_RDONLY, 0); |
| |
| if (IS_FILE_OPEN_ERR(srcf)) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("%s - Error opening file %s\n", __FUNCTION__, src)); |
| NICLF_DEFAULT_USE(); |
| break; |
| } |
| |
| |
| /* read the firmware from the file *.bin */ |
| FileLength = RtmpOSFileRead(srcf, pFirmwareImage, MAX_FIRMWARE_IMAGE_SIZE); |
| if (FileLength != MAX_FIRMWARE_IMAGE_SIZE) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("%s: error file length (=%d) in RT2860AP.BIN\n", |
| __FUNCTION__, FileLength)); |
| NICLF_DEFAULT_USE(); |
| break; |
| } |
| else |
| { |
| PUCHAR ptr = pFirmwareImage; |
| USHORT crc = 0xffff; |
| |
| |
| /* calculate firmware CRC */ |
| for(i=0; i<(MAX_FIRMWARE_IMAGE_SIZE-2); i++, ptr++) |
| crc = ByteCRC16(BitReverse(*ptr), crc); |
| /* End of for */ |
| |
| if ((pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-2] != \ |
| (UCHAR)BitReverse((UCHAR)(crc>>8))) || |
| (pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-1] != \ |
| (UCHAR)BitReverse((UCHAR)crc))) |
| { |
| /* CRC fail */ |
| DBGPRINT(RT_DEBUG_ERROR, ("%s: CRC = 0x%02x 0x%02x " |
| "error, should be 0x%02x 0x%02x\n", |
| __FUNCTION__, |
| pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-2], |
| pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-1], |
| (UCHAR)(crc>>8), (UCHAR)(crc))); |
| NICLF_DEFAULT_USE(); |
| break; |
| } |
| else |
| { |
| /* firmware is ok */ |
| pAd->FirmwareVersion = \ |
| (pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-4] << 8) + |
| pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-3]; |
| |
| /* check if firmware version of the file is too old */ |
| if ((pAd->FirmwareVersion) < \ |
| ((FIRMWARE_MAJOR_VERSION << 8) + |
| FIRMWARE_MINOR_VERSION)) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("%s: firmware version too old!\n", __FUNCTION__)); |
| NICLF_DEFAULT_USE(); |
| break; |
| } /* End of if */ |
| } /* End of if */ |
| |
| DBGPRINT(RT_DEBUG_TRACE, |
| ("NICLoadFirmware: CRC ok, ver=%d.%d\n", |
| pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-4], |
| pFirmwareImage[MAX_FIRMWARE_IMAGE_SIZE-3])); |
| } /* End of if (FileLength == MAX_FIRMWARE_IMAGE_SIZE) */ |
| break; |
| } while(TRUE); |
| |
| /* close firmware file */ |
| if (IS_FILE_OPEN_ERR(srcf)) |
| ; |
| else |
| { |
| retval = RtmpOSFileClose(srcf); |
| if (retval) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("--> Error %d closing %s\n", -retval, src)); |
| } |
| } |
| } |
| |
| |
| /* write firmware to ASIC */ |
| if (flg_default_firm_use == TRUE) |
| { |
| /* use default fimeware, free allocated buffer */ |
| if (pFirmwareImage != NULL) |
| kfree(pFirmwareImage); |
| /* End of if */ |
| |
| /* use default *.bin array */ |
| pFirmwareImage = FirmwareImage; |
| FileLength = sizeof(FirmwareImage); |
| } /* End of if */ |
| |
| /* enable Host program ram write selection */ |
| RTMP_IO_WRITE32(pAd, PBF_SYS_CTRL, 0x10000); |
| |
| for(i=0; i<FileLength; i+=4) |
| { |
| firm = pFirmwareImage[i] + |
| (pFirmwareImage[i+3] << 24) + |
| (pFirmwareImage[i+2] << 16) + |
| (pFirmwareImage[i+1] << 8); |
| |
| RTMP_IO_WRITE32(pAd, FIRMWARE_IMAGE_BASE + i, firm); |
| } /* End of for */ |
| |
| RTMP_IO_WRITE32(pAd, PBF_SYS_CTRL, 0x00000); |
| RTMP_IO_WRITE32(pAd, PBF_SYS_CTRL, 0x00001); |
| |
| /* initialize BBP R/W access agent */ |
| RTMP_IO_WRITE32(pAd, H2M_BBP_AGENT, 0); |
| RTMP_IO_WRITE32(pAd, H2M_MAILBOX_CSR, 0); |
| |
| if (flg_default_firm_use == FALSE) |
| { |
| /* use file firmware, free allocated buffer */ |
| if (pFirmwareImage != NULL) |
| kfree(pFirmwareImage); |
| /* End of if */ |
| } /* End of if */ |
| |
| RtmpOSFSInfoChange(&osFSInfo, FALSE); |
| #else |
| |
| NDIS_STATUS Status = NDIS_STATUS_SUCCESS; |
| PUCHAR pFirmwareImage; |
| ULONG FileLength, Index; |
| //ULONG firm; |
| UINT32 MacReg = 0; |
| UINT32 Version = (pAd->MACVersion >> 16); |
| |
| pFirmwareImage = FirmwareImage; |
| FileLength = sizeof(FirmwareImage); |
| |
| // New 8k byte firmware size for RT3071/RT3072 |
| //DBGPRINT(RT_DEBUG_TRACE, ("Usb Chip\n")); |
| if (FIRMWAREIMAGE_LENGTH == FIRMWAREIMAGE_MAX_LENGTH) |
| //The firmware image consists of two parts. One is the origianl and the other is the new. |
| //Use Second Part |
| { |
| #ifdef RTMP_MAC_PCI |
| if ((Version == 0x2860) || IS_RT3090(pAd)||IS_RT3390(pAd)) |
| { |
| pFirmwareImage = FirmwareImage; |
| FileLength = FIRMWAREIMAGE_LENGTH; |
| } |
| #endif // RTMP_MAC_PCI // |
| } |
| else |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("KH: bin file should be 8KB.\n")); |
| Status = NDIS_STATUS_FAILURE; |
| } |
| |
| |
| RTMP_WRITE_FIRMWARE(pAd, pFirmwareImage, FileLength); |
| |
| #endif |
| |
| /* check if MCU is ready */ |
| Index = 0; |
| do |
| { |
| RTMP_IO_READ32(pAd, PBF_SYS_CTRL, &MacReg); |
| |
| if (MacReg & 0x80) |
| break; |
| |
| RTMPusecDelay(1000); |
| } while (Index++ < 1000); |
| |
| if (Index >= 1000) |
| { |
| DBGPRINT(RT_DEBUG_ERROR, ("NICLoadFirmware: MCU is not ready\n\n\n")); |
| Status = NDIS_STATUS_FAILURE; |
| } |
| |
| DBGPRINT(RT_DEBUG_TRACE, ("<=== %s (status=%d)\n", __FUNCTION__, Status)); |
| |
| return Status; |
| } |
| |
| |
| INT RtmpAsicSendCommandToMcu( |
| IN PRTMP_ADAPTER pAd, |
| IN UCHAR Command, |
| IN UCHAR Token, |
| IN UCHAR Arg0, |
| IN UCHAR Arg1) |
| { |
| HOST_CMD_CSR_STRUC H2MCmd; |
| H2M_MAILBOX_STRUC H2MMailbox; |
| ULONG i = 0; |
| #ifdef RTMP_MAC_PCI |
| #ifdef RALINK_ATE |
| static UINT32 j = 0; |
| #endif // RALINK_ATE // |
| #endif // RTMP_MAC_PCI // |
| #ifdef PCIE_PS_SUPPORT |
| #ifdef CONFIG_STA_SUPPORT |
| // 3090F power solution 3 has hw limitation that needs to ban all mcu command |
| // when firmware is in radio state. For other chip doesn't have this limitation. |
| if (((IS_RT3090(pAd) || IS_RT3572(pAd) || IS_RT3390(pAd)) && IS_VERSION_AFTER_F(pAd)) && IS_VERSION_AFTER_F(pAd) |
| && (pAd->StaCfg.PSControl.field.rt30xxPowerMode == 3) |
| && (pAd->StaCfg.PSControl.field.EnableNewPS == TRUE)) |
| { |
| RTMP_SEM_LOCK(&pAd->McuCmdLock); |
| if ((pAd->brt30xxBanMcuCmd == TRUE) |
| && (Command != WAKE_MCU_CMD) && (Command != RFOFF_MCU_CMD)) |
| { |
| RTMP_SEM_UNLOCK(&pAd->McuCmdLock); |
| DBGPRINT(RT_DEBUG_TRACE, (" Ban Mcu Cmd %x in sleep mode\n", Command)); |
| return FALSE; |
| } |
| else if ((Command == SLEEP_MCU_CMD) |
| ||(Command == RFOFF_MCU_CMD)) |
| { |
| pAd->brt30xxBanMcuCmd = TRUE; |
| } |
| else if (Command != WAKE_MCU_CMD) |
| { |
| pAd->brt30xxBanMcuCmd = FALSE; |
| } |
| |
| RTMP_SEM_UNLOCK(&pAd->McuCmdLock); |
| |
| } |
| if (((IS_RT3090(pAd) || IS_RT3572(pAd) || IS_RT3390(pAd)) && IS_VERSION_AFTER_F(pAd)) && IS_VERSION_AFTER_F(pAd) |
| && (pAd->StaCfg.PSControl.field.rt30xxPowerMode == 3) |
| && (pAd->StaCfg.PSControl.field.EnableNewPS == TRUE) |
| && (Command == WAKE_MCU_CMD)) |
| { |
| |
| do |
| { |
| RTMP_IO_FORCE_READ32(pAd, H2M_MAILBOX_CSR, &H2MMailbox.word); |
| if (H2MMailbox.field.Owner == 0) |
| break; |
| |
| RTMPusecDelay(2); |
| DBGPRINT(RT_DEBUG_INFO, ("AsicSendCommanToMcu::Mail box is busy\n")); |
| } while(i++ < 100); |
| |
| if (i >= 100) |
| { |
| DBGPRINT_ERR(("H2M_MAILBOX still hold by MCU. command fail\n")); |
| return FALSE; |
| } |
| |
| H2MMailbox.field.Owner = 1; // pass ownership to MCU |
| H2MMailbox.field.CmdToken = Token; |
| H2MMailbox.field.HighByte = Arg1; |
| H2MMailbox.field.LowByte = Arg0; |
| RTMP_IO_FORCE_WRITE32(pAd, H2M_MAILBOX_CSR, H2MMailbox.word); |
| |
| H2MCmd.word = 0; |
| H2MCmd.field.HostCommand = Command; |
| RTMP_IO_FORCE_WRITE32(pAd, HOST_CMD_CSR, H2MCmd.word); |
| |
| |
| } |
| else |
| #endif // CONFIG_STA_SUPPORT // |
| #endif // PCIE_PS_SUPPORT // |
| { |
| do |
| { |
| RTMP_IO_READ32(pAd, H2M_MAILBOX_CSR, &H2MMailbox.word); |
| if (H2MMailbox.field.Owner == 0) |
| break; |
| |
| RTMPusecDelay(2); |
| } while(i++ < 100); |
| |
| if (i >= 100) |
| { |
| #ifdef RTMP_MAC_PCI |
| #ifdef RALINK_ATE |
| if (pAd->ate.bFWLoading == TRUE) |
| { |
| /* reloading firmware when received iwpriv cmd "ATE=ATESTOP" */ |
| if (j > 0) |
| { |
| if (j % 64 != 0) |
| { |
| ATEDBGPRINT(RT_DEBUG_ERROR, ("#")); |
| } |
| else |
| { |
| ATEDBGPRINT(RT_DEBUG_ERROR, ("\n")); |
| } |
| ++j; |
| } |
| else if (j == 0) |
| { |
| ATEDBGPRINT(RT_DEBUG_ERROR, ("Loading firmware. Please wait for a moment...\n")); |
| ++j; |
| } |
| } |
| else |
| #endif // RALINK_ATE // |
| #endif // RTMP_MAC_PCI // |
| { |
| DBGPRINT_ERR(("H2M_MAILBOX still hold by MCU. command fail\n")); |
| } |
| return FALSE; |
| } |
| |
| #ifdef RTMP_MAC_PCI |
| #ifdef RALINK_ATE |
| else if (pAd->ate.bFWLoading == TRUE) |
| { |
| /* reloading of firmware is completed */ |
| pAd->ate.bFWLoading = FALSE; |
| ATEDBGPRINT(RT_DEBUG_ERROR, ("\n")); |
| j = 0; |
| } |
| #endif // RALINK_ATE // |
| #endif // RTMP_MAC_PCI // |
| |
| H2MMailbox.field.Owner = 1; // pass ownership to MCU |
| H2MMailbox.field.CmdToken = Token; |
| H2MMailbox.field.HighByte = Arg1; |
| H2MMailbox.field.LowByte = Arg0; |
| RTMP_IO_WRITE32(pAd, H2M_MAILBOX_CSR, H2MMailbox.word); |
| |
| H2MCmd.word = 0; |
| H2MCmd.field.HostCommand = Command; |
| RTMP_IO_WRITE32(pAd, HOST_CMD_CSR, H2MCmd.word); |
| |
| if (Command != 0x80) |
| { |
| } |
| } |
| #ifdef PCIE_PS_SUPPORT |
| #ifdef CONFIG_STA_SUPPORT |
| // 3090 MCU Wakeup command needs more time to be stable. |
| // Before stable, don't issue other MCU command to prevent from firmware error. |
| if (((IS_RT3090(pAd) || IS_RT3572(pAd) || IS_RT3390(pAd)) && IS_VERSION_AFTER_F(pAd)) && IS_VERSION_AFTER_F(pAd) |
| && (pAd->StaCfg.PSControl.field.rt30xxPowerMode == 3) |
| && (pAd->StaCfg.PSControl.field.EnableNewPS == TRUE) |
| && (Command == WAKE_MCU_CMD)) |
| { |
| RTMPusecDelay(2000); |
| //Put this is after RF programming. |
| //NdisAcquireSpinLock(&pAd->McuCmdLock); |
| //pAd->brt30xxBanMcuCmd = FALSE; |
| //NdisReleaseSpinLock(&pAd->McuCmdLock); |
| } |
| #endif // CONFIG_STA_SUPPORT // |
| #endif // PCIE_PS_SUPPORT // |
| |
| return TRUE; |
| } |