[U-Boot] [PATCH 5/7] arm: rmobile: koelsch: Halt clock prior to booting kernel

[Nobuhiro Iwamatsu]

Before a kernel boots, GPIO, SYS-DMAC, QSPI, MSIOF and IPMMU-GP
clock is halted.

Signed-off-by: Hisashi Nakamura <hisashi.nakamura.ak at renesas.com>
Signed-off-by: Nobuhiro Iwamatsu <nobuhiro.iwamatsu.yj at renesas.com>
---
 board/renesas/koelsch/koelsch.c | 43 +++++++++++++++++++++++++++++++++++++++--
 1 file changed, 41 insertions(+), 2 deletions(-)

diff --git a/board/renesas/koelsch/koelsch.c b/board/renesas/koelsch/koelsch.c
index 5ebbfcf..8d43f36 100644
--- a/board/renesas/koelsch/koelsch.c
+++ b/board/renesas/koelsch/koelsch.c
@@ -61,10 +61,49 @@ int board_early_init_f(void)
 	return 0;
 }
 
+static struct mstp_ctl {
+	u32 s_addr;
+	u32 s_dis;
+	u32 s_ena;
+	u32 r_addr;
+	u32 r_dis;
+	u32 r_ena;
+} mstptbl[] = {
+	[0] = { SMSTPCR0,  0x00640801, 0x00400000,
+		RMSTPCR0,  0x00640801, 0x00000000 },
+	[1] = { SMSTPCR1,  0x9B6C9B5A, 0x00000000,
+		RMSTPCR1,  0x9B6C9B5A, 0x00000000 },
+	[2] = { SMSTPCR2,  0x100D21FC, 0x00002000,
+		RMSTPCR2,  0x100D21FC, 0x00000000 },
+	[3] = { SMSTPCR3,  0xF08CD810, 0x00000000,
+		RMSTPCR3,  0xF08CD810, 0x00000000 },
+	[4] = { SMSTPCR4,  0x800001C4, 0x00000180,
+		RMSTPCR4,  0x800001C4, 0x00000000 },
+	[5] = { SMSTPCR5,  0x44C00046, 0x00000000,
+		RMSTPCR5,  0x44C00046, 0x00000000 },
+	[7] = { SMSTPCR7,  0x05BFE618, 0x00200000,
+		RMSTPCR7,  0x05BFE618, 0x00000000 },
+	[8] = { SMSTPCR8,  0x40C0FE85, 0x00000000,
+		RMSTPCR8,  0x40C0FE85, 0x00000000 },
+	[9] = { SMSTPCR9,  0xFF979FFF, 0x00000000,
+		RMSTPCR9,  0xFF979FFF, 0x00000000 },
+	[10] = { SMSTPCR10, 0xFFFEFFE0, 0x00000000,
+		 RMSTPCR10, 0xFFFEFFE0, 0x00000000 },
+	[11] = { SMSTPCR11, 0x000001C0, 0x00000000,
+		 RMSTPCR11, 0x000001C0, 0x00000000 },
+};
+
 void arch_preboot_os(void)
 {
-	/* Disable TMU0 */
-	mstp_setbits_le32(MSTPSR1, SMSTPCR1, TMU0_MSTP125);
+	int i;
+
+	/* Stop all module clock */
+	for (i = 0; i < ARRAY_SIZE(mstptbl); i++) {
+		mstp_setclrbits_le32(mstptbl[i].s_addr, mstptbl[i].s_addr,
+				     mstptbl[i].s_dis, mstptbl[i].s_ena);
+		mstp_setclrbits_le32(mstptbl[i].r_addr, mstptbl[i].r_addr,
+				     mstptbl[i].r_dis, mstptbl[i].r_ena);
+	}
 }
 
 /* LSI pin pull-up control */
-- 
2.1.3