drivers/staging/rt3090/common/rtmp_mcu.c - kernel/prism - Git at Google

 /*
  *************************************************************************
  * 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;
 }
	/*
	*************************************************************************
	* 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;
	}