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

[linux-2.6-omap-h63xx.git] / arch / mips / txx9 / generic / setup.c

diff --git a/arch/mips/txx9/generic/setup.c b/arch/mips/txx9/generic/setup.c
index 46a631177757a4368cf395c82f6ded2a38e85c8e..66ff74f80c6be1bbe832a65b09d848497c40243e 100644 (file)
--- 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();
+}