[PATCH] sh: Simplistic clock framework
[linux-2.6.git] / arch / sh / kernel / cpu / sh4 / clock-sh7770.c
1 /*
2  * arch/sh/kernel/cpu/sh4/clock-sh7770.c
3  *
4  * SH7770 support for the clock framework
5  *
6  *  Copyright (C) 2005  Paul Mundt
7  *
8  * This file is subject to the terms and conditions of the GNU General Public
9  * License.  See the file "COPYING" in the main directory of this archive
10  * for more details.
11  */
12 #include <linux/init.h>
13 #include <linux/kernel.h>
14 #include <asm/clock.h>
15 #include <asm/freq.h>
16 #include <asm/io.h>
17
18 static int ifc_divisors[] = { 1, 1, 1, 1, 1, 1, 1, 1 };
19 static int bfc_divisors[] = { 1, 1, 1, 1, 1, 8,12, 1 };
20 static int pfc_divisors[] = { 1, 8, 1,10,12,16, 1, 1 };
21
22 static void master_clk_init(struct clk *clk)
23 {
24         clk->rate *= pfc_divisors[(ctrl_inl(FRQCR) >> 28) & 0x000f];
25 }
26
27 static struct clk_ops sh7770_master_clk_ops = {
28         .init           = master_clk_init,
29 };
30
31 static void module_clk_recalc(struct clk *clk)
32 {
33         int idx = ((ctrl_inl(FRQCR) >> 28) & 0x000f);
34         clk->rate = clk->parent->rate / pfc_divisors[idx];
35 }
36
37 static struct clk_ops sh7770_module_clk_ops = {
38         .recalc         = module_clk_recalc,
39 };
40
41 static void bus_clk_recalc(struct clk *clk)
42 {
43         int idx = (ctrl_inl(FRQCR) & 0x000f);
44         clk->rate = clk->parent->rate / bfc_divisors[idx];
45 }
46
47 static struct clk_ops sh7770_bus_clk_ops = {
48         .recalc         = bus_clk_recalc,
49 };
50
51 static void cpu_clk_recalc(struct clk *clk)
52 {
53         int idx = ((ctrl_inl(FRQCR) >> 24) & 0x000f);
54         clk->rate = clk->parent->rate / ifc_divisors[idx];
55 }
56
57 static struct clk_ops sh7770_cpu_clk_ops = {
58         .recalc         = cpu_clk_recalc,
59 };
60
61 static struct clk_ops *sh7770_clk_ops[] = {
62         &sh7770_master_clk_ops,
63         &sh7770_module_clk_ops,
64         &sh7770_bus_clk_ops,
65         &sh7770_cpu_clk_ops,
66 };
67
68 void __init arch_init_clk_ops(struct clk_ops **ops, int idx)
69 {
70         if (idx < ARRAY_SIZE(sh7770_clk_ops))
71                 *ops = sh7770_clk_ops[idx];
72 }
73