[MIPS] TXx9: Make single kernel can support multiple boards

Make single kernel can be used on RBTX4927/37/38.  Also make
some SoC-specific code independent from board-specific code.

Signed-off-by: Atsushi Nemoto <anemo@mba.ocn.ne.jp>
Signed-off-by: Ralf Baechle <ralf@linux-mips.org>

1 files changed, 169 insertions, 0 deletions

diff --git a/arch/mips/txx9/generic/setup.c b/arch/mips/txx9/generic/setup.c
index 46a631177757..66ff74f80c6b 100644
--- a/arch/mips/txx9/generic/setup.c
+++ b/arch/mips/txx9/generic/setup.c
@@ -14,7 +14,16 @@
 #include <linux/init.h>
 #include <linux/kernel.h>
 #include <linux/types.h>
+#include <linux/interrupt.h>
+#include <linux/string.h>
+#include <linux/module.h>
+#include <linux/clk.h>
+#include <linux/err.h>
+#include <asm/bootinfo.h>
 #include <asm/txx9/generic.h>
+#ifdef CONFIG_CPU_TX49XX
+#include <asm/txx9/tx4938.h>
+#endif
 
 /* EBUSC settings of TX4927, etc. */
 struct resource txx9_ce_res[8];
@@ -49,3 +58,163 @@ txx9_reg_res_init(unsigned int pcode, unsigned long base, unsigned long size)
 unsigned int txx9_master_clock;
 unsigned int txx9_cpu_clock;
 unsigned int txx9_gbus_clock;
+
+
+/* Minimum CLK support */
+
+struct clk *clk_get(struct device *dev, const char *id)
+{
+        if (!strcmp(id, "spi-baseclk"))
+                return (struct clk *)(txx9_gbus_clock / 2 / 4);
+        if (!strcmp(id, "imbus_clk"))
+                return (struct clk *)(txx9_gbus_clock / 2);
+        return ERR_PTR(-ENOENT);
+}
+EXPORT_SYMBOL(clk_get);
+
+int clk_enable(struct clk *clk)
+{
+        return 0;
+}
+EXPORT_SYMBOL(clk_enable);
+
+void clk_disable(struct clk *clk)
+{
+}
+EXPORT_SYMBOL(clk_disable);
+
+unsigned long clk_get_rate(struct clk *clk)
+{
+        return (unsigned long)clk;
+}
+EXPORT_SYMBOL(clk_get_rate);
+
+void clk_put(struct clk *clk)
+{
+}
+EXPORT_SYMBOL(clk_put);
+
+extern struct txx9_board_vec jmr3927_vec;
+extern struct txx9_board_vec rbtx4927_vec;
+extern struct txx9_board_vec rbtx4937_vec;
+extern struct txx9_board_vec rbtx4938_vec;
+
+/* board definitions */
+static struct txx9_board_vec *board_vecs[] __initdata = {
+#ifdef CONFIG_TOSHIBA_JMR3927
+        &jmr3927_vec,
+#endif
+#ifdef CONFIG_TOSHIBA_RBTX4927
+        &rbtx4927_vec,
+        &rbtx4937_vec,
+#endif
+#ifdef CONFIG_TOSHIBA_RBTX4938
+        &rbtx4938_vec,
+#endif
+};
+struct txx9_board_vec *txx9_board_vec __initdata;
+static char txx9_system_type[32];
+
+void __init prom_init_cmdline(void)
+{
+        int argc = (int)fw_arg0;
+        char **argv = (char **)fw_arg1;
+        int i;                  /* Always ignore the "-c" at argv[0] */
+
+        /* ignore all built-in args if any f/w args given */
+        if (argc > 1)
+                *arcs_cmdline = '\0';
+
+        for (i = 1; i < argc; i++) {
+                if (i != 1)
+                        strcat(arcs_cmdline, " ");
+                strcat(arcs_cmdline, argv[i]);
+        }
+}
+
+void __init prom_init(void)
+{
+        int i;
+
+#ifdef CONFIG_CPU_TX39XX
+        mips_machtype = MACH_TOSHIBA_JMR3927;
+#endif
+#ifdef CONFIG_CPU_TX49XX
+        switch (TX4938_REV_PCODE()) {
+        case 0x4927:
+                mips_machtype = MACH_TOSHIBA_RBTX4927;
+                break;
+        case 0x4937:
+                mips_machtype = MACH_TOSHIBA_RBTX4937;
+                break;
+        case 0x4938:
+                mips_machtype = MACH_TOSHIBA_RBTX4938;
+                break;
+        }
+#endif
+        for (i = 0; i < ARRAY_SIZE(board_vecs); i++) {
+                if (board_vecs[i]->type == mips_machtype) {
+                        txx9_board_vec = board_vecs[i];
+                        strcpy(txx9_system_type, txx9_board_vec->system);
+                        return txx9_board_vec->prom_init();
+                }
+        }
+}
+
+void __init prom_free_prom_memory(void)
+{
+}
+
+const char *get_system_type(void)
+{
+        return txx9_system_type;
+}
+
+char * __init prom_getcmdline(void)
+{
+        return &(arcs_cmdline[0]);
+}
+
+/* wrappers */
+void __init plat_mem_setup(void)
+{
+        txx9_board_vec->mem_setup();
+}
+
+void __init arch_init_irq(void)
+{
+        txx9_board_vec->irq_setup();
+}
+
+void __init plat_time_init(void)
+{
+        txx9_board_vec->time_init();
+}
+
+static int __init _txx9_arch_init(void)
+{
+        if (txx9_board_vec->arch_init)
+                txx9_board_vec->arch_init();
+        return 0;
+}
+arch_initcall(_txx9_arch_init);
+
+static int __init _txx9_device_init(void)
+{
+        if (txx9_board_vec->device_init)
+                txx9_board_vec->device_init();
+        return 0;
+}
+device_initcall(_txx9_device_init);
+
+int (*txx9_irq_dispatch)(int pending);
+asmlinkage void plat_irq_dispatch(void)
+{
+        int pending = read_c0_status() & read_c0_cause() & ST0_IM;
+        int irq = txx9_irq_dispatch(pending);
+
+        if (likely(irq >= 0))
+                do_IRQ(irq);
+        else
+                spurious_interrupt();
+}