sh2(A) exception handler update
[linux-2.6] / arch / sh / kernel / cpu / sh2 / clock-sh7619.c
1 /*
2  * arch/sh/kernel/cpu/sh2/clock-sh7619.c
3  *
4  * SH7619 support for the clock framework
5  *
6  *  Copyright (C) 2006  Yoshinori Sato
7  *
8  * Based on clock-sh4.c
9  *  Copyright (C) 2005  Paul Mundt
10  *
11  * This file is subject to the terms and conditions of the GNU General Public
12  * License.  See the file "COPYING" in the main directory of this archive
13  * for more details.
14  */
15 #include <linux/init.h>
16 #include <linux/kernel.h>
17 #include <asm/clock.h>
18 #include <asm/freq.h>
19 #include <asm/io.h>
20
21 static const int pll1rate[] = {1,2};
22 static const int pfc_divisors[] = {1,2,0,4};
23
24 #if (CONFIG_SH_CLK_MD == 1) || (CONFIG_SH_CLK_MD == 2)
25 #define PLL2 (4)
26 #elif (CONFIG_SH_CLK_MD == 5) || (CONFIG_SH_CLK_MD == 6)
27 #define PLL2 (2)
28 #else
29 #error "Illigal Clock Mode!"
30 #endif
31
32 static void master_clk_init(struct clk *clk)
33 {
34         clk->rate *= PLL2 * pll1rate[(ctrl_inw(FREQCR) >> 8) & 7];
35 }
36
37 static struct clk_ops sh7619_master_clk_ops = {
38         .init           = master_clk_init,
39 };
40
41 static void module_clk_recalc(struct clk *clk)
42 {
43         int idx = (ctrl_inw(FREQCR) & 0x0007);
44         clk->rate = clk->parent->rate / pfc_divisors[idx];
45 }
46
47 static struct clk_ops sh7619_module_clk_ops = {
48         .recalc         = module_clk_recalc,
49 };
50
51 static void bus_clk_recalc(struct clk *clk)
52 {
53         clk->rate = clk->parent->rate / pll1rate[(ctrl_inw(FREQCR) >> 8) & 7];
54 }
55
56 static struct clk_ops sh7619_bus_clk_ops = {
57         .recalc         = bus_clk_recalc,
58 };
59
60 static void cpu_clk_recalc(struct clk *clk)
61 {
62         clk->rate = clk->parent->rate;
63 }
64
65 static struct clk_ops sh7619_cpu_clk_ops = {
66         .recalc         = cpu_clk_recalc,
67 };
68
69 static struct clk_ops *sh7619_clk_ops[] = {
70         &sh7619_master_clk_ops,
71         &sh7619_module_clk_ops,
72         &sh7619_bus_clk_ops,
73         &sh7619_cpu_clk_ops,
74 };
75
76 void __init arch_init_clk_ops(struct clk_ops **ops, int idx)
77 {
78         if (idx < ARRAY_SIZE(sh7619_clk_ops))
79                 *ops = sh7619_clk_ops[idx];
80 }
81