|
@@ -0,0 +1,158 @@
|
|
|
+/*
|
|
|
+ * Board setup routines for the GEFanuc C2K board
|
|
|
+ *
|
|
|
+ * Author: Remi Machet <rmachet@slac.stanford.edu>
|
|
|
+ *
|
|
|
+ * Originated from prpmc2800.c
|
|
|
+ *
|
|
|
+ * 2008 (c) Stanford University
|
|
|
+ * 2007 (c) MontaVista, Software, Inc.
|
|
|
+ *
|
|
|
+ * This program is free software; you can redistribute it and/or modify it
|
|
|
+ * under the terms of the GNU General Public License version 2 as published
|
|
|
+ * by the Free Software Foundation.
|
|
|
+ */
|
|
|
+
|
|
|
+#include <linux/stddef.h>
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/delay.h>
|
|
|
+#include <linux/interrupt.h>
|
|
|
+#include <linux/seq_file.h>
|
|
|
+#include <linux/time.h>
|
|
|
+#include <linux/of.h>
|
|
|
+#include <linux/kexec.h>
|
|
|
+
|
|
|
+#include <asm/machdep.h>
|
|
|
+#include <asm/prom.h>
|
|
|
+#include <asm/system.h>
|
|
|
+#include <asm/time.h>
|
|
|
+
|
|
|
+#include <mm/mmu_decl.h>
|
|
|
+
|
|
|
+#include <sysdev/mv64x60.h>
|
|
|
+
|
|
|
+#define MV64x60_MPP_CNTL_0 0x0000
|
|
|
+#define MV64x60_MPP_CNTL_2 0x0008
|
|
|
+
|
|
|
+#define MV64x60_GPP_IO_CNTL 0x0000
|
|
|
+#define MV64x60_GPP_LEVEL_CNTL 0x0010
|
|
|
+#define MV64x60_GPP_VALUE_SET 0x0018
|
|
|
+
|
|
|
+static void __iomem *mv64x60_mpp_reg_base;
|
|
|
+static void __iomem *mv64x60_gpp_reg_base;
|
|
|
+
|
|
|
+static void __init c2k_setup_arch(void)
|
|
|
+{
|
|
|
+ struct device_node *np;
|
|
|
+ phys_addr_t paddr;
|
|
|
+ const unsigned int *reg;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * ioremap mpp and gpp registers in case they are later
|
|
|
+ * needed by c2k_reset_board().
|
|
|
+ */
|
|
|
+ np = of_find_compatible_node(NULL, NULL, "marvell,mv64360-mpp");
|
|
|
+ reg = of_get_property(np, "reg", NULL);
|
|
|
+ paddr = of_translate_address(np, reg);
|
|
|
+ of_node_put(np);
|
|
|
+ mv64x60_mpp_reg_base = ioremap(paddr, reg[1]);
|
|
|
+
|
|
|
+ np = of_find_compatible_node(NULL, NULL, "marvell,mv64360-gpp");
|
|
|
+ reg = of_get_property(np, "reg", NULL);
|
|
|
+ paddr = of_translate_address(np, reg);
|
|
|
+ of_node_put(np);
|
|
|
+ mv64x60_gpp_reg_base = ioremap(paddr, reg[1]);
|
|
|
+
|
|
|
+#ifdef CONFIG_PCI
|
|
|
+ mv64x60_pci_init();
|
|
|
+#endif
|
|
|
+}
|
|
|
+
|
|
|
+static void c2k_reset_board(void)
|
|
|
+{
|
|
|
+ u32 temp;
|
|
|
+
|
|
|
+ local_irq_disable();
|
|
|
+
|
|
|
+ temp = in_le32(mv64x60_mpp_reg_base + MV64x60_MPP_CNTL_0);
|
|
|
+ temp &= 0xFFFF0FFF;
|
|
|
+ out_le32(mv64x60_mpp_reg_base + MV64x60_MPP_CNTL_0, temp);
|
|
|
+
|
|
|
+ temp = in_le32(mv64x60_gpp_reg_base + MV64x60_GPP_LEVEL_CNTL);
|
|
|
+ temp |= 0x00000004;
|
|
|
+ out_le32(mv64x60_gpp_reg_base + MV64x60_GPP_LEVEL_CNTL, temp);
|
|
|
+
|
|
|
+ temp = in_le32(mv64x60_gpp_reg_base + MV64x60_GPP_IO_CNTL);
|
|
|
+ temp |= 0x00000004;
|
|
|
+ out_le32(mv64x60_gpp_reg_base + MV64x60_GPP_IO_CNTL, temp);
|
|
|
+
|
|
|
+ temp = in_le32(mv64x60_mpp_reg_base + MV64x60_MPP_CNTL_2);
|
|
|
+ temp &= 0xFFFF0FFF;
|
|
|
+ out_le32(mv64x60_mpp_reg_base + MV64x60_MPP_CNTL_2, temp);
|
|
|
+
|
|
|
+ temp = in_le32(mv64x60_gpp_reg_base + MV64x60_GPP_LEVEL_CNTL);
|
|
|
+ temp |= 0x00080000;
|
|
|
+ out_le32(mv64x60_gpp_reg_base + MV64x60_GPP_LEVEL_CNTL, temp);
|
|
|
+
|
|
|
+ temp = in_le32(mv64x60_gpp_reg_base + MV64x60_GPP_IO_CNTL);
|
|
|
+ temp |= 0x00080000;
|
|
|
+ out_le32(mv64x60_gpp_reg_base + MV64x60_GPP_IO_CNTL, temp);
|
|
|
+
|
|
|
+ out_le32(mv64x60_gpp_reg_base + MV64x60_GPP_VALUE_SET, 0x00080004);
|
|
|
+}
|
|
|
+
|
|
|
+static void c2k_restart(char *cmd)
|
|
|
+{
|
|
|
+ c2k_reset_board();
|
|
|
+ msleep(100);
|
|
|
+ panic("restart failed\n");
|
|
|
+}
|
|
|
+
|
|
|
+#ifdef CONFIG_NOT_COHERENT_CACHE
|
|
|
+#define COHERENCY_SETTING "off"
|
|
|
+#else
|
|
|
+#define COHERENCY_SETTING "on"
|
|
|
+#endif
|
|
|
+
|
|
|
+void c2k_show_cpuinfo(struct seq_file *m)
|
|
|
+{
|
|
|
+ uint memsize = total_memory;
|
|
|
+
|
|
|
+ seq_printf(m, "Vendor\t\t: GEFanuc\n");
|
|
|
+ seq_printf(m, "Memory\t\t: %d MB\n", memsize / (1024 * 1024));
|
|
|
+ seq_printf(m, "coherency\t: %s\n", COHERENCY_SETTING);
|
|
|
+}
|
|
|
+
|
|
|
+/*
|
|
|
+ * Called very early, device-tree isn't unflattened
|
|
|
+ */
|
|
|
+static int __init c2k_probe(void)
|
|
|
+{
|
|
|
+ unsigned long root = of_get_flat_dt_root();
|
|
|
+
|
|
|
+ if (!of_flat_dt_is_compatible(root, "GEFanuc,C2K"))
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ printk(KERN_INFO "Detected a GEFanuc C2K board\n");
|
|
|
+
|
|
|
+ _set_L2CR(0);
|
|
|
+ _set_L2CR(L2CR_L2E | L2CR_L2PE | L2CR_L2I);
|
|
|
+ return 1;
|
|
|
+}
|
|
|
+
|
|
|
+define_machine(c2k) {
|
|
|
+ .name = "C2K",
|
|
|
+ .probe = c2k_probe,
|
|
|
+ .setup_arch = c2k_setup_arch,
|
|
|
+ .init_early = mv64x60_init_early,
|
|
|
+ .show_cpuinfo = c2k_show_cpuinfo,
|
|
|
+ .init_IRQ = mv64x60_init_irq,
|
|
|
+ .get_irq = mv64x60_get_irq,
|
|
|
+ .restart = c2k_restart,
|
|
|
+ .calibrate_decr = generic_calibrate_decr,
|
|
|
+#ifdef CONFIG_KEXEC
|
|
|
+ .machine_kexec = default_machine_kexec,
|
|
|
+ .machine_kexec_prepare = default_machine_kexec_prepare,
|
|
|
+ .machine_crash_shutdown = default_machine_crash_shutdown,
|
|
|
+#endif
|
|
|
+};
|