1 /*
2 * arch/sh/kernel/cpu/sh3/clock-sh7712.c
3 *
4 * SH7712 support for the clock framework
5 *
6 * Copyright (C) 2007 Andrew Murray <amurray@mpc-data.co.uk>
7 *
8 * Based on arch/sh/kernel/cpu/sh3/clock-sh3.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 int multipliers[] = { 1, 2, 3 };
22 static int divisors[] = { 1, 2, 3, 4, 6 };
23
master_clk_init(struct clk * clk)24 static void master_clk_init(struct clk *clk)
25 {
26 int frqcr = ctrl_inw(FRQCR);
27 int idx = (frqcr & 0x0300) >> 8;
28
29 clk->rate *= multipliers[idx];
30 }
31
32 static struct clk_ops sh7712_master_clk_ops = {
33 .init = master_clk_init,
34 };
35
module_clk_recalc(struct clk * clk)36 static void module_clk_recalc(struct clk *clk)
37 {
38 int frqcr = ctrl_inw(FRQCR);
39 int idx = frqcr & 0x0007;
40
41 clk->rate = clk->parent->rate / divisors[idx];
42 }
43
44 static struct clk_ops sh7712_module_clk_ops = {
45 .recalc = module_clk_recalc,
46 };
47
cpu_clk_recalc(struct clk * clk)48 static void cpu_clk_recalc(struct clk *clk)
49 {
50 int frqcr = ctrl_inw(FRQCR);
51 int idx = (frqcr & 0x0030) >> 4;
52
53 clk->rate = clk->parent->rate / divisors[idx];
54 }
55
56 static struct clk_ops sh7712_cpu_clk_ops = {
57 .recalc = cpu_clk_recalc,
58 };
59
60 static struct clk_ops *sh7712_clk_ops[] = {
61 &sh7712_master_clk_ops,
62 &sh7712_module_clk_ops,
63 &sh7712_cpu_clk_ops,
64 };
65
arch_init_clk_ops(struct clk_ops ** ops,int idx)66 void __init arch_init_clk_ops(struct clk_ops **ops, int idx)
67 {
68 if (idx < ARRAY_SIZE(sh7712_clk_ops))
69 *ops = sh7712_clk_ops[idx];
70 }
71
72