s5pc210: universal: Add uart_asm_init

Check the UART_SEL at there.

Signed-off-by: Kyungmin Park <kyungmin.park@samsung.com>

diff --git a/board/samsung/universal_c210/lowlevel_init.S b/board/samsung/universal_c210/lowlevel_init.S
index 176e861..84c854e 100644 (file)
--- a/board/samsung/universal_c210/lowlevel_init.S
+++ b/board/samsung/universal_c210/lowlevel_init.S
@@ -1,7 +1,7 @@
 /*
- * Memory Setup stuff - taken from blob memsetup.S
+ * Lowlevel setup for universal board based on S5PC210
  *
- * Copyright (C) 2009 Samsung Electronics
+ * Copyright (C) 2010 Samsung Electronics
  * Kyungmin Park <kyungmin.park@samsung.com>
  *
  * See file CREDITS for list of people who contributed to this
@@ -29,11 +29,62 @@
 #include <asm/arch/clock.h>
 #include <asm/arch/power.h>
 
+/*
+ * Register usages:
+ *
+ * r5 has zero always
+ * r7 has GPIO part1 base 0x11400000
+ * r8 has GPIO part2 base 0x11000000
+ */
+
 _TEXT_BASE:
        .word   TEXT_BASE
 
        .globl lowlevel_init
 lowlevel_init:
        mov     r11, lr
+
+       /* r5 has always zero */
+       mov     r5, #0
+
+       ldr     r7, =S5PC210_GPIO_PART1_BASE
+       ldr     r8, =S5PC210_GPIO_PART2_BASE
+
+       /* UART */
+       bl      uart_asm_init
+
        mov     lr, r11
        mov     pc, lr
+
+/*
+ * uart_asm_init: Initialize UART's pins
+ */
+uart_asm_init:
+       /*
+        * setup UART0-UART4 GPIOs
+        * GPA1CON[3] = I2C_3_SCL (3)
+        * GPA1CON[2] = I2C_3_SDA (3)
+        */
+       mov     r0, r7          /* Part 1 */
+       ldr     r1, =0x22222222
+       str     r1, [r0, #0x00]                 @ S5PC210_GPIO_A0_OFFSET
+       ldr     r1, =0x00223322
+       str     r1, [r0, #0x20]                 @ S5PC210_GPIO_A1_OFFSET
+
+       /* UART_SEL GPY4[7] (part2) at S5PC210 */
+       add     r0, r8, #0x1A0                  @ S5PC210_GPIO_Y4_OFFSET
+       ldr     r1, [r0, #0x0]
+       bic     r1, r1, #(0xf << 28)            @ 28 = 7 * 4-bit
+       orr     r1, r1, #(0x1 << 28)
+       str     r1, [r0, #0x0]
+
+       ldr     r1, [r0, #0x8]
+       bic     r1, r1, #(0x3 << 14)            @ 14 = 7 * 2-bit
+       orr     r1, r1, #(0x2 << 14)            @ Pull-up enabled
+       str     r1, [r0, #0x8]
+
+       ldr     r1, [r0, #0x4]
+       orr     r1, r1, #(1 << 7)               @ 7 = 7 * 1-bit
+       str     r1, [r0, #0x4]
+
+       mov     pc, lr