From 691cc9529efe8ea7abaab170c452ae4470bf3ac2 Mon Sep 17 00:00:00 2001 From: Roman Yeryomin Date: Wed, 6 Feb 2013 02:59:31 +0200 Subject: Rebase files to rsdk 3.2 and refresh patches. Compilable (not by humans). Signed-off-by: Roman Yeryomin --- .../drivers/net/wireless/rtl8192cd/HalPwrSeqCmd.c | 129 +++++++++++++++++++++ 1 file changed, 129 insertions(+) create mode 100644 target/linux/realtek/files/drivers/net/wireless/rtl8192cd/HalPwrSeqCmd.c (limited to 'target/linux/realtek/files/drivers/net/wireless/rtl8192cd/HalPwrSeqCmd.c') diff --git a/target/linux/realtek/files/drivers/net/wireless/rtl8192cd/HalPwrSeqCmd.c b/target/linux/realtek/files/drivers/net/wireless/rtl8192cd/HalPwrSeqCmd.c new file mode 100644 index 000000000..4ab1b03fc --- /dev/null +++ b/target/linux/realtek/files/drivers/net/wireless/rtl8192cd/HalPwrSeqCmd.c @@ -0,0 +1,129 @@ +/*++ +Copyright (c) Realtek Semiconductor Corp. All rights reserved. + +Module Name: + HalPwrSeqCmd.c + +Abstract: + Implement HW Power sequence configuration CMD handling routine for Realtek devices. + +Major Change History: + When Who What + ---------- --------------- ------------------------------- + 2011-07-07 Roger Create. + +--*/ + +#ifdef CONFIG_RTL_88E_SUPPORT +//#include "Mp_Precomp.h" +#ifdef __KERNEL__ +#include +#endif +#include "8192cd_debug.h" +#include "8192cd_headers.h" +#include "8192cd_util.h" + +#define TRUE 1 +#define FALSE 0 + +// +// Description: +// This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. +// +// Assumption: +// We should follow specific format which was released from HW SD. +// +// 2011.07.07, added by Roger. +// +unsigned int HalPwrSeqCmdParsing(struct rtl8192cd_priv *priv, unsigned char CutVersion, unsigned char FabVersion, + unsigned char InterfaceType, WLAN_PWR_CFG PwrSeqCmd[]) +{ + + WLAN_PWR_CFG PwrCfgCmd = {0}; + unsigned int bPollingBit = FALSE; + unsigned int AryIdx=0; + unsigned char value = 0; + unsigned int offset = 0; + unsigned int pollingCount = 0; // polling autoload done. + unsigned int maxPollingCnt = 5000; + + do { + PwrCfgCmd=PwrSeqCmd[AryIdx]; + + DEBUG_INFO("%s %d, ENTRY, offset:0x%x, cut_msk:0x%x, fab_msk:0x%x, if_msk:0x%x, base:0x%x, cmd:0x%x, msk:0x%x, value:0x%x\n", + __FUNCTION__, __LINE__, GET_PWR_CFG_OFFSET(PwrCfgCmd), GET_PWR_CFG_CUT_MASK(PwrCfgCmd), + GET_PWR_CFG_FAB_MASK(PwrCfgCmd), GET_PWR_CFG_INTF_MASK(PwrCfgCmd), GET_PWR_CFG_BASE(PwrCfgCmd), + GET_PWR_CFG_CMD(PwrCfgCmd), GET_PWR_CFG_MASK(PwrCfgCmd), GET_PWR_CFG_VALUE(PwrCfgCmd)); + + //2 Only Handle the command whose FAB, CUT, and Interface are matched + if((GET_PWR_CFG_FAB_MASK(PwrCfgCmd)&FabVersion)&& + (GET_PWR_CFG_CUT_MASK(PwrCfgCmd)&CutVersion)&& + (GET_PWR_CFG_INTF_MASK(PwrCfgCmd)&InterfaceType)) { + switch(GET_PWR_CFG_CMD(PwrCfgCmd)) + { + case PWR_CMD_READ: + DEBUG_INFO("%s %d, PWR_CMD_READ\n", __FUNCTION__, __LINE__); + break; + + case PWR_CMD_WRITE: + DEBUG_INFO("%s %d, PWR_CMD_WRITE\n", __FUNCTION__, __LINE__); + offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); + + //Read the value from system register + value = RTL_R8(offset); + value = value&(~(GET_PWR_CFG_MASK(PwrCfgCmd))); + value = value|(GET_PWR_CFG_VALUE(PwrCfgCmd)&GET_PWR_CFG_MASK(PwrCfgCmd)); + + //Write the value back to sytem register + RTL_W8(offset, value); + break; + + case PWR_CMD_POLLING: + DEBUG_INFO("%s %d, PWR_CMD_POLLING\n", __FUNCTION__, __LINE__); + bPollingBit = FALSE; + offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); + + do { + value = RTL_R8(offset); + value=value&GET_PWR_CFG_MASK(PwrCfgCmd); + if(value==(GET_PWR_CFG_VALUE(PwrCfgCmd)&GET_PWR_CFG_MASK(PwrCfgCmd))) + bPollingBit=TRUE; + else + delay_us(10); + + if(pollingCount++ > maxPollingCnt){ + DEBUG_WARN("%s %d, PWR_CMD_POLLING, Fail to polling Offset[0x%x]\n", __FUNCTION__, __LINE__, offset); + return FALSE; + } + }while(!bPollingBit); + + break; + + case PWR_CMD_DELAY: + DEBUG_INFO("%s %d, PWR_CMD_DELAY\n", __FUNCTION__, __LINE__); + if(GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US) + delay_us(GET_PWR_CFG_OFFSET(PwrCfgCmd)); + else + delay_us(GET_PWR_CFG_OFFSET(PwrCfgCmd)*1000); + break; + + case PWR_CMD_END: + // When this command is parsed, end the process + DEBUG_INFO("%s %d, PWR_CMD_END\n", __FUNCTION__, __LINE__); + return TRUE; + break; + + default: + DEBUG_ERR("%s %d, Unknown CMD!!\n", __FUNCTION__, __LINE__); + break; + } + + } + + AryIdx++;//Add Array Index + }while(1); + + return TRUE; +} +#endif + -- cgit v1.2.3