| /****************************************************************************** |
| * |
| * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of version 2 of the GNU General Public License as |
| * published by the Free Software Foundation. |
| * |
| * 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. |
| * |
| ******************************************************************************/ |
| /*++ |
| 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-10-26 Lucas Modify to be compatible with SD4-CE driver. |
| 2011-07-07 Roger Create. |
| |
| --*/ |
| #include <HalPwrSeqCmd.h> |
| #include <usb_ops_linux.h> |
| |
| /* */ |
| /* 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. */ |
| /* */ |
| u8 HalPwrSeqCmdParsing23a(struct rtw_adapter *padapter, u8 CutVersion, |
| u8 FabVersion, u8 InterfaceType, |
| struct wlan_pwr_cfg PwrSeqCmd[]) |
| { |
| struct wlan_pwr_cfg PwrCfgCmd; |
| u8 bPollingBit; |
| u32 AryIdx = 0; |
| u8 value; |
| u32 offset; |
| u32 pollingCount = 0; /* polling autoload done. */ |
| u32 maxPollingCnt = 5000; |
| |
| do { |
| PwrCfgCmd = PwrSeqCmd[AryIdx]; |
| |
| RT_TRACE(_module_hal_init_c_, _drv_info_, |
| ("HalPwrSeqCmdParsing23a: offset(%#x) cut_msk(%#x) " |
| "fab_msk(%#x) interface_msk(%#x) base(%#x) cmd(%#x) " |
| "msk(%#x) value(%#x)\n", |
| 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: |
| RT_TRACE(_module_hal_init_c_, _drv_info_, |
| ("HalPwrSeqCmdParsing23a: " |
| "PWR_CMD_READ\n")); |
| break; |
| |
| case PWR_CMD_WRITE: |
| RT_TRACE(_module_hal_init_c_, _drv_info_, |
| ("HalPwrSeqCmdParsing23a: " |
| "PWR_CMD_WRITE\n")); |
| offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); |
| |
| /* Read the value from system register */ |
| value = rtl8723au_read8(padapter, offset); |
| |
| value &= ~(GET_PWR_CFG_MASK(PwrCfgCmd)); |
| value |= (GET_PWR_CFG_VALUE(PwrCfgCmd) & |
| GET_PWR_CFG_MASK(PwrCfgCmd)); |
| |
| /* Write the value back to sytem register */ |
| rtl8723au_write8(padapter, offset, value); |
| break; |
| |
| case PWR_CMD_POLLING: |
| RT_TRACE(_module_hal_init_c_, _drv_info_, |
| ("HalPwrSeqCmdParsing23a: " |
| "PWR_CMD_POLLING\n")); |
| |
| bPollingBit = false; |
| offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); |
| do { |
| value = rtl8723au_read8(padapter, |
| offset); |
| |
| value &= GET_PWR_CFG_MASK(PwrCfgCmd); |
| if (value == |
| (GET_PWR_CFG_VALUE(PwrCfgCmd) & |
| GET_PWR_CFG_MASK(PwrCfgCmd))) |
| bPollingBit = true; |
| else |
| udelay(10); |
| |
| if (pollingCount++ > maxPollingCnt) { |
| DBG_8723A("Fail to polling " |
| "Offset[%#x]\n", |
| offset); |
| return false; |
| } |
| } while (!bPollingBit); |
| |
| break; |
| |
| case PWR_CMD_DELAY: |
| RT_TRACE(_module_hal_init_c_, _drv_info_, |
| ("HalPwrSeqCmdParsing23a: " |
| "PWR_CMD_DELAY\n")); |
| if (GET_PWR_CFG_VALUE(PwrCfgCmd) == |
| PWRSEQ_DELAY_US) |
| udelay(GET_PWR_CFG_OFFSET(PwrCfgCmd)); |
| else |
| udelay(GET_PWR_CFG_OFFSET(PwrCfgCmd) * |
| 1000); |
| break; |
| |
| case PWR_CMD_END: |
| /* When this command is parsed, end |
| the process */ |
| RT_TRACE(_module_hal_init_c_, _drv_info_, |
| ("HalPwrSeqCmdParsing23a: " |
| "PWR_CMD_END\n")); |
| return true; |
| |
| default: |
| RT_TRACE(_module_hal_init_c_, _drv_err_, |
| ("HalPwrSeqCmdParsing23a: " |
| "Unknown CMD!!\n")); |
| break; |
| } |
| } |
| |
| AryIdx++; /* Add Array Index */ |
| } while (1); |
| |
| return true; |
| } |