xref: /rk3399_ARM-atf/plat/rockchip/rk3399/drivers/soc/soc.c (revision f47a25ddd876738c7b078efc002a48c53e48d7c0)
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),
58*f47a25ddSCaesar Wang 	MAP_REGION_FLAT(PMUGRF_BASE, PMUGRF_SIZE,
59*f47a25ddSCaesar Wang 			MT_DEVICE | MT_RW | MT_SECURE),
60*f47a25ddSCaesar Wang 
616fba6e04STony Xie 	{ 0 }
626fba6e04STony Xie };
636fba6e04STony Xie 
646fba6e04STony Xie /* The RockChip power domain tree descriptor */
656fba6e04STony Xie const unsigned char rockchip_power_domain_tree_desc[] = {
666fba6e04STony Xie 	/* No of root nodes */
676fba6e04STony Xie 	PLATFORM_SYSTEM_COUNT,
686fba6e04STony Xie 	/* No of children for the root node */
696fba6e04STony Xie 	PLATFORM_CLUSTER_COUNT,
706fba6e04STony Xie 	/* No of children for the first cluster node */
716fba6e04STony Xie 	PLATFORM_CLUSTER0_CORE_COUNT,
726fba6e04STony Xie 	/* No of children for the second cluster node */
736fba6e04STony Xie 	PLATFORM_CLUSTER1_CORE_COUNT
746fba6e04STony Xie };
756fba6e04STony Xie 
766fba6e04STony Xie void secure_timer_init(void)
776fba6e04STony Xie {
786fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_END_COUNT0, 0xffffffff);
796fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_END_COUNT1, 0xffffffff);
806fba6e04STony Xie 
816fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_INIT_COUNT0, 0x0);
826fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_INIT_COUNT0, 0x0);
836fba6e04STony Xie 
846fba6e04STony Xie 	/* auto reload & enable the timer */
856fba6e04STony Xie 	mmio_write_32(STIMER1_CHN_BASE(5) + TIMER_CONTROL_REG,
866fba6e04STony Xie 		      TIMER_EN | TIMER_FMODE);
876fba6e04STony Xie }
886fba6e04STony Xie 
896fba6e04STony Xie void sgrf_init(void)
906fba6e04STony Xie {
916fba6e04STony Xie 	/* security config for master */
926fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SOC_CON3_7(5),
936fba6e04STony Xie 		      SGRF_SOC_CON_WMSK | SGRF_SOC_ALLMST_NS);
946fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SOC_CON3_7(6),
956fba6e04STony Xie 		      SGRF_SOC_CON_WMSK | SGRF_SOC_ALLMST_NS);
966fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SOC_CON3_7(7),
976fba6e04STony Xie 		      SGRF_SOC_CON_WMSK | SGRF_SOC_ALLMST_NS);
986fba6e04STony Xie 
996fba6e04STony Xie 	/* security config for slave */
1006fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_PMU_SLV_CON0_1(0),
1016fba6e04STony Xie 		      SGRF_PMU_SLV_S_CFGED |
1026fba6e04STony Xie 		      SGRF_PMU_SLV_CRYPTO1_NS);
1036fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_PMU_SLV_CON0_1(1),
1046fba6e04STony Xie 		      SGRF_PMU_SLV_CON1_CFG);
1056fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(0),
1066fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1076fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(1),
1086fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1096fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(2),
1106fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1116fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(3),
1126fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1136fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_SLV_SECURE_CON0_4(4),
1146fba6e04STony Xie 		      SGRF_SLV_S_WMSK | SGRF_SLV_S_ALL_NS);
1156fba6e04STony Xie 
1166fba6e04STony Xie 	/* security config for ddr memery */
1176fba6e04STony Xie 	mmio_write_32(SGRF_BASE + SGRF_DDRRGN_CON0_16(16),
1186fba6e04STony Xie 		      SGRF_DDR_RGN_BYPS);
1196fba6e04STony Xie }
1206fba6e04STony Xie 
1216fba6e04STony Xie static void dma_secure_cfg(uint32_t secure)
1226fba6e04STony Xie {
1236fba6e04STony Xie 	if (secure) {
1246fba6e04STony Xie 		/* rgn0 secure for dmac0 and dmac1 */
1256fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_DDRRGN_CON20_34(22),
1266fba6e04STony Xie 			      SGRF_L_MST_S_DDR_RGN(0) | /* dmac0 */
1276fba6e04STony Xie 			      SGRF_H_MST_S_DDR_RGN(0) /* dmac1 */
1286fba6e04STony Xie 			      );
1296fba6e04STony Xie 
1306fba6e04STony Xie 		/* set dmac0 boot, under secure state */
1316fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(8),
1326fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1336fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(9),
1346fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1356fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(10),
1366fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1376fba6e04STony Xie 
1386fba6e04STony Xie 		/* dmac0 soft reset */
1396fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1406fba6e04STony Xie 			      CRU_DMAC0_RST);
1416fba6e04STony Xie 		udelay(5);
1426fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1436fba6e04STony Xie 			      CRU_DMAC0_RST_RLS);
1446fba6e04STony Xie 
1456fba6e04STony Xie 		/* set dmac1 boot, under secure state */
1466fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(11),
1476fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1486fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(12),
1496fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1506fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(13),
1516fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1526fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(14),
1536fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1546fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(15),
1556fba6e04STony Xie 			      SGRF_DMAC_CFG_S);
1566fba6e04STony Xie 
1576fba6e04STony Xie 		/* dmac1 soft reset */
1586fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1596fba6e04STony Xie 			      CRU_DMAC1_RST);
1606fba6e04STony Xie 		udelay(5);
1616fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1626fba6e04STony Xie 			      CRU_DMAC1_RST_RLS);
1636fba6e04STony Xie 	} else {
1646fba6e04STony Xie 		/* rgn non-secure for dmac0 and dmac1 */
1656fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_DDRRGN_CON20_34(22),
1666fba6e04STony Xie 			      DMAC1_RGN_NS | DMAC0_RGN_NS);
1676fba6e04STony Xie 
1686fba6e04STony Xie 		/* set dmac0 boot, under non-secure state */
1696fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(8),
1706fba6e04STony Xie 			      DMAC0_BOOT_CFG_NS);
1716fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(9),
1726fba6e04STony Xie 			      DMAC0_BOOT_PERIPH_NS);
1736fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(10),
1746fba6e04STony Xie 			      DMAC0_BOOT_ADDR_NS);
1756fba6e04STony Xie 
1766fba6e04STony Xie 		/* dmac0 soft reset */
1776fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1786fba6e04STony Xie 			      CRU_DMAC0_RST);
1796fba6e04STony Xie 		udelay(5);
1806fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1816fba6e04STony Xie 			      CRU_DMAC0_RST_RLS);
1826fba6e04STony Xie 
1836fba6e04STony Xie 		/* set dmac1 boot, under non-secure state */
1846fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(11),
1856fba6e04STony Xie 			      DMAC1_BOOT_CFG_NS);
1866fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(12),
1876fba6e04STony Xie 			      DMAC1_BOOT_PERIPH_L_NS);
1886fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(13),
1896fba6e04STony Xie 			      DMAC1_BOOT_ADDR_NS);
1906fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(14),
1916fba6e04STony Xie 			      DMAC1_BOOT_PERIPH_H_NS);
1926fba6e04STony Xie 		mmio_write_32(SGRF_BASE + SGRF_SOC_CON8_15(15),
1936fba6e04STony Xie 			      DMAC1_BOOT_IRQ_NS);
1946fba6e04STony Xie 
1956fba6e04STony Xie 		/* dmac1 soft reset */
1966fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
1976fba6e04STony Xie 			      CRU_DMAC1_RST);
1986fba6e04STony Xie 		udelay(5);
1996fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_SOFTRST_CON(10),
2006fba6e04STony Xie 			      CRU_DMAC1_RST_RLS);
2016fba6e04STony Xie 	}
2026fba6e04STony Xie }
2036fba6e04STony Xie 
2046fba6e04STony Xie /* pll suspend */
2056fba6e04STony Xie struct deepsleep_data_s slp_data;
2066fba6e04STony Xie 
2076fba6e04STony Xie static void pll_suspend_prepare(uint32_t pll_id)
2086fba6e04STony Xie {
2096fba6e04STony Xie 	int i;
2106fba6e04STony Xie 
2116fba6e04STony Xie 	if (pll_id == PPLL_ID)
2126fba6e04STony Xie 		for (i = 0; i < PLL_CON_COUNT; i++)
2136fba6e04STony Xie 			slp_data.plls_con[pll_id][i] =
2146fba6e04STony Xie 				mmio_read_32(PMUCRU_BASE + PMUCRU_PPLL_CON(i));
2156fba6e04STony Xie 	else
2166fba6e04STony Xie 		for (i = 0; i < PLL_CON_COUNT; i++)
2176fba6e04STony Xie 			slp_data.plls_con[pll_id][i] =
2186fba6e04STony Xie 				mmio_read_32(CRU_BASE + CRU_PLL_CON(pll_id, i));
2196fba6e04STony Xie }
2206fba6e04STony Xie 
2216fba6e04STony Xie static void set_pll_slow_mode(uint32_t pll_id)
2226fba6e04STony Xie {
2236fba6e04STony Xie 	if (pll_id == PPLL_ID)
2246fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE + PMUCRU_PPLL_CON(3), PLL_SLOW_MODE);
2256fba6e04STony Xie 	else
2266fba6e04STony Xie 		mmio_write_32((CRU_BASE +
2276fba6e04STony Xie 			      CRU_PLL_CON(pll_id, 3)), PLL_SLOW_MODE);
2286fba6e04STony Xie }
2296fba6e04STony Xie 
2306fba6e04STony Xie static void set_pll_normal_mode(uint32_t pll_id)
2316fba6e04STony Xie {
2326fba6e04STony Xie 	if (pll_id == PPLL_ID)
2336fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE + PMUCRU_PPLL_CON(3), PLL_NOMAL_MODE);
2346fba6e04STony Xie 	else
2356fba6e04STony Xie 		mmio_write_32(CRU_BASE +
2366fba6e04STony Xie 			      CRU_PLL_CON(pll_id, 3), PLL_NOMAL_MODE);
2376fba6e04STony Xie }
2386fba6e04STony Xie 
2396fba6e04STony Xie static void set_pll_bypass(uint32_t pll_id)
2406fba6e04STony Xie {
2416fba6e04STony Xie 	if (pll_id == PPLL_ID)
2426fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE +
2436fba6e04STony Xie 			      PMUCRU_PPLL_CON(3), PLL_BYPASS_MODE);
2446fba6e04STony Xie 	else
2456fba6e04STony Xie 		mmio_write_32(CRU_BASE +
2466fba6e04STony Xie 			      CRU_PLL_CON(pll_id, 3), PLL_BYPASS_MODE);
2476fba6e04STony Xie }
2486fba6e04STony Xie 
2496fba6e04STony Xie static void _pll_suspend(uint32_t pll_id)
2506fba6e04STony Xie {
2516fba6e04STony Xie 	set_pll_slow_mode(pll_id);
2526fba6e04STony Xie 	set_pll_bypass(pll_id);
2536fba6e04STony Xie }
2546fba6e04STony Xie 
2556fba6e04STony Xie void plls_suspend(void)
2566fba6e04STony Xie {
2576fba6e04STony Xie 	uint32_t i, pll_id;
2586fba6e04STony Xie 
2596fba6e04STony Xie 	for (pll_id = ALPLL_ID; pll_id < END_PLL_ID; pll_id++)
2606fba6e04STony Xie 		pll_suspend_prepare(pll_id);
2616fba6e04STony Xie 
2626fba6e04STony Xie 	for (i = 0; i < CRU_CLKSEL_COUNT; i++)
2636fba6e04STony Xie 		slp_data.cru_clksel_con[i] =
2646fba6e04STony Xie 			mmio_read_32(CRU_BASE +
2656fba6e04STony Xie 				     CRU_CLKSEL_OFFSET + i * REG_SIZE);
2666fba6e04STony Xie 
2676fba6e04STony Xie 	for (i = 0; i < PMUCRU_CLKSEL_CONUT; i++)
2686fba6e04STony Xie 		slp_data.pmucru_clksel_con[i] =
2696fba6e04STony Xie 			mmio_read_32(PMUCRU_BASE +
2706fba6e04STony Xie 				     PMUCRU_CLKSEL_OFFSET + i * REG_SIZE);
2716fba6e04STony Xie 
2726fba6e04STony Xie 	_pll_suspend(CPLL_ID);
2736fba6e04STony Xie 	_pll_suspend(NPLL_ID);
2746fba6e04STony Xie 	_pll_suspend(VPLL_ID);
2756fba6e04STony Xie 	_pll_suspend(PPLL_ID);
2766fba6e04STony Xie 	_pll_suspend(GPLL_ID);
2776fba6e04STony Xie 	_pll_suspend(ABPLL_ID);
2786fba6e04STony Xie 	_pll_suspend(ALPLL_ID);
2796fba6e04STony Xie }
2806fba6e04STony Xie 
2816fba6e04STony Xie static void set_plls_nobypass(uint32_t pll_id)
2826fba6e04STony Xie {
2836fba6e04STony Xie 	if (pll_id == PPLL_ID)
2846fba6e04STony Xie 		mmio_write_32(PMUCRU_BASE + PMUCRU_PPLL_CON(3),
2856fba6e04STony Xie 			      PLL_NO_BYPASS_MODE);
2866fba6e04STony Xie 	else
2876fba6e04STony Xie 		mmio_write_32(CRU_BASE + CRU_PLL_CON(pll_id, 3),
2886fba6e04STony Xie 			      PLL_NO_BYPASS_MODE);
2896fba6e04STony Xie }
2906fba6e04STony Xie 
2916fba6e04STony Xie static void plls_resume_prepare(void)
2926fba6e04STony Xie {
2936fba6e04STony Xie 	int i;
2946fba6e04STony Xie 
2956fba6e04STony Xie 	for (i = 0; i < CRU_CLKSEL_COUNT; i++)
2966fba6e04STony Xie 		mmio_write_32((CRU_BASE + CRU_CLKSEL_OFFSET + i * REG_SIZE),
2976fba6e04STony Xie 			      REG_SOC_WMSK | slp_data.cru_clksel_con[i]);
2986fba6e04STony Xie 	for (i = 0; i < PMUCRU_CLKSEL_CONUT; i++)
2996fba6e04STony Xie 		mmio_write_32((PMUCRU_BASE +
3006fba6e04STony Xie 			      PMUCRU_CLKSEL_OFFSET + i * REG_SIZE),
3016fba6e04STony Xie 			      REG_SOC_WMSK | slp_data.pmucru_clksel_con[i]);
3026fba6e04STony Xie }
3036fba6e04STony Xie 
3046fba6e04STony Xie void plls_resume(void)
3056fba6e04STony Xie {
3066fba6e04STony Xie 	int pll_id;
3076fba6e04STony Xie 
3086fba6e04STony Xie 	plls_resume_prepare();
3096fba6e04STony Xie 	for (pll_id = ALPLL_ID; pll_id < END_PLL_ID; pll_id++) {
3106fba6e04STony Xie 		set_plls_nobypass(pll_id);
3116fba6e04STony Xie 		set_pll_normal_mode(pll_id);
3126fba6e04STony Xie 	}
3136fba6e04STony Xie }
3146fba6e04STony Xie 
3156fba6e04STony Xie void soc_global_soft_reset_init(void)
3166fba6e04STony Xie {
3176fba6e04STony Xie 	mmio_write_32(PMUCRU_BASE + CRU_PMU_RSTHOLD_CON(1),
3186fba6e04STony Xie 		      CRU_PMU_SGRF_RST_RLS);
319*f47a25ddSCaesar Wang 
320*f47a25ddSCaesar Wang 	mmio_clrbits_32(CRU_BASE + CRU_GLB_RST_CON,
321*f47a25ddSCaesar Wang 			CRU_PMU_WDTRST_MSK | CRU_PMU_FIRST_SFTRST_MSK);
3226fba6e04STony Xie }
3236fba6e04STony Xie 
3246fba6e04STony Xie void  __dead2 soc_global_soft_reset(void)
3256fba6e04STony Xie {
3266fba6e04STony Xie 	set_pll_slow_mode(VPLL_ID);
3276fba6e04STony Xie 	set_pll_slow_mode(NPLL_ID);
3286fba6e04STony Xie 	set_pll_slow_mode(GPLL_ID);
3296fba6e04STony Xie 	set_pll_slow_mode(CPLL_ID);
3306fba6e04STony Xie 	set_pll_slow_mode(PPLL_ID);
3316fba6e04STony Xie 	set_pll_slow_mode(ABPLL_ID);
3326fba6e04STony Xie 	set_pll_slow_mode(ALPLL_ID);
333*f47a25ddSCaesar Wang 
334*f47a25ddSCaesar Wang 	dsb();
335*f47a25ddSCaesar Wang 
3366fba6e04STony Xie 	mmio_write_32(CRU_BASE + CRU_GLB_SRST_FST, GLB_SRST_FST_CFG_VAL);
3376fba6e04STony Xie 
3386fba6e04STony Xie 	/*
3396fba6e04STony Xie 	 * Maybe the HW needs some times to reset the system,
3406fba6e04STony Xie 	 * so we do not hope the core to excute valid codes.
3416fba6e04STony Xie 	 */
3426fba6e04STony Xie 	while (1)
3436fba6e04STony Xie 	;
3446fba6e04STony Xie }
3456fba6e04STony Xie 
3466fba6e04STony Xie void plat_rockchip_soc_init(void)
3476fba6e04STony Xie {
3486fba6e04STony Xie 	secure_timer_init();
3496fba6e04STony Xie 	dma_secure_cfg(0);
3506fba6e04STony Xie 	sgrf_init();
3516fba6e04STony Xie 	soc_global_soft_reset_init();
3526fba6e04STony Xie }
353