1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
3  *
4  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
5  *
6  ******************************************************************************/
7 /*++
8 Copyright (c) Realtek Semiconductor Corp. All rights reserved.
9 
10 Module Name:
11 	HalPwrSeqCmd.c
12 
13 Abstract:
14 	Implement HW Power sequence configuration CMD handling routine for Realtek devices.
15 
16 Major Change History:
17 	When       Who               What
18 	---------- ---------------   -------------------------------
19 	2011-10-26 Lucas            Modify to be compatible with SD4-CE driver.
20 	2011-07-07 Roger            Create.
21 
22 --*/
23 #include <drv_types.h>
24 #include <rtw_debug.h>
25 #include <HalPwrSeqCmd.h>
26 
27 
28 /*  */
29 /*  Description: */
30 /*  This routine deal with the Power Configuration CMDs parsing for RTL8723/RTL8188E Series IC. */
31 /*  */
32 /*  Assumption: */
33 /*  We should follow specific format which was released from HW SD. */
34 /*  */
35 /*  2011.07.07, added by Roger. */
36 /*  */
HalPwrSeqCmdParsing(struct adapter * padapter,u8 CutVersion,u8 FabVersion,u8 InterfaceType,struct wlan_pwr_cfg PwrSeqCmd[])37 u8 HalPwrSeqCmdParsing(
38 	struct adapter *padapter,
39 	u8 CutVersion,
40 	u8 FabVersion,
41 	u8 InterfaceType,
42 	struct wlan_pwr_cfg PwrSeqCmd[]
43 )
44 {
45 	struct wlan_pwr_cfg PwrCfgCmd;
46 	u8 bPollingBit = false;
47 	u32 AryIdx = 0;
48 	u8 value = 0;
49 	u32 offset = 0;
50 	u32 pollingCount = 0; /*  polling autoload done. */
51 	u32 maxPollingCnt = 5000;
52 
53 	do {
54 		PwrCfgCmd = PwrSeqCmd[AryIdx];
55 
56 		/* 2 Only Handle the command whose FAB, CUT, and Interface are matched */
57 		if (
58 			(GET_PWR_CFG_FAB_MASK(PwrCfgCmd) & FabVersion) &&
59 			(GET_PWR_CFG_CUT_MASK(PwrCfgCmd) & CutVersion) &&
60 			(GET_PWR_CFG_INTF_MASK(PwrCfgCmd) & InterfaceType)
61 		) {
62 			switch (GET_PWR_CFG_CMD(PwrCfgCmd)) {
63 			case PWR_CMD_READ:
64 				break;
65 
66 			case PWR_CMD_WRITE:
67 				offset = GET_PWR_CFG_OFFSET(PwrCfgCmd);
68 
69 				/*  */
70 				/*  <Roger_Notes> We should deal with interface specific address mapping for some interfaces, e.g., SDIO interface */
71 				/*  2011.07.07. */
72 				/*  */
73 				if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) {
74 					/*  Read Back SDIO Local value */
75 					value = SdioLocalCmd52Read1Byte(padapter, offset);
76 
77 					value &= ~(GET_PWR_CFG_MASK(PwrCfgCmd));
78 					value |= (
79 						GET_PWR_CFG_VALUE(PwrCfgCmd) &
80 						GET_PWR_CFG_MASK(PwrCfgCmd)
81 					);
82 
83 					/*  Write Back SDIO Local value */
84 					SdioLocalCmd52Write1Byte(padapter, offset, value);
85 				} else {
86 					/*  Read the value from system register */
87 					value = rtw_read8(padapter, offset);
88 
89 					value &= (~(GET_PWR_CFG_MASK(PwrCfgCmd)));
90 					value |= (
91 						GET_PWR_CFG_VALUE(PwrCfgCmd)
92 						&GET_PWR_CFG_MASK(PwrCfgCmd)
93 					);
94 
95 					/*  Write the value back to system register */
96 					rtw_write8(padapter, offset, value);
97 				}
98 				break;
99 
100 			case PWR_CMD_POLLING:
101 
102 				bPollingBit = false;
103 				offset = GET_PWR_CFG_OFFSET(PwrCfgCmd);
104 				do {
105 					if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO)
106 						value = SdioLocalCmd52Read1Byte(padapter, offset);
107 					else
108 						value = rtw_read8(padapter, offset);
109 
110 					value = value&GET_PWR_CFG_MASK(PwrCfgCmd);
111 					if (
112 						value == (GET_PWR_CFG_VALUE(PwrCfgCmd) &
113 						GET_PWR_CFG_MASK(PwrCfgCmd))
114 					)
115 						bPollingBit = true;
116 					else
117 						udelay(10);
118 
119 					if (pollingCount++ > maxPollingCnt)
120 						return false;
121 
122 				} while (!bPollingBit);
123 
124 				break;
125 
126 			case PWR_CMD_DELAY:
127 				if (GET_PWR_CFG_VALUE(PwrCfgCmd) == PWRSEQ_DELAY_US)
128 					udelay(GET_PWR_CFG_OFFSET(PwrCfgCmd));
129 				else
130 					udelay(GET_PWR_CFG_OFFSET(PwrCfgCmd)*1000);
131 				break;
132 
133 			case PWR_CMD_END:
134 				/*  When this command is parsed, end the process */
135 				return true;
136 
137 			default:
138 				break;
139 			}
140 		}
141 
142 		AryIdx++;/* Add Array Index */
143 	} while (1);
144 
145 	return true;
146 }
147