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..709006a 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 = "I/O DATA 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
