[PATCH v5 10/22] sh: Add board specific initialize of of-generic

[Yoshinori Sato]

Signed-off-by: Yoshinori Sato <ys...@users.sourceforge.jp>
---
 arch/sh/boards/of-generic.c | 64 +++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 64 insertions(+)

diff --git a/arch/sh/boards/of-generic.c b/arch/sh/boards/of-generic.c
index 2d3cda3..4038682 100644
--- a/arch/sh/boards/of-generic.c
+++ b/arch/sh/boards/of-generic.c
@@ -16,9 +16,15 @@
 #include <linux/irqchip.h>
 #include <linux/clk-provider.h>
 #include <linux/memblock.h>
+#include <linux/sm501-regs.h>
 #include <asm/machvec.h>
 #include <asm/rtc.h>
 
+struct model_setup {
+       char *name;
+       void (*fn)(void);
+};
+
 #ifdef CONFIG_SMP
 
 static void dummy_smp_setup(void)
@@ -125,10 +131,61 @@ static void __init sh_of_time_init(void)
        clocksource_probe();
 }
 
+#define PA_LED         0xb0000001      /* LED Control Register */
+#define PA_SHUTDOWN    0xb0000003      /* Shutdown Control Register */
+static void landisk_power_off(void)
+{
+       __raw_writeb(0x01, PA_SHUTDOWN);
+}
+
+static void __init landisk_setup(void)
+{
+       /* LED ON */
+       __raw_writeb(__raw_readb(PA_LED) | 0x03, PA_LED);
+       pm_power_off = landisk_power_off;
+}
+
+#define PA_POWOFF      0xa4000030      /* Board Power OFF control */
+#define PA_OUTPORT     0xa4000036      /* LED control */
+static void rts7751r2d_power_off(void)
+{
+       __raw_writew(0x0001, PA_POWOFF);
+}
+
+static void __init r2dplus_setup(void)
+{
+       void __iomem *sm501_reg;
+
+       __raw_writew(0x0000, PA_OUTPORT);
+       pm_power_off = rts7751r2d_power_off;
+
+       /* sm501 dram configuration:
+        * ColSizeX = 11 - External Memory Column Size: 256 words.
+        * APX = 1 - External Memory Active to Pre-Charge Delay: 7 clocks.
+        * RstX = 1 - External Memory Reset: Normal.
+        * Rfsh = 1 - Local Memory Refresh to Command Delay: 12 clocks.
+        * BwC =  1 - Local Memory Block Write Cycle Time: 2 clocks.
+        * BwP =  1 - Local Memory Block Write to Pre-Charge Delay: 1 clock.
+        * AP = 1 - Internal Memory Active to Pre-Charge Delay: 7 clocks.
+        * Rst = 1 - Internal Memory Reset: Normal.
+        * RA = 1 - Internal Memory Remain in Active State: Do not remain.
+        */
+
+       sm501_reg = (void __iomem *)0xb3e00000 + SM501_DRAM_CONTROL;
+       writel(readl(sm501_reg) | 0x00f107c0, sm501_reg);
+}
+
+static const struct model_setup model_setup_table[] __initconst = {
+       { .name = "iodata,HDL-U", .fn = landisk_setup, },
+       { .name = "renesas,RTS7751R2D+", .fn = r2dplus_setup, },
+       {},
+};
+
 static void __init sh_of_setup(char **cmdline_p)
 {
        struct device_node *root;
        struct device_node *cpu;
+       const struct model_setup *setup;
        u32 freq;
 
        board_time_init = sh_of_time_init;
@@ -145,6 +202,13 @@ static void __init sh_of_setup(char **cmdline_p)
        cpu = of_find_node_by_name(NULL, "cpu");
        if (!of_property_read_u32(cpu, "clock-frequency", &freq))
                preset_lpj = freq / CONFIG_HZ / 2;
+
+       for (setup = model_setup_table; setup->name; setup++) {
+               if (strcmp(setup->name, sh_mv.mv_name) == 0) {
+                       setup->fn();
+                       break;
+               }
+       }
 }
 
 static int sh_of_irq_demux(int irq)
-- 
2.7.0