From d91ca21f9ac06733b3895deab952e016ed20c2a1 Mon Sep 17 00:00:00 2001 From: Chen Liang Date: Tue, 10 Nov 2015 17:53:25 +0800 Subject: [PATCH] ARM: rockchip: rk3228: implement function rk3228_restart Change-Id: If6c5630a1ea9a8ebb95f527bd5d1aff082da079f Signed-off-by: Chen Liang --- arch/arm/mach-rockchip/rk3228.c | 16 ++++++++++++++++ 1 file changed, 16 insertions(+) diff --git a/arch/arm/mach-rockchip/rk3228.c b/arch/arm/mach-rockchip/rk3228.c index 12f0886189d3..bd5c434f9214 100644 --- a/arch/arm/mach-rockchip/rk3228.c +++ b/arch/arm/mach-rockchip/rk3228.c @@ -104,6 +104,22 @@ static void __init rk3228_init_late(void) static void rk3228_restart(char mode, const char *cmd) { + u32 boot_flag, boot_mode; + + rockchip_restart_get_boot_mode(cmd, &boot_flag, &boot_mode); + + /* for loader */ + writel_relaxed(boot_flag, RK_PMU_VIRT + RK3228_GRF_OS_REG0); + /* for linux */ + writel_relaxed(boot_mode, RK_PMU_VIRT + RK3228_GRF_OS_REG1); + + dsb(); + + /* pll enter slow mode */ + writel_relaxed(0x11010000, RK_CRU_VIRT + RK3228_CRU_MODE_CON); + dsb(); + writel_relaxed(0xeca8, RK_CRU_VIRT + RK3228_CRU_GLB_SRST_SND_VALUE); + dsb(); } DT_MACHINE_START(RK3228_DT, "Rockchip RK3228") -- 2.34.1