sh: clkfwk: beyond ARRAY_SIZE of onchip_ops for sh7722.
[safe/jmp/linux-2.6] / arch / sh / kernel / cpu / sh4a / clock-sh7722.c
index 69ab62d..c090c9a 100644 (file)
@@ -130,6 +130,12 @@ static void adjust_clocks(int originate, int *l, unsigned long v[],
  * is quite simple..
  */
 
+#if defined(CONFIG_CPU_SUBTYPE_SH7724)
+#define STCPLL(frqcr) ((((frqcr >> 24) & 0x3f) + 1) * 2)
+#else
+#define STCPLL(frqcr) (((frqcr >> 24) & 0x1f) + 1)
+#endif
+
 /*
  * Instead of having two separate multipliers/divisors set, like this:
  *
@@ -139,35 +145,53 @@ static void adjust_clocks(int originate, int *l, unsigned long v[],
  * I created the divisors2 array, which is used to calculate rate like
  *   rate = parent * 2 / divisors2[ divisor ];
 */
+#if defined(CONFIG_CPU_SUBTYPE_SH7724)
+static int divisors2[] = { 4, 1, 8, 12, 16, 24, 32, 1, 48, 64, 72, 96, 1, 144 };
+#else
 static int divisors2[] = { 2, 3, 4, 5, 6, 8, 10, 12, 16, 20, 24, 32, 40 };
+#endif
 
-static void master_clk_recalc(struct clk *clk)
+static unsigned long master_clk_recalc(struct clk *clk)
 {
        unsigned frqcr = ctrl_inl(FRQCR);
 
-       clk->rate = CONFIG_SH_PCLK_FREQ * (((frqcr >> 24) & 0x1f) + 1);
+       return CONFIG_SH_PCLK_FREQ * STCPLL(frqcr);
 }
 
 static void master_clk_init(struct clk *clk)
 {
        clk->parent = NULL;
-       clk->flags |= CLK_RATE_PROPAGATES;
-       clk->rate = CONFIG_SH_PCLK_FREQ;
-       master_clk_recalc(clk);
+       clk->rate = master_clk_recalc(clk);
 }
 
-
-static void module_clk_recalc(struct clk *clk)
+static unsigned long module_clk_recalc(struct clk *clk)
 {
        unsigned long frqcr = ctrl_inl(FRQCR);
 
-       clk->rate = clk->parent->rate / (((frqcr >> 24) & 0x1f) + 1);
+       return clk->parent->rate / STCPLL(frqcr);
 }
 
+#if defined(CONFIG_CPU_SUBTYPE_SH7724)
+#define MASTERDIVS     { 12, 16, 24, 30, 32, 36, 48 }
+#define STCMASK                0x3f
+#define DIVCALC(div)   (div/2-1)
+#define FRQCRKICK      0x80000000
+#elif defined(CONFIG_CPU_SUBTYPE_SH7723)
+#define MASTERDIVS     { 6, 8, 12, 16 }
+#define STCMASK                0x1f
+#define DIVCALC(div)   (div-1)
+#define FRQCRKICK      0x00000000
+#else
+#define MASTERDIVS     { 2, 3, 4, 6, 8, 16 }
+#define STCMASK                0x1f
+#define DIVCALC(div)   (div-1)
+#define FRQCRKICK      0x00000000
+#endif
+
 static int master_clk_setrate(struct clk *clk, unsigned long rate, int id)
 {
        int div = rate / clk->rate;
-       int master_divs[] = { 2, 3, 4, 6, 8, 16 };
+       int master_divs[] = MASTERDIVS;
        int index;
        unsigned long frqcr;
 
@@ -180,8 +204,9 @@ static int master_clk_setrate(struct clk *clk, unsigned long rate, int id)
        div = master_divs[index - 1];
 
        frqcr = ctrl_inl(FRQCR);
-       frqcr &= ~(0xF << 24);
-       frqcr |= ( (div-1) << 24);
+       frqcr &= ~(STCMASK << 24);
+       frqcr |= (DIVCALC(div) << 24);
+       frqcr |= FRQCRKICK;
        ctrl_outl(frqcr, FRQCR);
 
        return 0;
@@ -255,14 +280,14 @@ static int sh7722_find_div_index(unsigned long parent_rate, unsigned rate)
        return index;
 }
 
-static void sh7722_frqcr_recalc(struct clk *clk)
+static unsigned long sh7722_frqcr_recalc(struct clk *clk)
 {
        struct frqcr_context ctx = sh7722_get_clk_context(clk->name);
        unsigned long frqcr = ctrl_inl(FRQCR);
        int index;
 
        index = (frqcr >> ctx.shift) & ctx.mask;
-       clk->rate = clk->parent->rate * 2 / divisors2[index];
+       return clk->parent->rate * 2 / divisors2[index];
 }
 
 static int sh7722_frqcr_set_rate(struct clk *clk, unsigned long rate,
@@ -377,6 +402,7 @@ static int sh7722_frqcr_set_rate(struct clk *clk, unsigned long rate,
        /* clear FRQCR bits */
        frqcr &= ~(ctx.mask << ctx.shift);
        frqcr |= div << ctx.shift;
+       frqcr |= FRQCRKICK;
 
        /* ...and perform actual change */
        ctrl_outl(frqcr, FRQCR);
@@ -410,11 +436,8 @@ static struct clk_ops sh7722_frqcr_clk_ops = {
 
 /*
  * clock ops methods for SIU A/B and IrDA clock
- *
  */
-
 #ifndef CONFIG_CPU_SUBTYPE_SH7343
-
 static int sh7722_siu_set_rate(struct clk *clk, unsigned long rate, int algo_id)
 {
        unsigned long r;
@@ -429,12 +452,12 @@ static int sh7722_siu_set_rate(struct clk *clk, unsigned long rate, int algo_id)
        return 0;
 }
 
-static void sh7722_siu_recalc(struct clk *clk)
+static unsigned long sh7722_siu_recalc(struct clk *clk)
 {
        unsigned long r;
 
        r = ctrl_inl(clk->arch_flags);
-       clk->rate = clk->parent->rate * 2 / divisors2[r & 0xF];
+       return clk->parent->rate * 2 / divisors2[r & 0xF];
 }
 
 static int sh7722_siu_start_stop(struct clk *clk, int enable)
@@ -449,9 +472,9 @@ static int sh7722_siu_start_stop(struct clk *clk, int enable)
        return 0;
 }
 
-static void sh7722_siu_enable(struct clk *clk)
+static int sh7722_siu_enable(struct clk *clk)
 {
-       sh7722_siu_start_stop(clk, 1);
+       return sh7722_siu_start_stop(clk, 1);
 }
 
 static void sh7722_siu_disable(struct clk *clk)
@@ -468,12 +491,13 @@ static struct clk_ops sh7722_siu_clk_ops = {
 
 #endif /* CONFIG_CPU_SUBTYPE_SH7343 */
 
-static void sh7722_video_enable(struct clk *clk)
+static int sh7722_video_enable(struct clk *clk)
 {
        unsigned long r;
 
        r = ctrl_inl(VCLKCR);
        ctrl_outl( r & ~(1<<8), VCLKCR);
+       return 0;
 }
 
 static void sh7722_video_disable(struct clk *clk)
@@ -496,12 +520,12 @@ static int sh7722_video_set_rate(struct clk *clk, unsigned long rate,
        return 0;
 }
 
-static void sh7722_video_recalc(struct clk *clk)
+static unsigned long sh7722_video_recalc(struct clk *clk)
 {
        unsigned long r;
 
        r = ctrl_inl(VCLKCR);
-       clk->rate = clk->parent->rate / ((r & 0x3F) + 1);
+       return clk->parent->rate / ((r & 0x3F) + 1);
 }
 
 static struct clk_ops sh7722_video_clk_ops = {
@@ -533,9 +557,13 @@ static struct clk sh7722_sdram_clock = {
        .ops = &sh7722_frqcr_clk_ops,
 };
 
+static struct clk sh7722_r_clock = {
+       .name = "r_clk",
+       .rate = 32768,
+};
 
-#ifndef CONFIG_CPU_SUBTYPE_SH7343
-
+#if !defined(CONFIG_CPU_SUBTYPE_SH7343) &&\
+    !defined(CONFIG_CPU_SUBTYPE_SH7724)
 /*
  * these three clocks - SIU A, SIU B, IrDA - share the same clk_ops
  * methods of clk_ops determine which register they should access by
@@ -552,15 +580,16 @@ static struct clk sh7722_siu_b_clock = {
        .arch_flags = SCLKBCR,
        .ops = &sh7722_siu_clk_ops,
 };
+#endif /* CONFIG_CPU_SUBTYPE_SH7343, SH7724 */
 
-#if defined(CONFIG_CPU_SUBTYPE_SH7722)
+#if defined(CONFIG_CPU_SUBTYPE_SH7722) ||\
+    defined(CONFIG_CPU_SUBTYPE_SH7724)
 static struct clk sh7722_irda_clock = {
        .name = "irda_clk",
        .arch_flags = IrDACLKCR,
        .ops = &sh7722_siu_clk_ops,
 };
 #endif
-#endif /* CONFIG_CPU_SUBTYPE_SH7343 */
 
 static struct clk sh7722_video_clock = {
        .name = "video_clk",
@@ -589,7 +618,7 @@ static int sh7722_mstpcr_start_stop(struct clk *clk, int enable)
                break;
        default:
                return -EINVAL;
-       }  
+       }
 
        r = ctrl_inl(reg);
 
@@ -602,9 +631,9 @@ static int sh7722_mstpcr_start_stop(struct clk *clk, int enable)
        return 0;
 }
 
-static void sh7722_mstpcr_enable(struct clk *clk)
+static int sh7722_mstpcr_enable(struct clk *clk)
 {
-       sh7722_mstpcr_start_stop(clk, 1);
+       return sh7722_mstpcr_start_stop(clk, 1);
 }
 
 static void sh7722_mstpcr_disable(struct clk *clk)
@@ -615,53 +644,212 @@ static void sh7722_mstpcr_disable(struct clk *clk)
 static struct clk_ops sh7722_mstpcr_clk_ops = {
        .enable = sh7722_mstpcr_enable,
        .disable = sh7722_mstpcr_disable,
+       .recalc = followparent_recalc,
 };
 
-#define DECLARE_MSTPCRN(regnr, bitnr, bitstr)          \
-{                                                      \
-       .name = "mstp" __stringify(regnr) bitstr,       \
+#define MSTPCR(_name, _parent, regnr, bitnr, _flags) \
+{                                              \
+       .name = _name,                          \
+       .flags = _flags,                        \
        .arch_flags = MSTPCR_ARCH_FLAGS(regnr, bitnr),  \
-       .ops = &sh7722_mstpcr_clk_ops,  \
+       .ops = (void *)_parent,         \
 }
 
-#define DECLARE_MSTPCR(regnr) \
-       DECLARE_MSTPCRN(regnr, 31, "31"), \
-       DECLARE_MSTPCRN(regnr, 30, "30"), \
-       DECLARE_MSTPCRN(regnr, 29, "29"), \
-       DECLARE_MSTPCRN(regnr, 28, "28"), \
-       DECLARE_MSTPCRN(regnr, 27, "27"), \
-       DECLARE_MSTPCRN(regnr, 26, "26"), \
-       DECLARE_MSTPCRN(regnr, 25, "25"), \
-       DECLARE_MSTPCRN(regnr, 24, "24"), \
-       DECLARE_MSTPCRN(regnr, 23, "23"), \
-       DECLARE_MSTPCRN(regnr, 22, "22"), \
-       DECLARE_MSTPCRN(regnr, 21, "21"), \
-       DECLARE_MSTPCRN(regnr, 20, "20"), \
-       DECLARE_MSTPCRN(regnr, 19, "19"), \
-       DECLARE_MSTPCRN(regnr, 18, "18"), \
-       DECLARE_MSTPCRN(regnr, 17, "17"), \
-       DECLARE_MSTPCRN(regnr, 16, "16"), \
-       DECLARE_MSTPCRN(regnr, 15, "15"), \
-       DECLARE_MSTPCRN(regnr, 14, "14"), \
-       DECLARE_MSTPCRN(regnr, 13, "13"), \
-       DECLARE_MSTPCRN(regnr, 12, "12"), \
-       DECLARE_MSTPCRN(regnr, 11, "11"), \
-       DECLARE_MSTPCRN(regnr, 10, "10"), \
-       DECLARE_MSTPCRN(regnr, 9, "09"), \
-       DECLARE_MSTPCRN(regnr, 8, "08"), \
-       DECLARE_MSTPCRN(regnr, 7, "07"), \
-       DECLARE_MSTPCRN(regnr, 6, "06"), \
-       DECLARE_MSTPCRN(regnr, 5, "05"), \
-       DECLARE_MSTPCRN(regnr, 4, "04"), \
-       DECLARE_MSTPCRN(regnr, 3, "03"), \
-       DECLARE_MSTPCRN(regnr, 2, "02"), \
-       DECLARE_MSTPCRN(regnr, 1, "01"), \
-       DECLARE_MSTPCRN(regnr, 0, "00")
-
-static struct clk sh7722_mstpcr[] = {
-       DECLARE_MSTPCR(0),
-       DECLARE_MSTPCR(1),
-       DECLARE_MSTPCR(2),
+static struct clk sh7722_mstpcr_clocks[] = {
+#if defined(CONFIG_CPU_SUBTYPE_SH7722)
+       MSTPCR("uram0", "umem_clk", 0, 28, CLK_ENABLE_ON_INIT),
+       MSTPCR("xymem0", "bus_clk", 0, 26, CLK_ENABLE_ON_INIT),
+       MSTPCR("tmu0", "peripheral_clk", 0, 15, 0),
+       MSTPCR("cmt0", "r_clk", 0, 14, 0),
+       MSTPCR("rwdt0", "r_clk", 0, 13, 0),
+       MSTPCR("flctl0", "peripheral_clk", 0, 10, 0),
+       MSTPCR("scif0", "peripheral_clk", 0, 7, 0),
+       MSTPCR("scif1", "peripheral_clk", 0, 6, 0),
+       MSTPCR("scif2", "peripheral_clk", 0, 5, 0),
+       MSTPCR("i2c0", "peripheral_clk", 1, 9, 0),
+       MSTPCR("rtc0", "r_clk", 1, 8, 0),
+       MSTPCR("sdhi0", "peripheral_clk", 2, 18, 0),
+       MSTPCR("keysc0", "r_clk", 2, 14, 0),
+       MSTPCR("usbf0", "peripheral_clk", 2, 11, 0),
+       MSTPCR("2dg0", "bus_clk", 2, 9, 0),
+       MSTPCR("siu0", "bus_clk", 2, 8, 0),
+       MSTPCR("vou0", "bus_clk", 2, 5, 0),
+       MSTPCR("jpu0", "bus_clk", 2, 6, CLK_ENABLE_ON_INIT),
+       MSTPCR("beu0", "bus_clk", 2, 4, 0),
+       MSTPCR("ceu0", "bus_clk", 2, 3, 0),
+       MSTPCR("veu0", "bus_clk", 2, 2, CLK_ENABLE_ON_INIT),
+       MSTPCR("vpu0", "bus_clk", 2, 1, CLK_ENABLE_ON_INIT),
+       MSTPCR("lcdc0", "bus_clk", 2, 0, 0),
+#endif
+#if defined(CONFIG_CPU_SUBTYPE_SH7723)
+       /* See page 60 of Datasheet V1.0: Overview -> Block Diagram */
+       MSTPCR("tlb0", "cpu_clk", 0, 31, 0),
+       MSTPCR("ic0", "cpu_clk", 0, 30, 0),
+       MSTPCR("oc0", "cpu_clk", 0, 29, 0),
+       MSTPCR("l2c0", "sh_clk", 0, 28, 0),
+       MSTPCR("ilmem0", "cpu_clk", 0, 27, 0),
+       MSTPCR("fpu0", "cpu_clk", 0, 24, 0),
+       MSTPCR("intc0", "cpu_clk", 0, 22, 0),
+       MSTPCR("dmac0", "bus_clk", 0, 21, 0),
+       MSTPCR("sh0", "sh_clk", 0, 20, 0),
+       MSTPCR("hudi0", "peripheral_clk", 0, 19, 0),
+       MSTPCR("ubc0", "cpu_clk", 0, 17, 0),
+       MSTPCR("tmu0", "peripheral_clk", 0, 15, 0),
+       MSTPCR("cmt0", "r_clk", 0, 14, 0),
+       MSTPCR("rwdt0", "r_clk", 0, 13, 0),
+       MSTPCR("dmac1", "bus_clk", 0, 12, 0),
+       MSTPCR("tmu1", "peripheral_clk", 0, 11, 0),
+       MSTPCR("flctl0", "peripheral_clk", 0, 10, 0),
+       MSTPCR("scif0", "peripheral_clk", 0, 9, 0),
+       MSTPCR("scif1", "peripheral_clk", 0, 8, 0),
+       MSTPCR("scif2", "peripheral_clk", 0, 7, 0),
+       MSTPCR("scif3", "bus_clk", 0, 6, 0),
+       MSTPCR("scif4", "bus_clk", 0, 5, 0),
+       MSTPCR("scif5", "bus_clk", 0, 4, 0),
+       MSTPCR("msiof0", "bus_clk", 0, 2, 0),
+       MSTPCR("msiof1", "bus_clk", 0, 1, 0),
+       MSTPCR("meram0", "sh_clk", 0, 0, CLK_ENABLE_ON_INIT),
+       MSTPCR("i2c0", "peripheral_clk", 1, 9, 0),
+       MSTPCR("rtc0", "r_clk", 1, 8, 0),
+       MSTPCR("atapi0", "sh_clk", 2, 28, 0),
+       MSTPCR("adc0", "peripheral_clk", 2, 28, 0),
+       MSTPCR("tpu0", "bus_clk", 2, 25, 0),
+       MSTPCR("irda0", "peripheral_clk", 2, 24, 0),
+       MSTPCR("tsif0", "bus_clk", 2, 22, 0),
+       MSTPCR("icb0", "bus_clk", 2, 21, 0),
+       MSTPCR("sdhi0", "bus_clk", 2, 18, 0),
+       MSTPCR("sdhi1", "bus_clk", 2, 17, 0),
+       MSTPCR("keysc0", "r_clk", 2, 14, 0),
+       MSTPCR("usb0", "bus_clk", 2, 11, 0),
+       MSTPCR("2dg0", "bus_clk", 2, 10, 0),
+       MSTPCR("siu0", "bus_clk", 2, 8, 0),
+       MSTPCR("veu1", "bus_clk", 2, 6, CLK_ENABLE_ON_INIT),
+       MSTPCR("vou0", "bus_clk", 2, 5, 0),
+       MSTPCR("beu0", "bus_clk", 2, 4, 0),
+       MSTPCR("ceu0", "bus_clk", 2, 3, 0),
+       MSTPCR("veu0", "bus_clk", 2, 2, CLK_ENABLE_ON_INIT),
+       MSTPCR("vpu0", "bus_clk", 2, 1, CLK_ENABLE_ON_INIT),
+       MSTPCR("lcdc0", "bus_clk", 2, 0, 0),
+#endif
+#if defined(CONFIG_CPU_SUBTYPE_SH7724)
+       /* See Datasheet : Overview -> Block Diagram */
+       MSTPCR("tlb0", "cpu_clk", 0, 31, 0),
+       MSTPCR("ic0", "cpu_clk", 0, 30, 0),
+       MSTPCR("oc0", "cpu_clk", 0, 29, 0),
+       MSTPCR("rs0", "bus_clk", 0, 28, 0),
+       MSTPCR("ilmem0", "cpu_clk", 0, 27, 0),
+       MSTPCR("l2c0", "sh_clk", 0, 26, 0),
+       MSTPCR("fpu0", "cpu_clk", 0, 24, 0),
+       MSTPCR("intc0", "peripheral_clk", 0, 22, 0),
+       MSTPCR("dmac0", "bus_clk", 0, 21, 0),
+       MSTPCR("sh0", "sh_clk", 0, 20, 0),
+       MSTPCR("hudi0", "peripheral_clk", 0, 19, 0),
+       MSTPCR("ubc0", "cpu_clk", 0, 17, 0),
+       MSTPCR("tmu0", "peripheral_clk", 0, 15, 0),
+       MSTPCR("cmt0", "r_clk", 0, 14, 0),
+       MSTPCR("rwdt0", "r_clk", 0, 13, 0),
+       MSTPCR("dmac1", "bus_clk", 0, 12, 0),
+       MSTPCR("tmu1", "peripheral_clk", 0, 10, 0),
+       MSTPCR("scif0", "peripheral_clk", 0, 9, 0),
+       MSTPCR("scif1", "peripheral_clk", 0, 8, 0),
+       MSTPCR("scif2", "peripheral_clk", 0, 7, 0),
+       MSTPCR("scif3", "bus_clk", 0, 6, 0),
+       MSTPCR("scif4", "bus_clk", 0, 5, 0),
+       MSTPCR("scif5", "bus_clk", 0, 4, 0),
+       MSTPCR("msiof0", "bus_clk", 0, 2, 0),
+       MSTPCR("msiof1", "bus_clk", 0, 1, 0),
+       MSTPCR("keysc0", "r_clk", 1, 12, 0),
+       MSTPCR("rtc0", "r_clk", 1, 11, 0),
+       MSTPCR("i2c0", "peripheral_clk", 1, 9, 0),
+       MSTPCR("i2c1", "peripheral_clk", 1, 8, 0),
+       MSTPCR("mmc0", "bus_clk", 2, 29, 0),
+       MSTPCR("eth0", "bus_clk", 2, 28, 0),
+       MSTPCR("atapi0", "bus_clk", 2, 26, 0),
+       MSTPCR("tpu0", "bus_clk", 2, 25, 0),
+       MSTPCR("irda0", "peripheral_clk", 2, 24, 0),
+       MSTPCR("tsif0", "bus_clk", 2, 22, 0),
+       MSTPCR("usb1", "bus_clk", 2, 21, 0),
+       MSTPCR("usb0", "bus_clk", 2, 20, 0),
+       MSTPCR("2dg0", "bus_clk", 2, 19, 0),
+       MSTPCR("sdhi0", "bus_clk", 2, 18, 0),
+       MSTPCR("sdhi1", "bus_clk", 2, 17, 0),
+       MSTPCR("veu1", "bus_clk", 2, 15, CLK_ENABLE_ON_INIT),
+       MSTPCR("ceu1", "bus_clk", 2, 13, 0),
+       MSTPCR("beu1", "bus_clk", 2, 12, 0),
+       MSTPCR("2ddmac0", "sh_clk", 2, 10, 0),
+       MSTPCR("spu0", "bus_clk", 2, 9, 0),
+       MSTPCR("jpu0", "bus_clk", 2, 6, 0),
+       MSTPCR("vou0", "bus_clk", 2, 5, 0),
+       MSTPCR("beu0", "bus_clk", 2, 4, 0),
+       MSTPCR("ceu0", "bus_clk", 2, 3, 0),
+       MSTPCR("veu0", "bus_clk", 2, 2, CLK_ENABLE_ON_INIT),
+       MSTPCR("vpu0", "bus_clk", 2, 1, CLK_ENABLE_ON_INIT),
+       MSTPCR("lcdc0", "bus_clk", 2, 0, 0),
+#endif
+#if defined(CONFIG_CPU_SUBTYPE_SH7343)
+       MSTPCR("uram0", "umem_clk", 0, 28, CLK_ENABLE_ON_INIT),
+       MSTPCR("xymem0", "bus_clk", 0, 26, CLK_ENABLE_ON_INIT),
+       MSTPCR("tmu0", "peripheral_clk", 0, 15, 0),
+       MSTPCR("cmt0", "r_clk", 0, 14, 0),
+       MSTPCR("rwdt0", "r_clk", 0, 13, 0),
+       MSTPCR("scif0", "peripheral_clk", 0, 7, 0),
+       MSTPCR("scif1", "peripheral_clk", 0, 6, 0),
+       MSTPCR("scif2", "peripheral_clk", 0, 5, 0),
+       MSTPCR("scif3", "peripheral_clk", 0, 4, 0),
+       MSTPCR("i2c0", "peripheral_clk", 1, 9, 0),
+       MSTPCR("i2c1", "peripheral_clk", 1, 8, 0),
+       MSTPCR("sdhi0", "peripheral_clk", 2, 18, 0),
+       MSTPCR("keysc0", "r_clk", 2, 14, 0),
+       MSTPCR("usbf0", "peripheral_clk", 2, 11, 0),
+       MSTPCR("siu0", "bus_clk", 2, 8, 0),
+       MSTPCR("jpu0", "bus_clk", 2, 6, CLK_ENABLE_ON_INIT),
+       MSTPCR("vou0", "bus_clk", 2, 5, 0),
+       MSTPCR("beu0", "bus_clk", 2, 4, 0),
+       MSTPCR("ceu0", "bus_clk", 2, 3, 0),
+       MSTPCR("veu0", "bus_clk", 2, 2, CLK_ENABLE_ON_INIT),
+       MSTPCR("vpu0", "bus_clk", 2, 1, CLK_ENABLE_ON_INIT),
+       MSTPCR("lcdc0", "bus_clk", 2, 0, 0),
+#endif
+#if defined(CONFIG_CPU_SUBTYPE_SH7366)
+       /* See page 52 of Datasheet V0.40: Overview -> Block Diagram */
+       MSTPCR("tlb0", "cpu_clk", 0, 31, 0),
+       MSTPCR("ic0", "cpu_clk", 0, 30, 0),
+       MSTPCR("oc0", "cpu_clk", 0, 29, 0),
+       MSTPCR("rsmem0", "sh_clk", 0, 28, CLK_ENABLE_ON_INIT),
+       MSTPCR("xymem0", "cpu_clk", 0, 26, CLK_ENABLE_ON_INIT),
+       MSTPCR("intc30", "peripheral_clk", 0, 23, 0),
+       MSTPCR("intc0", "peripheral_clk", 0, 22, 0),
+       MSTPCR("dmac0", "bus_clk", 0, 21, 0),
+       MSTPCR("sh0", "sh_clk", 0, 20, 0),
+       MSTPCR("hudi0", "peripheral_clk", 0, 19, 0),
+       MSTPCR("ubc0", "cpu_clk", 0, 17, 0),
+       MSTPCR("tmu0", "peripheral_clk", 0, 15, 0),
+       MSTPCR("cmt0", "r_clk", 0, 14, 0),
+       MSTPCR("rwdt0", "r_clk", 0, 13, 0),
+       MSTPCR("flctl0", "peripheral_clk", 0, 10, 0),
+       MSTPCR("scif0", "peripheral_clk", 0, 7, 0),
+       MSTPCR("scif1", "bus_clk", 0, 6, 0),
+       MSTPCR("scif2", "bus_clk", 0, 5, 0),
+       MSTPCR("msiof0", "peripheral_clk", 0, 2, 0),
+       MSTPCR("sbr0", "peripheral_clk", 0, 1, 0),
+       MSTPCR("i2c0", "peripheral_clk", 1, 9, 0),
+       MSTPCR("icb0", "bus_clk", 2, 27, 0),
+       MSTPCR("meram0", "sh_clk", 2, 26, 0),
+       MSTPCR("dacc0", "peripheral_clk", 2, 24, 0),
+       MSTPCR("dacy0", "peripheral_clk", 2, 23, 0),
+       MSTPCR("tsif0", "bus_clk", 2, 22, 0),
+       MSTPCR("sdhi0", "bus_clk", 2, 18, 0),
+       MSTPCR("mmcif0", "bus_clk", 2, 17, 0),
+       MSTPCR("usb0", "bus_clk", 2, 11, 0),
+       MSTPCR("siu0", "bus_clk", 2, 8, 0),
+       MSTPCR("veu1", "bus_clk", 2, 7, CLK_ENABLE_ON_INIT),
+       MSTPCR("vou0", "bus_clk", 2, 5, 0),
+       MSTPCR("beu0", "bus_clk", 2, 4, 0),
+       MSTPCR("ceu0", "bus_clk", 2, 3, 0),
+       MSTPCR("veu0", "bus_clk", 2, 2, CLK_ENABLE_ON_INIT),
+       MSTPCR("vpu0", "bus_clk", 2, 1, CLK_ENABLE_ON_INIT),
+       MSTPCR("lcdc0", "bus_clk", 2, 0, 0),
+#endif
 };
 
 static struct clk *sh7722_clocks[] = {
@@ -669,12 +857,15 @@ static struct clk *sh7722_clocks[] = {
        &sh7722_sh_clock,
        &sh7722_peripheral_clock,
        &sh7722_sdram_clock,
-#ifndef CONFIG_CPU_SUBTYPE_SH7343
+#if !defined(CONFIG_CPU_SUBTYPE_SH7343) &&\
+    !defined(CONFIG_CPU_SUBTYPE_SH7724)
        &sh7722_siu_a_clock,
        &sh7722_siu_b_clock,
-#if defined(CONFIG_CPU_SUBTYPE_SH7722)
-       &sh7722_irda_clock,
 #endif
+/* 7724 should support FSI clock */
+#if defined(CONFIG_CPU_SUBTYPE_SH7722) || \
+    defined(CONFIG_CPU_SUBTYPE_SH7724)
+       &sh7722_irda_clock,
 #endif
        &sh7722_video_clock,
 };
@@ -692,27 +883,38 @@ struct clk_ops *onchip_ops[] = {
 void __init
 arch_init_clk_ops(struct clk_ops **ops, int type)
 {
-       BUG_ON(type < 0 || type > ARRAY_SIZE(onchip_ops));
+       BUG_ON(type < 0 || type >= ARRAY_SIZE(onchip_ops));
        *ops = onchip_ops[type];
 }
 
 int __init arch_clk_init(void)
 {
-       struct clk *master;
+       struct clk *clk;
        int i;
 
-       master = clk_get(NULL, "master_clk");
+       cpg_clk_init();
+
+       clk = clk_get(NULL, "master_clk");
        for (i = 0; i < ARRAY_SIZE(sh7722_clocks); i++) {
                pr_debug( "Registering clock '%s'\n", sh7722_clocks[i]->name);
-               sh7722_clocks[i]->parent = master;
+               sh7722_clocks[i]->parent = clk;
                clk_register(sh7722_clocks[i]);
        }
-       clk_put(master);
-
-       for (i = 0; i < ARRAY_SIZE(sh7722_mstpcr); i++) {
-               pr_debug( "Registering mstpcr '%s'\n", sh7722_mstpcr[i].name);
-               clk_register(&sh7722_mstpcr[i]);
+       clk_put(clk);
+
+       clk_register(&sh7722_r_clock);
+
+       for (i = 0; i < ARRAY_SIZE(sh7722_mstpcr_clocks); i++) {
+               pr_debug( "Registering mstpcr clock '%s'\n",
+                         sh7722_mstpcr_clocks[i].name);
+               clk = clk_get(NULL, (void *) sh7722_mstpcr_clocks[i].ops);
+               sh7722_mstpcr_clocks[i].parent = clk;
+               sh7722_mstpcr_clocks[i].ops = &sh7722_mstpcr_clk_ops;
+               clk_register(&sh7722_mstpcr_clocks[i]);
+               clk_put(clk);
        }
 
+       propagate_rate(&sh7722_r_clock); /* make sure rate gets propagated */
+
        return 0;
 }