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