On Mon, Jul 04, 2016 at 01:46:30AM +0900, Yoshinori Sato wrote: > 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) > --
I think all of this code should be in appropriate driver files, not of-generic.c. Much of it looks like it should be pm (power management) drivers for which I'd assume there's an existing framework. I'm not sure about the DRAM control. For the LED I think there's an LED GPIO framework already too that would be appropriate and that probably only needs appropriate nodes in the DT, not even any code. Rich