Merge branch 'adm8668'

[openwrt/svn-archive/archive.git] / target / linux / adm8668 / files / arch / mips / adm8668 / prom.c

diff --git a/target/linux/adm8668/files/arch/mips/adm8668/prom.c b/target/linux/adm8668/files/arch/mips/adm8668/prom.c
new file mode 100644 (file)
index 0000000..53731c1
--- /dev/null
+++ b/target/linux/adm8668/files/arch/mips/adm8668/prom.c
@@ -0,0 +1,138 @@
+/*
+ * Copyright (C) 2010 Scott Nicholas <neutronscott@scottn.us>
+ *
+ * based on work of rb532 prom.c
+ *  Copyright (C) 2003, Peter Sadik <peter.sadik@idt.com>
+ *  Copyright (C) 2005-2006, P.Christeas <p_christ@hol.gr>
+ *  Copyright (C) 2007, Gabor Juhos <juhosg@openwrt.org>
+ *                     Felix Fietkau <nbd@openwrt.org>
+ *                     Florian Fainelli <florian@openwrt.org>
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ */
+
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/types.h>
+#include <linux/console.h>
+#include <linux/string.h>
+#include <linux/serial_core.h>
+#include <asm/bootinfo.h>
+#include <adm8668.h>
+#include "u-boot.h"
+
+register volatile struct global_data *gd asm ("k0");
+
+#ifdef CONFIG_SERIAL_ADM8668_CONSOLE
+static inline unsigned int adm_uart_readl(unsigned int offset)
+{
+       return (*(volatile unsigned int *)(0xbe400000 + offset));
+}
+
+static inline void adm_uart_writel(unsigned int value, unsigned int offset)
+{
+       (*((volatile unsigned int *)(0xbe400000 + offset))) = value;
+}
+
+static void prom_putchar(char c)
+{
+       adm_uart_writel(c, UART_DR_REG);
+       while ((adm_uart_readl(UART_FR_REG) & UART_TX_FIFO_FULL) != 0)
+               ;
+}
+
+static void __init
+early_console_write(struct console *con, const char *s, unsigned n)
+{
+       while (n-- && *s) {
+               if (*s == '\n')
+                       prom_putchar('\r');
+               prom_putchar(*s);
+               s++;
+       }
+}
+
+static struct console early_console __initdata = {
+       .name   = "early",
+       .write  = early_console_write,
+       .flags  = CON_BOOT,
+       .index  = -1
+};
+
+#endif
+
+void __init prom_free_prom_memory(void)
+{
+       /* No prom memory to free */
+}
+
+static inline int match_tag(char *arg, const char *tag)
+{
+       return strncmp(arg, tag, strlen(tag)) == 0;
+}
+
+static inline unsigned long tag2ul(char *arg, const char *tag)
+{
+       char *num;
+
+       num = arg + strlen(tag);
+       return simple_strtoul(num, 0, 10);
+}
+
+void __init prom_setup_cmdline(void)
+{
+       char *cp;
+       int prom_argc;
+       char **prom_argv;
+       int i;
+
+       prom_argc = fw_arg0;
+       prom_argv = (char **)KSEG0ADDR(fw_arg1);
+
+       cp = &(arcs_cmdline[0]);
+       for (i = 1; i < prom_argc; i++) {
+               prom_argv[i] = (char *)KSEG0ADDR(prom_argv[i]);
+
+               /* default bootargs has "console=/dev/ttyS0" yet console won't
+                * show up at all if you do this ... */
+               if (match_tag(prom_argv[i], "console=/dev/")) {
+                       char *ptr = prom_argv[i] + strlen("console=/dev/");
+
+                       strcpy(cp, "console=");
+                       cp += strlen("console=");
+                       strcpy(cp, ptr);
+                       cp += strlen(ptr);
+                       *cp++ = ' ';
+                       continue;
+               }
+               strcpy(cp, prom_argv[i]);
+               cp += strlen(prom_argv[i]);
+               *cp++ = ' ';
+       }
+       if (prom_argc > 1)
+               --cp; /* trailing space */
+
+       *cp = '\0';
+}
+
+void __init prom_init(void)
+{
+       bd_t *bd = gd->bd;
+       int memsize;
+
+#ifdef CONFIG_SERIAL_ADM8668_CONSOLE
+       register_console(&early_console);
+#endif
+
+       memsize = bd->bi_memsize;
+       printk("Board info:\n");
+       printk("  Board ID: %#lx\n", bd->bi_arch_number);
+       printk("  RAM size: %d MB\n", (int)memsize/(1024*1024));
+       printk("  NOR start: %#lx\n", bd->bi_flashstart);
+       printk("  NOR size: %#lx\n", bd->bi_flashsize);
+
+       prom_setup_cmdline();
+       add_memory_region(0, memsize, BOOT_MEM_RAM);
+}