From 4ed07626af30f04607b67c015c57668e1652e2e9 Mon Sep 17 00:00:00 2001
From: Kyungmin Park <kyungmin.park@samsung.com>
Date: Fri, 28 Aug 2009 10:03:10 +0900
Subject: [PATCH] s5pc110: universal: Add TZPC initialization

Signed-off-by: Kyungmin Park <kyungmin.park@samsung.com>
---
 board/samsung/universal/lowlevel_init.S | 21 ++++++++++++---------
 1 file changed, 12 insertions(+), 9 deletions(-)

diff --git a/board/samsung/universal/lowlevel_init.S b/board/samsung/universal/lowlevel_init.S
index 102a780..d98777c 100644
--- a/board/samsung/universal/lowlevel_init.S
+++ b/board/samsung/universal/lowlevel_init.S
@@ -84,7 +84,7 @@ lowlevel_init:
 	ldrne	r0, =S5PC110_OTHERS			@0xE010E000
 	ldr	r1, [r0]
 	ldreq	r2, =(1 << 31)				@IO_RET_REL
-	ldrne	r2, =((1 << 31) | (1 << 28))		@ GPIO, UART_IO
+	ldrne	r2, =((1 << 31) | (1 << 29) | (1 << 28))	@ GPIO, UART_IO
 	orr	r1, r1, r2
 	str	r1, [r0]
 
@@ -260,8 +260,10 @@ system_clock_init:
 	b	200f
 110:
 	/* Set Clock divider */
-	ldr	r1, =0x14131330		@ 1:1:4:4, 1:4:5
+	ldr	r1, =0x14131330			@ 1:1:4:4, 1:4:5
 	str	r1, [r0, #0x300]
+	ldr	r1, =0x11110111			@ UART[3210]: MMC[3210]
+	str	r1, [r0, #0x310]
 
 	/* Set Lock Time */
 	ldr	r1, =0xe10			@ Locktime : 0xe10 = 3600
@@ -271,16 +273,16 @@ system_clock_init:
 	str	r1, [r0, #0x020]		@ S5PC110_VPLL_LOCK
 
 	/* S5PC110_APLL_CON */
-	ldr	r1, =0x80C80601		@ 800MHz
+	ldr	r1, =0x80C80601			@ 800MHz
 	str	r1, [r0, #0x100]
 	/* S5PC110_MPLL_CON */
-	ldr	r1, =0x829B0C01		@ 667MHz
+	ldr	r1, =0x829B0C01			@ 667MHz
 	str	r1, [r0, #0x108]
 	/* S5PC110_EPLL_CON */
-	ldr	r1, =0x80600602		@  96MHz
+	ldr	r1, =0x80600602			@  96MHz
 	str	r1, [r0, #0x110]
 	/* S5PC110_VPLL_CON */
-	ldr	r1, =0x806C0603		@  54MHz
+	ldr	r1, =0x806C0603			@  54MHz
 	str	r1, [r0, #0x120]
 
 	/* Set Source Clock */
@@ -382,24 +384,25 @@ tzpc_asm_init:
 	mov	r1, #0xff
 	str	r1, [r0, #0x804]
 	str	r1, [r0, #0x810]
+	str	r1, [r0, #0x81C]
 
-	cmp	r7, r8
 	ldreq	r0, =0xE2800000			@ TZPC1
 	ldrne	r0, =0xFAD00000			@ TZPC1
 	str	r1, [r0, #0x804]
 	str	r1, [r0, #0x810]
 	str	r1, [r0, #0x81C]
 
-	cmp	r7, r8
 	ldreq	r0, =0xE2900000			@ TZPC2
 	ldrne	r0, =0xE0600000			@ TZPC2
 	str	r1, [r0, #0x804]
 	str	r1, [r0, #0x810]
+	str	r1, [r0, #0x81C]
+	str	r1, [r0, #0x828]
 
-	cmp	r7, r8
 	ldrne	r0, =0xE1C00000			@ TZPC3 S5PC110 only
 	strne	r1, [r0, #0x804]
 	strne	r1, [r0, #0x810]
+	strne	r1, [r0, #0x81C]
 
 	mov	pc, lr
 #endif
-- 
2.7.4