Merge branch 'linus' into irq/genirq
[linux-2.6] / arch / arm / mach-lh7a40x / clocks.c
1 /* arch/arm/mach-lh7a40x/clocks.c
2  *
3  *  Copyright (C) 2004 Marc Singer
4  *
5  *  This program is free software; you can redistribute it and/or
6  *  modify it under the terms of the GNU General Public License
7  *  version 2 as published by the Free Software Foundation.
8  *
9  */
10
11 #include <linux/cpufreq.h>
12 #include <mach/hardware.h>
13 #include <mach/clocks.h>
14 #include <linux/err.h>
15
16 struct module;
17
18 struct clk {
19         struct list_head node;
20         unsigned long rate;
21         struct module *owner;
22         const char *name;
23 };
24
25 /* ----- */
26
27 #define MAINDIV1(c)     (((c) >>  7) & 0x0f)
28 #define MAINDIV2(c)     (((c) >> 11) & 0x1f)
29 #define PS(c)           (((c) >> 18) & 0x03)
30 #define PREDIV(c)       (((c) >>  2) & 0x1f)
31 #define HCLKDIV(c)      (((c) >>  0) & 0x02)
32 #define PCLKDIV(c)      (((c) >> 16) & 0x03)
33
34 unsigned int cpufreq_get (unsigned int cpu) /* in kHz */
35 {
36         return fclkfreq_get ()/1000;
37 }
38 EXPORT_SYMBOL(cpufreq_get);
39
40 unsigned int fclkfreq_get (void)
41 {
42         unsigned int clkset = CSC_CLKSET;
43         unsigned int gclk
44                 = XTAL_IN
45                 / (1 << PS(clkset))
46                 * (MAINDIV1(clkset) + 2)
47                 / (PREDIV(clkset)   + 2)
48                 * (MAINDIV2(clkset) + 2)
49                 ;
50         return gclk;
51 }
52
53 unsigned int hclkfreq_get (void)
54 {
55         unsigned int clkset = CSC_CLKSET;
56         unsigned int hclk = fclkfreq_get () / (HCLKDIV(clkset) + 1);
57
58         return hclk;
59 }
60
61 unsigned int pclkfreq_get (void)
62 {
63         unsigned int clkset = CSC_CLKSET;
64         int pclkdiv = PCLKDIV(clkset);
65         unsigned int pclk;
66         if (pclkdiv == 0x3)
67                 pclkdiv = 0x2;
68         pclk = hclkfreq_get () / (1 << pclkdiv);
69
70         return pclk;
71 }
72
73 /* ----- */
74
75 struct clk *clk_get (struct device *dev, const char *id)
76 {
77         return dev && strcmp(dev_name(dev), "cldc-lh7a40x") == 0
78                  ? NULL : ERR_PTR(-ENOENT);
79 }
80 EXPORT_SYMBOL(clk_get);
81
82 void clk_put (struct clk *clk)
83 {
84 }
85 EXPORT_SYMBOL(clk_put);
86
87 int clk_enable (struct clk *clk)
88 {
89         return 0;
90 }
91 EXPORT_SYMBOL(clk_enable);
92
93 void clk_disable (struct clk *clk)
94 {
95 }
96 EXPORT_SYMBOL(clk_disable);
97
98 unsigned long clk_get_rate (struct clk *clk)
99 {
100         return 0;
101 }
102 EXPORT_SYMBOL(clk_get_rate);
103
104 long clk_round_rate (struct clk *clk, unsigned long rate)
105 {
106         return rate;
107 }
108 EXPORT_SYMBOL(clk_round_rate);
109
110 int clk_set_rate (struct clk *clk, unsigned long rate)
111 {
112         return -EIO;
113 }
114 EXPORT_SYMBOL(clk_set_rate);