xref: /rk3399_ARM-atf/plat/rockchip/rk3399/drivers/soc/soc.c (revision 9901dcf6bb14813bf9ace57ffb51d62f37a1d2fb)
16fba6e04STony Xie /*
26fba6e04STony Xie  * Copyright (c) 2016, ARM Limited and Contributors. All rights reserved.
36fba6e04STony Xie  *
46fba6e04STony Xie  * Redistribution and use in source and binary forms, with or without
56fba6e04STony Xie  * modification, are permitted provided that the following conditions are met:
66fba6e04STony Xie  *
76fba6e04STony Xie  * Redistributions of source code must retain the above copyright notice, this
86fba6e04STony Xie  * list of conditions and the following disclaimer.
96fba6e04STony Xie  *
106fba6e04STony Xie  * Redistributions in binary form must reproduce the above copyright notice,
116fba6e04STony Xie  * this list of conditions and the following disclaimer in the documentation
126fba6e04STony Xie  * and/or other materials provided with the distribution.
136fba6e04STony Xie  *
146fba6e04STony Xie  * Neither the name of ARM nor the names of its contributors may be used
156fba6e04STony Xie  * to endorse or promote products derived from this software without specific
166fba6e04STony Xie  * prior written permission.
176fba6e04STony Xie  *
186fba6e04STony Xie  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
196fba6e04STony Xie  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
206fba6e04STony Xie  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
216fba6e04STony Xie  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
226fba6e04STony Xie  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
236fba6e04STony Xie  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
246fba6e04STony Xie  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
256fba6e04STony Xie  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
266fba6e04STony Xie  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
276fba6e04STony Xie  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
286fba6e04STony Xie  * POSSIBILITY OF SUCH DAMAGE.
296fba6e04STony Xie  */
306fba6e04STony Xie 
316fba6e04STony Xie #include <arch_helpers.h>
326fba6e04STony Xie #include <debug.h>
336fba6e04STony Xie #include <delay_timer.h>
346fba6e04STony Xie #include <mmio.h>
356fba6e04STony Xie #include <platform_def.h>
366fba6e04STony Xie #include <plat_private.h>
376fba6e04STony Xie #include <rk3399_def.h>
386fba6e04STony Xie #include <soc.h>
396fba6e04STony Xie 
406fba6e04STony Xie /* Table of regions to map using the MMU.  */
416fba6e04STony Xie const mmap_region_t plat_rk_mmap[] = {
426fba6e04STony Xie 	MAP_REGION_FLAT(GIC500_BASE, GIC500_SIZE,
436fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_SECURE),
446fba6e04STony Xie 	MAP_REGION_FLAT(CCI500_BASE, CCI500_SIZE,
456fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_SECURE),
466fba6e04STony Xie 	MAP_REGION_FLAT(STIME_BASE, STIME_SIZE,
476fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_SECURE),
486fba6e04STony Xie 	MAP_REGION_FLAT(CRUS_BASE, CRUS_SIZE,
496fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_SECURE),
506fba6e04STony Xie 	MAP_REGION_FLAT(SGRF_BASE, SGRF_SIZE,
516fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_SECURE),
526fba6e04STony Xie 	MAP_REGION_FLAT(PMU_BASE, PMU_SIZE,
536fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_NS),
546fba6e04STony Xie 	MAP_REGION_FLAT(PMUSRAM_BASE, PMUSRAM_SIZE,
556fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_SECURE),
566fba6e04STony Xie 	MAP_REGION_FLAT(RK3399_UART2_BASE, RK3399_UART2_SIZE,
576fba6e04STony Xie 			MT_DEVICE | MT_RW | MT_SECURE),
58f47a25ddSCaesar Wang 	MAP_REGION_FLAT(PMUGRF_BASE, PMUGRF_SIZE,
59f47a25ddSCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
60*9901dcf6SCaesar Wang 	MAP_REGION_FLAT(GPIO0_BASE, GPIO0_SIZE,
61*9901dcf6SCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
62*9901dcf6SCaesar Wang 	MAP_REGION_FLAT(GPIO1_BASE, GPIO1_SIZE,
63*9901dcf6SCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
64*9901dcf6SCaesar Wang 	MAP_REGION_FLAT(GPIO2_BASE, GPIO2_SIZE,
65*9901dcf6SCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
66*9901dcf6SCaesar Wang 	MAP_REGION_FLAT(GPIO3_BASE, GPIO3_SIZE,
67*9901dcf6SCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
68*9901dcf6SCaesar Wang 	MAP_REGION_FLAT(GPIO4_BASE, GPIO4_SIZE,
69*9901dcf6SCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
70*9901dcf6SCaesar Wang 	MAP_REGION_FLAT(GRF_BASE, GRF_SIZE,
71*9901dcf6SCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
726fba6e04STony Xie 	{ 0 }
736fba6e04STony Xie };
746fba6e04STony Xie 
756fba6e04STony Xie /* The RockChip power domain tree descriptor */
766fba6e04STony Xie const unsigned char rockchip_power_domain_tree_desc[] = {
776fba6e04STony Xie 	/* No of root nodes */
786fba6e04STony Xie 	PLATFORM_SYSTEM_COUNT,
796fba6e04STony Xie 	/* No of children for the root node */
806fba6e04STony Xie 	PLATFORM_CLUSTER_COUNT,
816fba6e04STony Xie 	/* No of children for the first cluster node */
826fba6e04STony Xie 	PLATFORM_CLUSTER0_CORE_COUNT,
836fba6e04STony Xie 	/* No of children for the second cluster node */
846fba6e04STony Xie 	PLATFORM_CLUSTER1_CORE_COUNT
856fba6e04STony Xie };
866fba6e04STony Xie 
876fba6e04STony Xie void secure_timer_init(void)
886fba6e04STony Xie {
896fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_END_COUNT0, 0xffffffff);
906fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_END_COUNT1, 0xffffffff);
916fba6e04STony Xie 
926fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_INIT_COUNT0, 0x0);
936fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_INIT_COUNT0, 0x0);
946fba6e04STony Xie 
956fba6e04STony Xie 	/* auto reload & enable the timer */
966fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_CONTROL_REG,
976fba6e04STony Xie 		      TIMER_EN | TIMER_FMODE);
986fba6e04STony Xie }
996fba6e04STony Xie 
1006fba6e04STony Xie void sgrf_init(void)
1016fba6e04STony Xie {
1026fba6e04STony Xie 	/* security config for master */
1036fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SOC_CON3_7(5),
1046fba6e04STony Xie 		      SGRF_SOC_CON_WMSK | SGRF_SOC_ALLMST_NS);
1056fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SOC_CON3_7(6),
1066fba6e04STony Xie 		      SGRF_SOC_CON_WMSK | SGRF_SOC_ALLMST_NS);
1076fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SOC_CON3_7(7),
1086fba6e04STony Xie 		      SGRF_SOC_CON_WMSK | SGRF_SOC_ALLMST_NS);
1096fba6e04STony Xie 
1106fba6e04STony Xie 	/* security config for slave */
1116fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_PMU_SLV_CON0_1(0),
1126fba6e04STony Xie 		      SGRF_PMU_SLV_S_CFGED |
1136fba6e04STony Xie 		      SGRF_PMU_SLV_CRYPTO1_NS);
1146fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_PMU_SLV_CON0_1(1),
1156fba6e04STony Xie 		      SGRF_PMU_SLV_CON1_CFG);
1166fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(0),
1176fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1186fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(1),
1196fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1206fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(2),
1216fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1226fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(3),
1236fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1246fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(4),
1256fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1266fba6e04STony Xie 
1276fba6e04STony Xie 	/* security config for ddr memery */
1286fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_DDRRGN_CON0_16(16),
1296fba6e04STony Xie 		      SGRF_DDR_RGN_BYPS);
1306fba6e04STony Xie }
1316fba6e04STony Xie 
1326fba6e04STony Xie static void dma_secure_cfg(uint32_t secure)
1336fba6e04STony Xie {
1346fba6e04STony Xie 	if (secure) {
1356fba6e04STony Xie 		/* rgn0 secure for dmac0 and dmac1 */
1366fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_DDRRGN_CON20_34(22),
1376fba6e04STony Xie 			      SGRF_L_MST_S_DDR_RGN(0) | /* dmac0 */
1386fba6e04STony Xie 			      SGRF_H_MST_S_DDR_RGN(0) /* dmac1 */
1396fba6e04STony Xie 			      );
1406fba6e04STony Xie 
1416fba6e04STony Xie 		/* set dmac0 boot, under secure state */
1426fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(8),
1436fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1446fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(9),
1456fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1466fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(10),
1476fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1486fba6e04STony Xie 
1496fba6e04STony Xie 		/* dmac0 soft reset */
1506fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1516fba6e04STony Xie 			      CRU_DMAC0_RST);
1526fba6e04STony Xie 		udelay(5);
1536fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1546fba6e04STony Xie 			      CRU_DMAC0_RST_RLS);
1556fba6e04STony Xie 
1566fba6e04STony Xie 		/* set dmac1 boot, under secure state */
1576fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(11),
1586fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1596fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(12),
1606fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1616fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(13),
1626fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1636fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(14),
1646fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1656fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(15),
1666fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1676fba6e04STony Xie 
1686fba6e04STony Xie 		/* dmac1 soft reset */
1696fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1706fba6e04STony Xie 			      CRU_DMAC1_RST);
1716fba6e04STony Xie 		udelay(5);
1726fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1736fba6e04STony Xie 			      CRU_DMAC1_RST_RLS);
1746fba6e04STony Xie 	} else {
1756fba6e04STony Xie 		/* rgn non-secure for dmac0 and dmac1 */
1766fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_DDRRGN_CON20_34(22),
1776fba6e04STony Xie 			      DMAC1_RGN_NS | DMAC0_RGN_NS);
1786fba6e04STony Xie 
1796fba6e04STony Xie 		/* set dmac0 boot, under non-secure state */
1806fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(8),
1816fba6e04STony Xie 			      DMAC0_BOOT_CFG_NS);
1826fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(9),
1836fba6e04STony Xie 			      DMAC0_BOOT_PERIPH_NS);
1846fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(10),
1856fba6e04STony Xie 			      DMAC0_BOOT_ADDR_NS);
1866fba6e04STony Xie 
1876fba6e04STony Xie 		/* dmac0 soft reset */
1886fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1896fba6e04STony Xie 			      CRU_DMAC0_RST);
1906fba6e04STony Xie 		udelay(5);
1916fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1926fba6e04STony Xie 			      CRU_DMAC0_RST_RLS);
1936fba6e04STony Xie 
1946fba6e04STony Xie 		/* set dmac1 boot, under non-secure state */
1956fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(11),
1966fba6e04STony Xie 			      DMAC1_BOOT_CFG_NS);
1976fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(12),
1986fba6e04STony Xie 			      DMAC1_BOOT_PERIPH_L_NS);
1996fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(13),
2006fba6e04STony Xie 			      DMAC1_BOOT_ADDR_NS);
2016fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(14),
2026fba6e04STony Xie 			      DMAC1_BOOT_PERIPH_H_NS);
2036fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(15),
2046fba6e04STony Xie 			      DMAC1_BOOT_IRQ_NS);
2056fba6e04STony Xie 
2066fba6e04STony Xie 		/* dmac1 soft reset */
2076fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
2086fba6e04STony Xie 			      CRU_DMAC1_RST);
2096fba6e04STony Xie 		udelay(5);
2106fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
2116fba6e04STony Xie 			      CRU_DMAC1_RST_RLS);
2126fba6e04STony Xie 	}
2136fba6e04STony Xie }
2146fba6e04STony Xie 
2156fba6e04STony Xie /* pll suspend */
2166fba6e04STony Xie struct deepsleep_data_s slp_data;
2176fba6e04STony Xie 
2186fba6e04STony Xie static void pll_suspend_prepare(uint32_t pll_id)
2196fba6e04STony Xie {
2206fba6e04STony Xie 	int i;
2216fba6e04STony Xie 
2226fba6e04STony Xie 	if (pll_id == PPLL_ID)
2236fba6e04STony Xie 		for (i = 0; i < PLL_CON_COUNT; i++)
2246fba6e04STony Xie 			slp_data.plls_con[pll_id][i] =
2256fba6e04STony Xie 				mmio_read_32(PMUCRU_BASE + PMUCRU_PPLL_CON(i));
2266fba6e04STony Xie 	else
2276fba6e04STony Xie 		for (i = 0; i < PLL_CON_COUNT; i++)
2286fba6e04STony Xie 			slp_data.plls_con[pll_id][i] =
2296fba6e04STony Xie 				mmio_read_32(CRU_BASE + CRU_PLL_CON(pll_id, i));
2306fba6e04STony Xie }
2316fba6e04STony Xie 
2326fba6e04STony Xie static void set_pll_slow_mode(uint32_t pll_id)
2336fba6e04STony Xie {
2346fba6e04STony Xie 	if (pll_id == PPLL_ID)
2356fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE + PMUCRU_PPLL_CON(3), PLL_SLOW_MODE);
2366fba6e04STony Xie 	else
2376fba6e04STony Xie 		mmio_write_32((CRU_BASE +
2386fba6e04STony Xie 			      CRU_PLL_CON(pll_id, 3)), PLL_SLOW_MODE);
2396fba6e04STony Xie }
2406fba6e04STony Xie 
2416fba6e04STony Xie static void set_pll_normal_mode(uint32_t pll_id)
2426fba6e04STony Xie {
2436fba6e04STony Xie 	if (pll_id == PPLL_ID)
2446fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE + PMUCRU_PPLL_CON(3), PLL_NOMAL_MODE);
2456fba6e04STony Xie 	else
2466fba6e04STony Xie 		mmio_write_32(CRU_BASE +
2476fba6e04STony Xie 			      CRU_PLL_CON(pll_id, 3), PLL_NOMAL_MODE);
2486fba6e04STony Xie }
2496fba6e04STony Xie 
2506fba6e04STony Xie static void set_pll_bypass(uint32_t pll_id)
2516fba6e04STony Xie {
2526fba6e04STony Xie 	if (pll_id == PPLL_ID)
2536fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE +
2546fba6e04STony Xie 			      PMUCRU_PPLL_CON(3), PLL_BYPASS_MODE);
2556fba6e04STony Xie 	else
2566fba6e04STony Xie 		mmio_write_32(CRU_BASE +
2576fba6e04STony Xie 			      CRU_PLL_CON(pll_id, 3), PLL_BYPASS_MODE);
2586fba6e04STony Xie }
2596fba6e04STony Xie 
2606fba6e04STony Xie static void _pll_suspend(uint32_t pll_id)
2616fba6e04STony Xie {
2626fba6e04STony Xie 	set_pll_slow_mode(pll_id);
2636fba6e04STony Xie 	set_pll_bypass(pll_id);
2646fba6e04STony Xie }
2656fba6e04STony Xie 
2666fba6e04STony Xie void plls_suspend(void)
2676fba6e04STony Xie {
2686fba6e04STony Xie 	uint32_t i, pll_id;
2696fba6e04STony Xie 
2706fba6e04STony Xie 	for (pll_id = ALPLL_ID; pll_id < END_PLL_ID; pll_id++)
2716fba6e04STony Xie 		pll_suspend_prepare(pll_id);
2726fba6e04STony Xie 
2736fba6e04STony Xie 	for (i = 0; i < CRU_CLKSEL_COUNT; i++)
2746fba6e04STony Xie 		slp_data.cru_clksel_con[i] =
2756fba6e04STony Xie 			mmio_read_32(CRU_BASE +
2766fba6e04STony Xie 				     CRU_CLKSEL_OFFSET + i * REG_SIZE);
2776fba6e04STony Xie 
2786fba6e04STony Xie 	for (i = 0; i < PMUCRU_CLKSEL_CONUT; i++)
2796fba6e04STony Xie 		slp_data.pmucru_clksel_con[i] =
2806fba6e04STony Xie 			mmio_read_32(PMUCRU_BASE +
2816fba6e04STony Xie 				     PMUCRU_CLKSEL_OFFSET + i * REG_SIZE);
2826fba6e04STony Xie 
2836fba6e04STony Xie 	_pll_suspend(CPLL_ID);
2846fba6e04STony Xie 	_pll_suspend(NPLL_ID);
2856fba6e04STony Xie 	_pll_suspend(VPLL_ID);
2866fba6e04STony Xie 	_pll_suspend(PPLL_ID);
2876fba6e04STony Xie 	_pll_suspend(GPLL_ID);
2886fba6e04STony Xie 	_pll_suspend(ABPLL_ID);
2896fba6e04STony Xie 	_pll_suspend(ALPLL_ID);
2906fba6e04STony Xie }
2916fba6e04STony Xie 
2926fba6e04STony Xie static void set_plls_nobypass(uint32_t pll_id)
2936fba6e04STony Xie {
2946fba6e04STony Xie 	if (pll_id == PPLL_ID)
2956fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE + PMUCRU_PPLL_CON(3),
2966fba6e04STony Xie 			      PLL_NO_BYPASS_MODE);
2976fba6e04STony Xie 	else
2986fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_PLL_CON(pll_id, 3),
2996fba6e04STony Xie 			      PLL_NO_BYPASS_MODE);
3006fba6e04STony Xie }
3016fba6e04STony Xie 
3026fba6e04STony Xie static void plls_resume_prepare(void)
3036fba6e04STony Xie {
3046fba6e04STony Xie 	int i;
3056fba6e04STony Xie 
3066fba6e04STony Xie 	for (i = 0; i < CRU_CLKSEL_COUNT; i++)
3076fba6e04STony Xie 		mmio_write_32((CRU_BASE + CRU_CLKSEL_OFFSET + i * REG_SIZE),
3086fba6e04STony Xie 			      REG_SOC_WMSK | slp_data.cru_clksel_con[i]);
3096fba6e04STony Xie 	for (i = 0; i < PMUCRU_CLKSEL_CONUT; i++)
3106fba6e04STony Xie 		mmio_write_32((PMUCRU_BASE +
3116fba6e04STony Xie 			      PMUCRU_CLKSEL_OFFSET + i * REG_SIZE),
3126fba6e04STony Xie 			      REG_SOC_WMSK | slp_data.pmucru_clksel_con[i]);
3136fba6e04STony Xie }
3146fba6e04STony Xie 
3156fba6e04STony Xie void plls_resume(void)
3166fba6e04STony Xie {
3176fba6e04STony Xie 	int pll_id;
3186fba6e04STony Xie 
3196fba6e04STony Xie 	plls_resume_prepare();
3206fba6e04STony Xie 	for (pll_id = ALPLL_ID; pll_id < END_PLL_ID; pll_id++) {
3216fba6e04STony Xie 		set_plls_nobypass(pll_id);
3226fba6e04STony Xie 		set_pll_normal_mode(pll_id);
3236fba6e04STony Xie 	}
3246fba6e04STony Xie }
3256fba6e04STony Xie 
3266fba6e04STony Xie void soc_global_soft_reset_init(void)
3276fba6e04STony Xie {
3286fba6e04STony Xie 	mmio_write_32(PMUCRU_BASE + CRU_PMU_RSTHOLD_CON(1),
3296fba6e04STony Xie 		      CRU_PMU_SGRF_RST_RLS);
330f47a25ddSCaesar Wang 
331f47a25ddSCaesar Wang 	mmio_clrbits_32(CRU_BASE + CRU_GLB_RST_CON,
332f47a25ddSCaesar Wang 			CRU_PMU_WDTRST_MSK | CRU_PMU_FIRST_SFTRST_MSK);
3336fba6e04STony Xie }
3346fba6e04STony Xie 
3356fba6e04STony Xie void  __dead2 soc_global_soft_reset(void)
3366fba6e04STony Xie {
3376fba6e04STony Xie 	set_pll_slow_mode(VPLL_ID);
3386fba6e04STony Xie 	set_pll_slow_mode(NPLL_ID);
3396fba6e04STony Xie 	set_pll_slow_mode(GPLL_ID);
3406fba6e04STony Xie 	set_pll_slow_mode(CPLL_ID);
3416fba6e04STony Xie 	set_pll_slow_mode(PPLL_ID);
3426fba6e04STony Xie 	set_pll_slow_mode(ABPLL_ID);
3436fba6e04STony Xie 	set_pll_slow_mode(ALPLL_ID);
344f47a25ddSCaesar Wang 
345f47a25ddSCaesar Wang 	dsb();
346f47a25ddSCaesar Wang 
3476fba6e04STony Xie 	mmio_write_32(CRU_BASE + CRU_GLB_SRST_FST, GLB_SRST_FST_CFG_VAL);
3486fba6e04STony Xie 
3496fba6e04STony Xie 	/*
3506fba6e04STony Xie 	 * Maybe the HW needs some times to reset the system,
3516fba6e04STony Xie 	 * so we do not hope the core to excute valid codes.
3526fba6e04STony Xie 	 */
3536fba6e04STony Xie 	while (1)
3546fba6e04STony Xie 	;
3556fba6e04STony Xie }
3566fba6e04STony Xie 
3576fba6e04STony Xie void plat_rockchip_soc_init(void)
3586fba6e04STony Xie {
3596fba6e04STony Xie 	secure_timer_init();
3606fba6e04STony Xie 	dma_secure_cfg(0);
3616fba6e04STony Xie 	sgrf_init();
3626fba6e04STony Xie 	soc_global_soft_reset_init();
363*9901dcf6SCaesar Wang 	plat_rockchip_gpio_init();
3646fba6e04STony Xie }
365