xref: /OK3568_Linux_fs/u-boot/arch/arm/mach-rockchip/px30/px30.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Copyright (c) 2017 Rockchip Electronics Co., Ltd
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * SPDX-License-Identifier:     GPL-2.0+
5*4882a593Smuzhiyun  */
6*4882a593Smuzhiyun #include <common.h>
7*4882a593Smuzhiyun #include <clk.h>
8*4882a593Smuzhiyun #include <dm.h>
9*4882a593Smuzhiyun #include <fdt_support.h>
10*4882a593Smuzhiyun #include <asm/io.h>
11*4882a593Smuzhiyun #include <asm/arch/cru_px30.h>
12*4882a593Smuzhiyun #include <asm/arch/grf_px30.h>
13*4882a593Smuzhiyun #include <asm/arch/hardware.h>
14*4882a593Smuzhiyun #include <asm/arch/uart.h>
15*4882a593Smuzhiyun #include <asm/arch/clock.h>
16*4882a593Smuzhiyun #include <asm/arch/cpu.h>
17*4882a593Smuzhiyun #include <asm/arch/cru_px30.h>
18*4882a593Smuzhiyun #include <dt-bindings/clock/px30-cru.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #define PMU_PWRDN_CON			0xff000018
21*4882a593Smuzhiyun #define GRF_CPU_CON1			0xff140504
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun #define USBPHY_GRF_BASE			0xff2c0000
24*4882a593Smuzhiyun #define VIDEO_PHY_BASE			0xff2e0000
25*4882a593Smuzhiyun #define FW_DDR_CON_REG			0xff534040
26*4882a593Smuzhiyun #define SERVICE_CORE_ADDR		0xff508000
27*4882a593Smuzhiyun #define QOS_PRIORITY			0x08
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #define QOS_PRIORITY_LEVEL(h, l)	((((h) & 3) << 8) | ((l) & 3))
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun #ifdef CONFIG_ARM64
32*4882a593Smuzhiyun #include <asm/armv8/mmu.h>
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun static struct mm_region px30_mem_map[] = {
35*4882a593Smuzhiyun 	{
36*4882a593Smuzhiyun 		.virt = 0x0UL,
37*4882a593Smuzhiyun 		.phys = 0x0UL,
38*4882a593Smuzhiyun 		.size = 0xff000000UL,
39*4882a593Smuzhiyun 		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
40*4882a593Smuzhiyun 			 PTE_BLOCK_INNER_SHARE
41*4882a593Smuzhiyun 	}, {
42*4882a593Smuzhiyun 		.virt = 0xff000000UL,
43*4882a593Smuzhiyun 		.phys = 0xff000000UL,
44*4882a593Smuzhiyun 		.size = 0x01000000UL,
45*4882a593Smuzhiyun 		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
46*4882a593Smuzhiyun 			 PTE_BLOCK_NON_SHARE |
47*4882a593Smuzhiyun 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
48*4882a593Smuzhiyun 	}, {
49*4882a593Smuzhiyun 		/* List terminator */
50*4882a593Smuzhiyun 		0,
51*4882a593Smuzhiyun 	}
52*4882a593Smuzhiyun };
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun struct mm_region *mem_map = px30_mem_map;
55*4882a593Smuzhiyun #endif
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun #define PMU_PWRDN_CON			0xff000018
58*4882a593Smuzhiyun #define GRF_BASE			0xff140000
59*4882a593Smuzhiyun #define CRU_BASE			0xff2b0000
60*4882a593Smuzhiyun #define VIDEO_PHY_BASE			0xff2e0000
61*4882a593Smuzhiyun #define SERVICE_CORE_ADDR		0xff508000
62*4882a593Smuzhiyun #define DDR_FW_BASE			0xff534000
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun #define FW_DDR_CON			0x40
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun #define QOS_PRIORITY			0x08
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun #define QOS_PRIORITY_LEVEL(h, l)	((((h) & 3) << 8) | ((l) & 3))
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun #define GRF_GPIO1A_DS2			0x0090
71*4882a593Smuzhiyun #define GRF_GPIO1B_DS2			0x0094
72*4882a593Smuzhiyun #define GRF_GPIO1A_E			0x00F0
73*4882a593Smuzhiyun #define GRF_GPIO1B_E			0x00F4
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun /* GRF_GPIO1CL_IOMUX */
76*4882a593Smuzhiyun enum {
77*4882a593Smuzhiyun 	GPIO1C1_SHIFT		= 4,
78*4882a593Smuzhiyun 	GPIO1C1_MASK		= 0xf << GPIO1C1_SHIFT,
79*4882a593Smuzhiyun 	GPIO1C1_GPIO		= 0,
80*4882a593Smuzhiyun 	GPIO1C1_UART1_TX,
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	GPIO1C0_SHIFT		= 0,
83*4882a593Smuzhiyun 	GPIO1C0_MASK		= 0xf << GPIO1C0_SHIFT,
84*4882a593Smuzhiyun 	GPIO1C0_GPIO		= 0,
85*4882a593Smuzhiyun 	GPIO1C0_UART1_RX,
86*4882a593Smuzhiyun };
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun /* GRF_GPIO1DL_IOMUX */
89*4882a593Smuzhiyun enum {
90*4882a593Smuzhiyun 	GPIO1D3_SHIFT		= 12,
91*4882a593Smuzhiyun 	GPIO1D3_MASK		= 0xf << GPIO1D3_SHIFT,
92*4882a593Smuzhiyun 	GPIO1D3_GPIO		= 0,
93*4882a593Smuzhiyun 	GPIO1D3_SDMMC_D1,
94*4882a593Smuzhiyun 	GPIO1D3_UART2_RXM0,
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun 	GPIO1D2_SHIFT		= 8,
97*4882a593Smuzhiyun 	GPIO1D2_MASK		= 0xf << GPIO1D2_SHIFT,
98*4882a593Smuzhiyun 	GPIO1D2_GPIO		= 0,
99*4882a593Smuzhiyun 	GPIO1D2_SDMMC_D0,
100*4882a593Smuzhiyun 	GPIO1D2_UART2_TXM0,
101*4882a593Smuzhiyun };
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun /* GRF_GPIO1DH_IOMUX */
104*4882a593Smuzhiyun enum {
105*4882a593Smuzhiyun 	GPIO1D7_SHIFT		= 12,
106*4882a593Smuzhiyun 	GPIO1D7_MASK		= 0xf << GPIO1D7_SHIFT,
107*4882a593Smuzhiyun 	GPIO1D7_GPIO		= 0,
108*4882a593Smuzhiyun 	GPIO1D7_SDMMC_CMD,
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	GPIO1D6_SHIFT		= 8,
111*4882a593Smuzhiyun 	GPIO1D6_MASK		= 0xf << GPIO1D6_SHIFT,
112*4882a593Smuzhiyun 	GPIO1D6_GPIO		= 0,
113*4882a593Smuzhiyun 	GPIO1D6_SDMMC_CLK,
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun 	GPIO1D5_SHIFT		= 4,
116*4882a593Smuzhiyun 	GPIO1D5_MASK		= 0xf << GPIO1D5_SHIFT,
117*4882a593Smuzhiyun 	GPIO1D5_GPIO		= 0,
118*4882a593Smuzhiyun 	GPIO1D5_SDMMC_D3,
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	GPIO1D4_SHIFT		= 0,
121*4882a593Smuzhiyun 	GPIO1D4_MASK		= 0xf << GPIO1D4_SHIFT,
122*4882a593Smuzhiyun 	GPIO1D4_GPIO		= 0,
123*4882a593Smuzhiyun 	GPIO1D4_SDMMC_D2,
124*4882a593Smuzhiyun };
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun /* GRF_GPIO2BH_IOMUX */
127*4882a593Smuzhiyun enum {
128*4882a593Smuzhiyun 	GPIO2B6_SHIFT		= 8,
129*4882a593Smuzhiyun 	GPIO2B6_MASK		= 0xf << GPIO2B6_SHIFT,
130*4882a593Smuzhiyun 	GPIO2B6_GPIO		= 0,
131*4882a593Smuzhiyun 	GPIO2B6_CIF_D1M0,
132*4882a593Smuzhiyun 	GPIO2B6_UART2_RXM1,
133*4882a593Smuzhiyun 
134*4882a593Smuzhiyun 	GPIO2B4_SHIFT		= 0,
135*4882a593Smuzhiyun 	GPIO2B4_MASK		= 0xf << GPIO2B4_SHIFT,
136*4882a593Smuzhiyun 	GPIO2B4_GPIO		= 0,
137*4882a593Smuzhiyun 	GPIO2B4_CIF_D0M0,
138*4882a593Smuzhiyun 	GPIO2B4_UART2_TXM1,
139*4882a593Smuzhiyun };
140*4882a593Smuzhiyun 
141*4882a593Smuzhiyun /* GRF_GPIO3AL_IOMUX */
142*4882a593Smuzhiyun enum {
143*4882a593Smuzhiyun 	GPIO3A2_SHIFT		= 8,
144*4882a593Smuzhiyun 	GPIO3A2_MASK		= 0xf << GPIO3A2_SHIFT,
145*4882a593Smuzhiyun 	GPIO3A2_GPIO		= 0,
146*4882a593Smuzhiyun 	GPIO3A2_UART5_TX	= 4,
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 	GPIO3A1_SHIFT		= 4,
149*4882a593Smuzhiyun 	GPIO3A1_MASK		= 0xf << GPIO3A1_SHIFT,
150*4882a593Smuzhiyun 	GPIO3A1_GPIO		= 0,
151*4882a593Smuzhiyun 	GPIO3A1_UART5_RX	= 4,
152*4882a593Smuzhiyun };
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun enum {
155*4882a593Smuzhiyun 	IOVSEL6_CTRL_SHIFT	= 0,
156*4882a593Smuzhiyun 	IOVSEL6_CTRL_MASK	= BIT(0),
157*4882a593Smuzhiyun 	VCCIO6_SEL_BY_GPIO	= 0,
158*4882a593Smuzhiyun 	VCCIO6_SEL_BY_IOVSEL6,
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	IOVSEL6_SHIFT		= 1,
161*4882a593Smuzhiyun 	IOVSEL6_MASK		= BIT(1),
162*4882a593Smuzhiyun 	VCCIO6_3V3		= 0,
163*4882a593Smuzhiyun 	VCCIO6_1V8,
164*4882a593Smuzhiyun };
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun /*
167*4882a593Smuzhiyun  * The voltage of VCCIO6(which is the voltage domain of emmc/flash/sfc
168*4882a593Smuzhiyun  * interface) can indicated by GPIO0_B6 or io_vsel6. The SOC defaults
169*4882a593Smuzhiyun  * use GPIO0_B6 to indicate power supply voltage for VCCIO6 by hardware,
170*4882a593Smuzhiyun  * then we can switch to io_vsel6 after system power on, and release GPIO0_B6
171*4882a593Smuzhiyun  * for other usage.
172*4882a593Smuzhiyun  */
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun #define GPIO0_B6		14
175*4882a593Smuzhiyun #define GPIO0_BASE		0xff040000
176*4882a593Smuzhiyun #define GPIO_SWPORTA_DDR	0x4
177*4882a593Smuzhiyun #define GPIO_EXT_PORTA		0x50
178*4882a593Smuzhiyun 
grf_vccio6_vsel_init(void)179*4882a593Smuzhiyun static int grf_vccio6_vsel_init(void)
180*4882a593Smuzhiyun {
181*4882a593Smuzhiyun 	static struct px30_grf * const grf = (void *)GRF_BASE;
182*4882a593Smuzhiyun 	u32 val;
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 	val = readl(GPIO0_BASE + GPIO_SWPORTA_DDR);
185*4882a593Smuzhiyun 	val &= ~BIT(GPIO0_B6);
186*4882a593Smuzhiyun 	writel(val, GPIO0_BASE + GPIO_SWPORTA_DDR);
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 	if (readl(GPIO0_BASE + GPIO_EXT_PORTA) & BIT(GPIO0_B6))
189*4882a593Smuzhiyun 		val = VCCIO6_SEL_BY_IOVSEL6 << IOVSEL6_CTRL_SHIFT |
190*4882a593Smuzhiyun 		      VCCIO6_1V8 << IOVSEL6_SHIFT;
191*4882a593Smuzhiyun 	else
192*4882a593Smuzhiyun 		val = VCCIO6_SEL_BY_IOVSEL6 << IOVSEL6_CTRL_SHIFT |
193*4882a593Smuzhiyun 		      VCCIO6_3V3 << IOVSEL6_SHIFT;
194*4882a593Smuzhiyun 	rk_clrsetreg(&grf->io_vsel, IOVSEL6_CTRL_MASK | IOVSEL6_MASK, val);
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun 	return 0;
197*4882a593Smuzhiyun }
198*4882a593Smuzhiyun 
arch_cpu_init(void)199*4882a593Smuzhiyun int arch_cpu_init(void)
200*4882a593Smuzhiyun {
201*4882a593Smuzhiyun #ifdef CONFIG_SPL_BUILD
202*4882a593Smuzhiyun 	/* We do some SoC one time setting here. */
203*4882a593Smuzhiyun 	/* Disable the ddr secure region setting to make it non-secure */
204*4882a593Smuzhiyun 	writel(0x0, FW_DDR_CON_REG);
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 	if (soc_is_px30s()) {
207*4882a593Smuzhiyun 		/* set the emmc data(GPIO1A0-A7) drive strength to 14.2ma */
208*4882a593Smuzhiyun 		writel(0xFFFF0000, GRF_BASE + GRF_GPIO1A_DS2);
209*4882a593Smuzhiyun 		writel(0xFFFFFFFF, GRF_BASE + GRF_GPIO1A_E);
210*4882a593Smuzhiyun 		/* set the emmc clock(GPIO1B1) drive strength to 23.7ma */
211*4882a593Smuzhiyun 		/* set the emmc cmd(GPIO1B2) drive strength to 14.2ma */
212*4882a593Smuzhiyun 		writel(0x00060002, GRF_BASE + GRF_GPIO1B_DS2);
213*4882a593Smuzhiyun 		writel(0x003C0038, GRF_BASE + GRF_GPIO1B_E);
214*4882a593Smuzhiyun 	}
215*4882a593Smuzhiyun #endif
216*4882a593Smuzhiyun 	/* Enable PD_VO (default disable at reset) */
217*4882a593Smuzhiyun 	rk_clrreg(PMU_PWRDN_CON, 1 << 13);
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun #ifdef CONFIG_SPL_BUILD
220*4882a593Smuzhiyun 	/* Set cpu qos priority */
221*4882a593Smuzhiyun 	writel(QOS_PRIORITY_LEVEL(1, 1), SERVICE_CORE_ADDR + QOS_PRIORITY);
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun #if !defined(CONFIG_DEBUG_UART_BOARD_INIT) || \
224*4882a593Smuzhiyun     (CONFIG_DEBUG_UART_BASE != 0xff160000) || \
225*4882a593Smuzhiyun     (CONFIG_DEBUG_UART_CHANNEL != 0)
226*4882a593Smuzhiyun 	static struct px30_grf * const grf = (void *)GRF_BASE;
227*4882a593Smuzhiyun 	/* fix sdmmc pinmux if not using uart2-channel0 as debug uart */
228*4882a593Smuzhiyun 	rk_clrsetreg(&grf->gpio1dl_iomux,
229*4882a593Smuzhiyun 		     GPIO1D3_MASK | GPIO1D2_MASK,
230*4882a593Smuzhiyun 		     GPIO1D3_SDMMC_D1 << GPIO1D3_SHIFT |
231*4882a593Smuzhiyun 		     GPIO1D2_SDMMC_D0 << GPIO1D2_SHIFT);
232*4882a593Smuzhiyun 	rk_clrsetreg(&grf->gpio1dh_iomux,
233*4882a593Smuzhiyun 		     GPIO1D7_MASK | GPIO1D6_MASK | GPIO1D5_MASK | GPIO1D4_MASK,
234*4882a593Smuzhiyun 		     GPIO1D7_SDMMC_CMD << GPIO1D7_SHIFT |
235*4882a593Smuzhiyun 		     GPIO1D6_SDMMC_CLK << GPIO1D6_SHIFT |
236*4882a593Smuzhiyun 		     GPIO1D5_SDMMC_D3 << GPIO1D5_SHIFT |
237*4882a593Smuzhiyun 		     GPIO1D4_SDMMC_D2 << GPIO1D4_SHIFT);
238*4882a593Smuzhiyun #endif
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun #endif
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun 	/* Enable PD_VO (default disable at reset) */
243*4882a593Smuzhiyun 	rk_clrreg(PMU_PWRDN_CON, 1 << 13);
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun 	/* Disable video phy bandgap by default */
246*4882a593Smuzhiyun 	writel(0x82, VIDEO_PHY_BASE + 0x0000);
247*4882a593Smuzhiyun 	writel(0x05, VIDEO_PHY_BASE + 0x03ac);
248*4882a593Smuzhiyun 
249*4882a593Smuzhiyun 	/* Clear the force_jtag */
250*4882a593Smuzhiyun 	rk_clrreg(GRF_CPU_CON1, 1 << 7);
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	grf_vccio6_vsel_init();
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	if (soc_is_px30s()) {
255*4882a593Smuzhiyun 		/* set usb2phy parameter */
256*4882a593Smuzhiyun 		writel(0x04, USBPHY_GRF_BASE + 0x8000);
257*4882a593Smuzhiyun 		writel(0x46, USBPHY_GRF_BASE + 0x8004);
258*4882a593Smuzhiyun 		writel(0xdb, USBPHY_GRF_BASE + 0x8008);
259*4882a593Smuzhiyun 		writel(0x04, USBPHY_GRF_BASE + 0x8400);
260*4882a593Smuzhiyun 		writel(0x46, USBPHY_GRF_BASE + 0x8404);
261*4882a593Smuzhiyun 		writel(0xdb, USBPHY_GRF_BASE + 0x8408);
262*4882a593Smuzhiyun 	}
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	return 0;
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun #define GRF_BASE		0xff140000
268*4882a593Smuzhiyun #define UART2_BASE		0xff160000
269*4882a593Smuzhiyun #define CRU_BASE		0xff2b0000
board_debug_uart_init(void)270*4882a593Smuzhiyun void board_debug_uart_init(void)
271*4882a593Smuzhiyun {
272*4882a593Smuzhiyun 	static struct px30_grf * const grf = (void *)GRF_BASE;
273*4882a593Smuzhiyun 	static struct px30_cru * const cru = (void *)CRU_BASE;
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun #if defined(CONFIG_DEBUG_UART_BASE) && (CONFIG_DEBUG_UART_BASE == 0xff158000)
276*4882a593Smuzhiyun 	/* uart_sel_clk default select 24MHz */
277*4882a593Smuzhiyun 	rk_clrsetreg(&cru->clksel_con[34],
278*4882a593Smuzhiyun 		     UART1_PLL_SEL_MASK | UART1_DIV_CON_MASK,
279*4882a593Smuzhiyun 		     UART1_PLL_SEL_24M << UART1_PLL_SEL_SHIFT | 0);
280*4882a593Smuzhiyun 	rk_clrsetreg(&cru->clksel_con[35],
281*4882a593Smuzhiyun 		     UART1_CLK_SEL_MASK,
282*4882a593Smuzhiyun 		     UART1_CLK_SEL_UART1 << UART1_CLK_SEL_SHIFT);
283*4882a593Smuzhiyun 
284*4882a593Smuzhiyun 	rk_clrsetreg(&grf->gpio1cl_iomux,
285*4882a593Smuzhiyun 		     GPIO1C1_MASK | GPIO1C0_MASK,
286*4882a593Smuzhiyun 		     GPIO1C1_UART1_TX << GPIO1C1_SHIFT |
287*4882a593Smuzhiyun 		     GPIO1C0_UART1_RX << GPIO1C0_SHIFT);
288*4882a593Smuzhiyun #elif defined(CONFIG_DEBUG_UART_BASE) && (CONFIG_DEBUG_UART_BASE == 0xff178000)
289*4882a593Smuzhiyun 	/* uart_sel_clk default select 24MHz */
290*4882a593Smuzhiyun 	rk_clrsetreg(&cru->clksel_con[46],
291*4882a593Smuzhiyun 		     UART5_PLL_SEL_MASK | UART5_DIV_CON_MASK,
292*4882a593Smuzhiyun 		     UART5_PLL_SEL_24M << UART5_PLL_SEL_SHIFT | 0);
293*4882a593Smuzhiyun 	rk_clrsetreg(&cru->clksel_con[47],
294*4882a593Smuzhiyun 		     UART5_CLK_SEL_MASK,
295*4882a593Smuzhiyun 		     UART5_CLK_SEL_UART5 << UART5_CLK_SEL_SHIFT);
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	rk_clrsetreg(&grf->gpio3al_iomux,
298*4882a593Smuzhiyun 		     GPIO3A2_MASK | GPIO3A1_MASK,
299*4882a593Smuzhiyun 		     GPIO3A2_UART5_TX << GPIO3A2_SHIFT |
300*4882a593Smuzhiyun 		     GPIO3A1_UART5_RX << GPIO3A1_SHIFT);
301*4882a593Smuzhiyun #else
302*4882a593Smuzhiyun 	/* GRF_IOFUNC_CON0 */
303*4882a593Smuzhiyun 	enum {
304*4882a593Smuzhiyun 		CON_IOMUX_UART2SEL_SHIFT	= 10,
305*4882a593Smuzhiyun 		CON_IOMUX_UART2SEL_MASK = 3 << CON_IOMUX_UART2SEL_SHIFT,
306*4882a593Smuzhiyun 		CON_IOMUX_UART2SEL_M0	= 0,
307*4882a593Smuzhiyun 		CON_IOMUX_UART2SEL_M1,
308*4882a593Smuzhiyun 		CON_IOMUX_UART2SEL_USBPHY,
309*4882a593Smuzhiyun 	};
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	/* uart_sel_clk default select 24MHz */
312*4882a593Smuzhiyun 	rk_clrsetreg(&cru->clksel_con[37],
313*4882a593Smuzhiyun 		     UART2_PLL_SEL_MASK | UART2_DIV_CON_MASK,
314*4882a593Smuzhiyun 		     UART2_PLL_SEL_24M << UART2_PLL_SEL_SHIFT | 0);
315*4882a593Smuzhiyun 	rk_clrsetreg(&cru->clksel_con[38],
316*4882a593Smuzhiyun 		     UART2_CLK_SEL_MASK,
317*4882a593Smuzhiyun 		     UART2_CLK_SEL_UART2 << UART2_CLK_SEL_SHIFT);
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun #if (CONFIG_DEBUG_UART2_CHANNEL == 1)
320*4882a593Smuzhiyun 	/* Enable early UART2 */
321*4882a593Smuzhiyun 	rk_clrsetreg(&grf->iofunc_con0,
322*4882a593Smuzhiyun 		     CON_IOMUX_UART2SEL_MASK,
323*4882a593Smuzhiyun 		     CON_IOMUX_UART2SEL_M1 << CON_IOMUX_UART2SEL_SHIFT);
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	/*
326*4882a593Smuzhiyun 	 * Set iomux to UART2_M0 and UART2_M1.
327*4882a593Smuzhiyun 	 * Because uart2_rxm0 and uart2_txm0 are default reset value,
328*4882a593Smuzhiyun 	 * so only need set uart2_rxm1 and uart2_txm1 here.
329*4882a593Smuzhiyun 	 */
330*4882a593Smuzhiyun 	rk_clrsetreg(&grf->gpio2bh_iomux,
331*4882a593Smuzhiyun 		     GPIO2B6_MASK | GPIO2B4_MASK,
332*4882a593Smuzhiyun 		     GPIO2B6_UART2_RXM1 << GPIO2B6_SHIFT |
333*4882a593Smuzhiyun 		     GPIO2B4_UART2_TXM1 << GPIO2B4_SHIFT);
334*4882a593Smuzhiyun #else
335*4882a593Smuzhiyun 	rk_clrsetreg(&grf->iofunc_con0,
336*4882a593Smuzhiyun 		     CON_IOMUX_UART2SEL_MASK,
337*4882a593Smuzhiyun 		     CON_IOMUX_UART2SEL_M0 << CON_IOMUX_UART2SEL_SHIFT);
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	rk_clrsetreg(&grf->gpio1dl_iomux,
340*4882a593Smuzhiyun 		     GPIO1D3_MASK | GPIO1D2_MASK,
341*4882a593Smuzhiyun 		     GPIO1D3_UART2_RXM0 << GPIO1D3_SHIFT |
342*4882a593Smuzhiyun 		     GPIO1D2_UART2_TXM0 << GPIO1D2_SHIFT);
343*4882a593Smuzhiyun #endif /* CONFIG_DEBUG_UART2_CHANNEL == 1 */
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun #endif /* CONFIG_DEBUG_UART_BASE && CONFIG_DEBUG_UART_BASE == ... */
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun 
set_armclk_rate(void)348*4882a593Smuzhiyun int set_armclk_rate(void)
349*4882a593Smuzhiyun {
350*4882a593Smuzhiyun 	struct px30_clk_priv *priv;
351*4882a593Smuzhiyun 	struct clk clk;
352*4882a593Smuzhiyun 	int ret;
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	ret = rockchip_get_clk(&clk.dev);
355*4882a593Smuzhiyun 	if (ret) {
356*4882a593Smuzhiyun 		printf("Failed to get clk dev\n");
357*4882a593Smuzhiyun 		return ret;
358*4882a593Smuzhiyun 	}
359*4882a593Smuzhiyun 	clk.id = ARMCLK;
360*4882a593Smuzhiyun 	priv = dev_get_priv(clk.dev);
361*4882a593Smuzhiyun 	ret = clk_set_rate(&clk, priv->armclk_hz);
362*4882a593Smuzhiyun 	if (ret < 0) {
363*4882a593Smuzhiyun 		printf("Failed to set armclk %lu\n", priv->armclk_hz);
364*4882a593Smuzhiyun 		return ret;
365*4882a593Smuzhiyun 	}
366*4882a593Smuzhiyun 	priv->set_armclk_rate = true;
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 	return 0;
369*4882a593Smuzhiyun }
370*4882a593Smuzhiyun 
fdt_fixup_cpu_opp_table(const void * blob)371*4882a593Smuzhiyun static int fdt_fixup_cpu_opp_table(const void *blob)
372*4882a593Smuzhiyun {
373*4882a593Smuzhiyun 	int opp_node, cpu_node, sub_node;
374*4882a593Smuzhiyun 	int len;
375*4882a593Smuzhiyun 	u32 phandle;
376*4882a593Smuzhiyun 	u32 *pp;
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 	/* Replace opp table */
379*4882a593Smuzhiyun 	opp_node = fdt_path_offset(blob, "/px30s-cpu0-opp-table");
380*4882a593Smuzhiyun 	if (opp_node < 0) {
381*4882a593Smuzhiyun 		printf("Failed to get px30s-cpu0-opp-table node\n");
382*4882a593Smuzhiyun 		return -EINVAL;
383*4882a593Smuzhiyun 	}
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	phandle = fdt_get_phandle(blob, opp_node);
386*4882a593Smuzhiyun 	if (!phandle) {
387*4882a593Smuzhiyun 		printf("Failed to get cpu opp table phandle\n");
388*4882a593Smuzhiyun 		return -EINVAL;
389*4882a593Smuzhiyun 	}
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	cpu_node = fdt_path_offset(blob, "/cpus");
392*4882a593Smuzhiyun 	if (cpu_node < 0) {
393*4882a593Smuzhiyun 		printf("Failed to get cpus node\n");
394*4882a593Smuzhiyun 		return -EINVAL;
395*4882a593Smuzhiyun 	}
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 	fdt_for_each_subnode(sub_node, blob, cpu_node) {
398*4882a593Smuzhiyun 		pp = (u32 *)fdt_getprop(blob, sub_node, "operating-points-v2",
399*4882a593Smuzhiyun 					&len);
400*4882a593Smuzhiyun 		if (!pp)
401*4882a593Smuzhiyun 			continue;
402*4882a593Smuzhiyun 		pp[0] = cpu_to_fdt32(phandle);
403*4882a593Smuzhiyun 	}
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun 	return 0;
406*4882a593Smuzhiyun }
407*4882a593Smuzhiyun 
fdt_fixup_dmc_opp_table(const void * blob)408*4882a593Smuzhiyun static int fdt_fixup_dmc_opp_table(const void *blob)
409*4882a593Smuzhiyun {
410*4882a593Smuzhiyun 	int opp_node, dmc_node;
411*4882a593Smuzhiyun 	int len;
412*4882a593Smuzhiyun 	u32 phandle;
413*4882a593Smuzhiyun 	u32 *pp;
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 	opp_node = fdt_path_offset(blob, "/px30s-dmc-opp-table");
416*4882a593Smuzhiyun 	if (opp_node < 0) {
417*4882a593Smuzhiyun 		printf("Failed to get px30s-dmc-opp-table node\n");
418*4882a593Smuzhiyun 		return -EINVAL;
419*4882a593Smuzhiyun 	}
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	phandle = fdt_get_phandle(blob, opp_node);
422*4882a593Smuzhiyun 	if (!phandle) {
423*4882a593Smuzhiyun 		printf("Failed to get dmc opp table phandle\n");
424*4882a593Smuzhiyun 		return -EINVAL;
425*4882a593Smuzhiyun 	}
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	dmc_node = fdt_path_offset(blob, "/dmc");
428*4882a593Smuzhiyun 	if (dmc_node < 0) {
429*4882a593Smuzhiyun 		printf("Failed to get dmc node\n");
430*4882a593Smuzhiyun 		return -EINVAL;
431*4882a593Smuzhiyun 	}
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	pp = (u32 *)fdt_getprop(blob, dmc_node, "operating-points-v2", &len);
434*4882a593Smuzhiyun 	if (!pp)
435*4882a593Smuzhiyun 		return 0;
436*4882a593Smuzhiyun 	pp[0] = cpu_to_fdt32(phandle);
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 	return 0;
439*4882a593Smuzhiyun }
440*4882a593Smuzhiyun 
fdt_fixup_gpu_opp_table(const void * blob)441*4882a593Smuzhiyun static int fdt_fixup_gpu_opp_table(const void *blob)
442*4882a593Smuzhiyun {
443*4882a593Smuzhiyun 	int opp_node, gpu_node;
444*4882a593Smuzhiyun 	int len;
445*4882a593Smuzhiyun 	u32 phandle;
446*4882a593Smuzhiyun 	u32 *pp;
447*4882a593Smuzhiyun 
448*4882a593Smuzhiyun 	opp_node = fdt_path_offset(blob, "/px30s-gpu-opp-table");
449*4882a593Smuzhiyun 	if (opp_node < 0) {
450*4882a593Smuzhiyun 		printf("Failed to get px30s-gpu-opp-table node\n");
451*4882a593Smuzhiyun 		return -EINVAL;
452*4882a593Smuzhiyun 	}
453*4882a593Smuzhiyun 
454*4882a593Smuzhiyun 	phandle = fdt_get_phandle(blob, opp_node);
455*4882a593Smuzhiyun 	if (!phandle) {
456*4882a593Smuzhiyun 		printf("Failed to get gpu opp table phandle\n");
457*4882a593Smuzhiyun 		return -EINVAL;
458*4882a593Smuzhiyun 	}
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	gpu_node = fdt_path_offset(blob, "/gpu@ff400000");
461*4882a593Smuzhiyun 	if (gpu_node < 0) {
462*4882a593Smuzhiyun 		printf("Failed to get gpu node\n");
463*4882a593Smuzhiyun 		return -EINVAL;
464*4882a593Smuzhiyun 	}
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	pp = (u32 *)fdt_getprop(blob, gpu_node, "operating-points-v2", &len);
467*4882a593Smuzhiyun 	if (!pp)
468*4882a593Smuzhiyun 		return 0;
469*4882a593Smuzhiyun 	pp[0] = cpu_to_fdt32(phandle);
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	return 0;
472*4882a593Smuzhiyun }
473*4882a593Smuzhiyun 
fixup_pcfg_drive_strength(const void * blob,int noffset)474*4882a593Smuzhiyun static void fixup_pcfg_drive_strength(const void *blob, int noffset)
475*4882a593Smuzhiyun {
476*4882a593Smuzhiyun 	u32 *ds, *dss;
477*4882a593Smuzhiyun 	u32 val;
478*4882a593Smuzhiyun 
479*4882a593Smuzhiyun 	dss = (u32 *)fdt_getprop(blob, noffset, "drive-strength-s", NULL);
480*4882a593Smuzhiyun 	if (!dss)
481*4882a593Smuzhiyun 		return;
482*4882a593Smuzhiyun 
483*4882a593Smuzhiyun 	val = dss[0];
484*4882a593Smuzhiyun 	ds = (u32 *)fdt_getprop(blob, noffset, "drive-strength", NULL);
485*4882a593Smuzhiyun 	if (ds) {
486*4882a593Smuzhiyun 		ds[0] = val;
487*4882a593Smuzhiyun 	} else {
488*4882a593Smuzhiyun 		if (fdt_setprop((void *)blob, noffset,
489*4882a593Smuzhiyun 				"drive-strength", &val, 4) < 0)
490*4882a593Smuzhiyun 			printf("Failed to add drive-strength prop\n");
491*4882a593Smuzhiyun 	}
492*4882a593Smuzhiyun }
493*4882a593Smuzhiyun 
fdt_fixup_pcfg(const void * blob)494*4882a593Smuzhiyun static int fdt_fixup_pcfg(const void *blob)
495*4882a593Smuzhiyun {
496*4882a593Smuzhiyun 	int depth1_node;
497*4882a593Smuzhiyun 	int depth2_node;
498*4882a593Smuzhiyun 	int root_node;
499*4882a593Smuzhiyun 
500*4882a593Smuzhiyun 	root_node = fdt_path_offset(blob, "/");
501*4882a593Smuzhiyun 	if (root_node < 0)
502*4882a593Smuzhiyun 		return root_node;
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	fdt_for_each_subnode(depth1_node, blob, root_node) {
505*4882a593Smuzhiyun 		debug("depth1: %s\n", fdt_get_name(blob, depth1_node, NULL));
506*4882a593Smuzhiyun 		fixup_pcfg_drive_strength(blob, depth1_node);
507*4882a593Smuzhiyun 		fdt_for_each_subnode(depth2_node, blob, depth1_node) {
508*4882a593Smuzhiyun 			debug("    depth2: %s\n",
509*4882a593Smuzhiyun 			      fdt_get_name(blob, depth2_node, NULL));
510*4882a593Smuzhiyun 			fixup_pcfg_drive_strength(blob, depth2_node);
511*4882a593Smuzhiyun 		}
512*4882a593Smuzhiyun 	}
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun 	return 0;
515*4882a593Smuzhiyun }
516*4882a593Smuzhiyun 
fdt_fixup_bus_apll(const void * blob)517*4882a593Smuzhiyun static int fdt_fixup_bus_apll(const void *blob)
518*4882a593Smuzhiyun {
519*4882a593Smuzhiyun 	char path[] = "/bus-apll";
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	do_fixup_by_path((void *)blob, path, "status", "disabled", sizeof("disabled"), 0);
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun 	return 0;
524*4882a593Smuzhiyun }
525*4882a593Smuzhiyun 
fdt_fixup_cpu_gpu_clk(const void * blob)526*4882a593Smuzhiyun static int fdt_fixup_cpu_gpu_clk(const void *blob)
527*4882a593Smuzhiyun {
528*4882a593Smuzhiyun 	int cpu_node, gpu_node, scmi_clk_node;
529*4882a593Smuzhiyun 	int len;
530*4882a593Smuzhiyun 	u32 phandle;
531*4882a593Smuzhiyun 	u32 *pp;
532*4882a593Smuzhiyun 
533*4882a593Smuzhiyun 	scmi_clk_node = fdt_path_offset(blob, "/firmware/scmi/protocol@14");
534*4882a593Smuzhiyun 	if (scmi_clk_node < 0) {
535*4882a593Smuzhiyun 		printf("Failed to get px30s scmi clk node\n");
536*4882a593Smuzhiyun 		return -EINVAL;
537*4882a593Smuzhiyun 	}
538*4882a593Smuzhiyun 
539*4882a593Smuzhiyun 	phandle = fdt_get_phandle(blob, scmi_clk_node);
540*4882a593Smuzhiyun 	if (!phandle)
541*4882a593Smuzhiyun 		return 0;
542*4882a593Smuzhiyun 
543*4882a593Smuzhiyun 	cpu_node = fdt_path_offset(blob, "/cpus/cpu@0");
544*4882a593Smuzhiyun 	if (cpu_node < 0) {
545*4882a593Smuzhiyun 		printf("Failed to get px30s cpu node\n");
546*4882a593Smuzhiyun 		return -EINVAL;
547*4882a593Smuzhiyun 	}
548*4882a593Smuzhiyun 	/*
549*4882a593Smuzhiyun 	 * before fixed:
550*4882a593Smuzhiyun 	 *	clocks = <&cru ARMCLK>;
551*4882a593Smuzhiyun 	 * after fixed:
552*4882a593Smuzhiyun 	 *	clocks = <&scmi_clk 0>;
553*4882a593Smuzhiyun 	 */
554*4882a593Smuzhiyun 	pp = (u32 *)fdt_getprop(blob, cpu_node,
555*4882a593Smuzhiyun 				"clocks",
556*4882a593Smuzhiyun 				&len);
557*4882a593Smuzhiyun 	if (!pp)
558*4882a593Smuzhiyun 		return 0;
559*4882a593Smuzhiyun 	if ((len / 8) >= 1) {
560*4882a593Smuzhiyun 		pp[0] = cpu_to_fdt32(phandle);
561*4882a593Smuzhiyun 		pp[1] = cpu_to_fdt32(0);
562*4882a593Smuzhiyun 	}
563*4882a593Smuzhiyun 
564*4882a593Smuzhiyun 	gpu_node = fdt_path_offset(blob, "/gpu@ff400000");
565*4882a593Smuzhiyun 	if (gpu_node < 0) {
566*4882a593Smuzhiyun 		printf("Failed to get px30s gpu node\n");
567*4882a593Smuzhiyun 		return -EINVAL;
568*4882a593Smuzhiyun 	}
569*4882a593Smuzhiyun 	/*
570*4882a593Smuzhiyun 	 * before fixed:
571*4882a593Smuzhiyun 	 *	clocks = <&cru SCLK_GPU>;
572*4882a593Smuzhiyun 	 * after fixed:
573*4882a593Smuzhiyun 	 *	clocks = <&scmi_clk 1>;
574*4882a593Smuzhiyun 	 */
575*4882a593Smuzhiyun 	pp = (u32 *)fdt_getprop(blob, gpu_node,
576*4882a593Smuzhiyun 				"clocks",
577*4882a593Smuzhiyun 				&len);
578*4882a593Smuzhiyun 	if (!pp)
579*4882a593Smuzhiyun 		return 0;
580*4882a593Smuzhiyun 	if ((len / 8) >= 1) {
581*4882a593Smuzhiyun 		pp[0] = cpu_to_fdt32(phandle);
582*4882a593Smuzhiyun 		pp[1] = cpu_to_fdt32(1);
583*4882a593Smuzhiyun 	}
584*4882a593Smuzhiyun 	return 0;
585*4882a593Smuzhiyun }
586*4882a593Smuzhiyun 
fdt_fixup_i2s_soft_reset(const void * blob)587*4882a593Smuzhiyun static int fdt_fixup_i2s_soft_reset(const void *blob)
588*4882a593Smuzhiyun {
589*4882a593Smuzhiyun 	int node;
590*4882a593Smuzhiyun 	int len;
591*4882a593Smuzhiyun 	u32 *pp;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	node = fdt_path_offset(blob, "/i2s@ff060000");
594*4882a593Smuzhiyun 	if (node < 0) {
595*4882a593Smuzhiyun 		printf("Failed to get px30s i2s node\n");
596*4882a593Smuzhiyun 		return -EINVAL;
597*4882a593Smuzhiyun 	}
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 	/*
600*4882a593Smuzhiyun 	 * before fixed:
601*4882a593Smuzhiyun 	 *	resets = <&cru SRST_I2S0_TX>, <&cru SRST_I2S0_RX>;
602*4882a593Smuzhiyun 	 * after fixed:
603*4882a593Smuzhiyun 	 *	resets = <&cru SRST_I2S0_TX>, <&cru 128>;
604*4882a593Smuzhiyun 	 */
605*4882a593Smuzhiyun 	pp = (u32 *)fdt_getprop(blob, node,
606*4882a593Smuzhiyun 				"resets",
607*4882a593Smuzhiyun 				&len);
608*4882a593Smuzhiyun 	if (!pp)
609*4882a593Smuzhiyun 		return 0;
610*4882a593Smuzhiyun 	if ((len / 8) >= 2)
611*4882a593Smuzhiyun 		pp[3] = cpu_to_fdt32(128);
612*4882a593Smuzhiyun 
613*4882a593Smuzhiyun 	return 0;
614*4882a593Smuzhiyun }
615*4882a593Smuzhiyun 
616*4882a593Smuzhiyun #define RKPM_SLP_ARMPD			BIT(0)
617*4882a593Smuzhiyun #define RKPM_SLP_ARMOFF			BIT(1)
618*4882a593Smuzhiyun #define RKPM_SLP_ARMOFF_DDRPD		BIT(2)
619*4882a593Smuzhiyun #define RKPM_SLP_ARMOFF_LOGOFF		BIT(3)
620*4882a593Smuzhiyun 
fdt_fixup_rockchip_suspend(const void * blob)621*4882a593Smuzhiyun static int fdt_fixup_rockchip_suspend(const void *blob)
622*4882a593Smuzhiyun {
623*4882a593Smuzhiyun 	int suspend_node;
624*4882a593Smuzhiyun 	u32 *data, mode;
625*4882a593Smuzhiyun 
626*4882a593Smuzhiyun 	/* Replace opp table */
627*4882a593Smuzhiyun 	suspend_node = fdt_path_offset(blob, "/rockchip-suspend");
628*4882a593Smuzhiyun 	if (suspend_node < 0) {
629*4882a593Smuzhiyun 		printf("Failed to get rockchip-suspend node\n");
630*4882a593Smuzhiyun 		return -EINVAL;
631*4882a593Smuzhiyun 	}
632*4882a593Smuzhiyun 
633*4882a593Smuzhiyun 	data = (u32 *)fdt_getprop(blob, suspend_node,
634*4882a593Smuzhiyun 				 "rockchip,sleep-mode-config", NULL);
635*4882a593Smuzhiyun 	if (!data)
636*4882a593Smuzhiyun 		return 0;
637*4882a593Smuzhiyun 
638*4882a593Smuzhiyun 	mode = fdt32_to_cpu(*data);
639*4882a593Smuzhiyun 	mode &= ~RKPM_SLP_ARMOFF_LOGOFF;
640*4882a593Smuzhiyun 	mode |= RKPM_SLP_ARMOFF;
641*4882a593Smuzhiyun 	*data = cpu_to_fdt32(mode);
642*4882a593Smuzhiyun 
643*4882a593Smuzhiyun 	if (fdt_setprop((void *)blob, suspend_node,
644*4882a593Smuzhiyun 			"rockchip,sleep-mode-config", data, sizeof(*data)))
645*4882a593Smuzhiyun 		printf("Failed to set rockchip,sleep-mode-config = 0x%x\n", mode);
646*4882a593Smuzhiyun 	else
647*4882a593Smuzhiyun 		debug("set rockchip,sleep-mode-config = 0x%x\n", mode);
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	return 0;
650*4882a593Smuzhiyun }
651*4882a593Smuzhiyun 
fixup_regulators_px30s(const void * blob,int reg_node)652*4882a593Smuzhiyun static void fixup_regulators_px30s(const void *blob, int reg_node)
653*4882a593Smuzhiyun {
654*4882a593Smuzhiyun 	const char *name;
655*4882a593Smuzhiyun 	int mem_node;
656*4882a593Smuzhiyun 	int suspend;
657*4882a593Smuzhiyun 	u32 *min, *max;
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 	min = (u32 *)fdt_getprop(blob, reg_node,
660*4882a593Smuzhiyun 				 "regulator-min-microvolt", NULL);
661*4882a593Smuzhiyun 	max = (u32 *)fdt_getprop(blob, reg_node,
662*4882a593Smuzhiyun 				 "regulator-max-microvolt", NULL);
663*4882a593Smuzhiyun 	if (!min || !max)
664*4882a593Smuzhiyun 		return;
665*4882a593Smuzhiyun 
666*4882a593Smuzhiyun 	name = fdt_getprop(blob, reg_node, "regulator-name", NULL);
667*4882a593Smuzhiyun 
668*4882a593Smuzhiyun 	debug("%s: name: %s, min %duV, max %duV\n",
669*4882a593Smuzhiyun 	      name, fdt_get_name(blob, reg_node, NULL),
670*4882a593Smuzhiyun 	      fdt32_to_cpu(min[0]), fdt32_to_cpu(max[0]));
671*4882a593Smuzhiyun 
672*4882a593Smuzhiyun 	/* 1. fixed volt: 1.0v => 0.9v */
673*4882a593Smuzhiyun 	if (*min == *max && fdt32_to_cpu(min[0]) == 1000000) {
674*4882a593Smuzhiyun 		mem_node = fdt_subnode_offset(blob, reg_node,
675*4882a593Smuzhiyun 					      "regulator-state-mem");
676*4882a593Smuzhiyun 		if (mem_node < 0)
677*4882a593Smuzhiyun 			return;
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 		suspend = cpu_to_fdt32(900000);
680*4882a593Smuzhiyun 		if (fdt_setprop((void *)blob, mem_node,
681*4882a593Smuzhiyun 				"regulator-suspend-microvolt",
682*4882a593Smuzhiyun 				&suspend, sizeof(suspend)))
683*4882a593Smuzhiyun 			printf("Failed to set %s suspend 0.9V\n", name);
684*4882a593Smuzhiyun 		else
685*4882a593Smuzhiyun 			debug("%s: set suspend volt 0.9V\n", name);
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 		min[0] = cpu_to_fdt32(900000);
688*4882a593Smuzhiyun 		max[0] = cpu_to_fdt32(900000);
689*4882a593Smuzhiyun 		debug("%s: min/max 1.0v => 0.9v\n",
690*4882a593Smuzhiyun 		      fdt_get_name(blob, reg_node, NULL));
691*4882a593Smuzhiyun 	}
692*4882a593Smuzhiyun 
693*4882a593Smuzhiyun 	/* 2. vdd_logic suspend: any => 0.85v */
694*4882a593Smuzhiyun 	if (!strcmp(name, "vdd_logic")) {
695*4882a593Smuzhiyun 		mem_node = fdt_subnode_offset(blob, reg_node,
696*4882a593Smuzhiyun 					      "regulator-state-mem");
697*4882a593Smuzhiyun 		if (mem_node < 0)
698*4882a593Smuzhiyun 			return;
699*4882a593Smuzhiyun 
700*4882a593Smuzhiyun 		suspend = cpu_to_fdt32(850000);
701*4882a593Smuzhiyun 		if (fdt_setprop((void *)blob, mem_node,
702*4882a593Smuzhiyun 				"regulator-suspend-microvolt",
703*4882a593Smuzhiyun 				&suspend, sizeof(suspend)))
704*4882a593Smuzhiyun 			printf("Failed to set vdd_logic suspend 0.85V\n");
705*4882a593Smuzhiyun 		else
706*4882a593Smuzhiyun 			debug("vdd_logic: set suspend volt 0.85V\n");
707*4882a593Smuzhiyun 	}
708*4882a593Smuzhiyun }
709*4882a593Smuzhiyun 
fixup_regulators_px30(const void * blob,int reg_node)710*4882a593Smuzhiyun static void fixup_regulators_px30(const void *blob, int reg_node)
711*4882a593Smuzhiyun {
712*4882a593Smuzhiyun 	const char *name;
713*4882a593Smuzhiyun 	int mem_node;
714*4882a593Smuzhiyun 
715*4882a593Smuzhiyun 	name = fdt_getprop(blob, reg_node, "regulator-name", NULL);
716*4882a593Smuzhiyun 	if (!name)
717*4882a593Smuzhiyun 		return;
718*4882a593Smuzhiyun 
719*4882a593Smuzhiyun 	/* regulator-off-in-suspend => regulator-on-in-suspend */
720*4882a593Smuzhiyun 	if (!strcmp(name, "vdd_logic") ||
721*4882a593Smuzhiyun 	    !strcmp(name, "vcc_3v0") ||
722*4882a593Smuzhiyun 	    !strcmp(name, "vcc_1v0") ||
723*4882a593Smuzhiyun 	    !strcmp(name, "vccio_sd") ||
724*4882a593Smuzhiyun 	    !strcmp(name, "vcc_sd")) {
725*4882a593Smuzhiyun 		mem_node = fdt_subnode_offset(blob, reg_node,
726*4882a593Smuzhiyun 					      "regulator-state-mem");
727*4882a593Smuzhiyun 		if (mem_node < 0)
728*4882a593Smuzhiyun 			return;
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 		fdt_delprop((void *)blob, mem_node, "regulator-off-in-suspend");
731*4882a593Smuzhiyun 		if (fdt_setprop((void *)blob, mem_node,
732*4882a593Smuzhiyun 				"regulator-on-in-suspend", NULL, 0))
733*4882a593Smuzhiyun 			printf("Failed to set regulator(%s) on in suspend\n", name);
734*4882a593Smuzhiyun 		else
735*4882a593Smuzhiyun 			debug("set regulator(%s) on in suspend\n", name);
736*4882a593Smuzhiyun 	}
737*4882a593Smuzhiyun }
738*4882a593Smuzhiyun 
fixup_regulators(const void * blob,int pmic_node)739*4882a593Smuzhiyun static void fixup_regulators(const void *blob, int pmic_node)
740*4882a593Smuzhiyun {
741*4882a593Smuzhiyun 	int parent_node;
742*4882a593Smuzhiyun 	int reg_node;
743*4882a593Smuzhiyun 
744*4882a593Smuzhiyun 	parent_node = fdt_subnode_offset(blob, pmic_node, "regulators");
745*4882a593Smuzhiyun 	if (parent_node < 0)
746*4882a593Smuzhiyun 		return;
747*4882a593Smuzhiyun 
748*4882a593Smuzhiyun 	fdt_for_each_subnode(reg_node, blob, parent_node) {
749*4882a593Smuzhiyun 		if (soc_is_px30s())
750*4882a593Smuzhiyun 			fixup_regulators_px30s(blob, reg_node);
751*4882a593Smuzhiyun 		else if (soc_is_px30())
752*4882a593Smuzhiyun 			fixup_regulators_px30(blob, reg_node);
753*4882a593Smuzhiyun 	}
754*4882a593Smuzhiyun }
755*4882a593Smuzhiyun 
756*4882a593Smuzhiyun /* Assume that: all regulators are from rk809/817 */
fdt_fixup_regulator(const void * blob)757*4882a593Smuzhiyun static int fdt_fixup_regulator(const void *blob)
758*4882a593Smuzhiyun {
759*4882a593Smuzhiyun 	const char *name;
760*4882a593Smuzhiyun 	int i2c_node;
761*4882a593Smuzhiyun 	int pmic_node;
762*4882a593Smuzhiyun 	int root_node;
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun 	root_node = fdt_path_offset(blob, "/");
765*4882a593Smuzhiyun 	if (root_node < 0)
766*4882a593Smuzhiyun 		return root_node;
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun 	fdt_for_each_subnode(i2c_node, blob, root_node) {
769*4882a593Smuzhiyun 		name = fdt_get_name(blob, i2c_node, NULL);
770*4882a593Smuzhiyun 		debug("depth1: %s\n", name);
771*4882a593Smuzhiyun 		if (!strncmp(name, "i2c@", 4)) {
772*4882a593Smuzhiyun 			fdt_for_each_subnode(pmic_node, blob, i2c_node) {
773*4882a593Smuzhiyun 				name = fdt_get_name(blob, pmic_node, NULL);
774*4882a593Smuzhiyun 				debug("depth2: %s\n", name);
775*4882a593Smuzhiyun 				if (!strncmp(name, "pmic@20", 7)) {
776*4882a593Smuzhiyun 					fixup_regulators(blob, pmic_node);
777*4882a593Smuzhiyun 					return 0;
778*4882a593Smuzhiyun 				}
779*4882a593Smuzhiyun 			}
780*4882a593Smuzhiyun 		}
781*4882a593Smuzhiyun 	}
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun 	return 0;
784*4882a593Smuzhiyun }
785*4882a593Smuzhiyun 
rk_board_fdt_fixup(const void * blob)786*4882a593Smuzhiyun int rk_board_fdt_fixup(const void *blob)
787*4882a593Smuzhiyun {
788*4882a593Smuzhiyun 	if (soc_is_px30s()) {
789*4882a593Smuzhiyun 		fdt_increase_size((void *)blob, SZ_8K);
790*4882a593Smuzhiyun 		fdt_fixup_cpu_opp_table(blob);
791*4882a593Smuzhiyun 		fdt_fixup_dmc_opp_table(blob);
792*4882a593Smuzhiyun 		fdt_fixup_gpu_opp_table(blob);
793*4882a593Smuzhiyun 		fdt_fixup_pcfg(blob);
794*4882a593Smuzhiyun 		fdt_fixup_bus_apll(blob);
795*4882a593Smuzhiyun 		fdt_fixup_cpu_gpu_clk(blob);
796*4882a593Smuzhiyun 		fdt_fixup_i2s_soft_reset(blob);
797*4882a593Smuzhiyun 	} else if (soc_is_px30()) {
798*4882a593Smuzhiyun 		fdt_fixup_rockchip_suspend(blob);
799*4882a593Smuzhiyun 	}
800*4882a593Smuzhiyun 
801*4882a593Smuzhiyun 	fdt_fixup_regulator(blob);
802*4882a593Smuzhiyun 
803*4882a593Smuzhiyun 	return 0;
804*4882a593Smuzhiyun }
805*4882a593Smuzhiyun 
rk_board_early_fdt_fixup(const void * blob)806*4882a593Smuzhiyun int rk_board_early_fdt_fixup(const void *blob)
807*4882a593Smuzhiyun {
808*4882a593Smuzhiyun 	rk_board_fdt_fixup(blob);
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	return 0;
811*4882a593Smuzhiyun }
812*4882a593Smuzhiyun 
do_board_download(void)813*4882a593Smuzhiyun void do_board_download(void)
814*4882a593Smuzhiyun {
815*4882a593Smuzhiyun 	/*
816*4882a593Smuzhiyun 	 * Maskrom download can prevent to flash px30s board with px30
817*4882a593Smuzhiyun 	 * update.img, because px30 ddr.bin can't work on px30s which is
818*4882a593Smuzhiyun 	 * early than download action.
819*4882a593Smuzhiyun 	 *
820*4882a593Smuzhiyun 	 * Let's handle that early than outside generic download.
821*4882a593Smuzhiyun 	 */
822*4882a593Smuzhiyun 	if (soc_is_px30s()) {
823*4882a593Smuzhiyun 		printf("Rockusb is disabled, entering bootrom...\n");
824*4882a593Smuzhiyun 		flushc();
825*4882a593Smuzhiyun 		run_command("rbrom", 0);
826*4882a593Smuzhiyun 	}
827*4882a593Smuzhiyun }
828*4882a593Smuzhiyun 
829*4882a593Smuzhiyun #if !defined(CONFIG_SPL_BUILD) && defined(CONFIG_ROCKCHIP_DMC_FSP)
rk_board_init(void)830*4882a593Smuzhiyun int rk_board_init(void)
831*4882a593Smuzhiyun {
832*4882a593Smuzhiyun 	struct udevice *dev;
833*4882a593Smuzhiyun 	u32 ret = 0;
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 	ret = uclass_get_device_by_driver(UCLASS_DMC, DM_GET_DRIVER(dmc_fsp), &dev);
836*4882a593Smuzhiyun 	if (ret) {
837*4882a593Smuzhiyun 		printf("dmc_fsp failed, ret=%d\n", ret);
838*4882a593Smuzhiyun 		return 0;
839*4882a593Smuzhiyun 	}
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun 	return 0;
842*4882a593Smuzhiyun }
843*4882a593Smuzhiyun #endif
844