X-Git-Url: http://plrg.eecs.uci.edu/git/?p=firefly-linux-kernel-4.4.55.git;a=blobdiff_plain;f=arch%2Farm%2Fmach-rockchip%2Frk3228.c;h=bd5c434f92145a952c7f65d85c7a7c12c1d167fd;hp=12f0886189d3ae02d49ec57e0d5f67d043ef9546;hb=d91ca21f9ac06733b3895deab952e016ed20c2a1;hpb=cbc7aedfc21c6f60abc74a85bc42331ee1975bb2

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")