Merge branch 'adm8668'

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@23900 3c298f89-4303-0410-b956-a3cf2f4a3e73

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);
+}