Merge branch 'pxa-devel' into pxa
[linux-2.6] / arch / arm / mach-sa1100 / clock.c
1 /*
2  *  linux/arch/arm/mach-sa1100/clock.c
3  */
4 #include <linux/module.h>
5 #include <linux/kernel.h>
6 #include <linux/list.h>
7 #include <linux/errno.h>
8 #include <linux/err.h>
9 #include <linux/string.h>
10 #include <linux/clk.h>
11 #include <linux/spinlock.h>
12 #include <linux/mutex.h>
13
14 #include <asm/hardware.h>
15
16 /*
17  * Very simple clock implementation - we only have one clock to
18  * deal with at the moment, so we only match using the "name".
19  */
20 struct clk {
21         struct list_head        node;
22         unsigned long           rate;
23         const char              *name;
24         unsigned int            enabled;
25         void                    (*enable)(void);
26         void                    (*disable)(void);
27 };
28
29 static LIST_HEAD(clocks);
30 static DEFINE_MUTEX(clocks_mutex);
31 static DEFINE_SPINLOCK(clocks_lock);
32
33 struct clk *clk_get(struct device *dev, const char *id)
34 {
35         struct clk *p, *clk = ERR_PTR(-ENOENT);
36
37         mutex_lock(&clocks_mutex);
38         list_for_each_entry(p, &clocks, node) {
39                 if (strcmp(id, p->name) == 0) {
40                         clk = p;
41                         break;
42                 }
43         }
44         mutex_unlock(&clocks_mutex);
45
46         return clk;
47 }
48 EXPORT_SYMBOL(clk_get);
49
50 void clk_put(struct clk *clk)
51 {
52 }
53 EXPORT_SYMBOL(clk_put);
54
55 int clk_enable(struct clk *clk)
56 {
57         unsigned long flags;
58
59         spin_lock_irqsave(&clocks_lock, flags);
60         if (clk->enabled++ == 0)
61                 clk->enable();
62         spin_unlock_irqrestore(&clocks_lock, flags);
63         return 0;
64 }
65 EXPORT_SYMBOL(clk_enable);
66
67 void clk_disable(struct clk *clk)
68 {
69         unsigned long flags;
70
71         WARN_ON(clk->enabled == 0);
72
73         spin_lock_irqsave(&clocks_lock, flags);
74         if (--clk->enabled == 0)
75                 clk->disable();
76         spin_unlock_irqrestore(&clocks_lock, flags);
77 }
78 EXPORT_SYMBOL(clk_disable);
79
80 unsigned long clk_get_rate(struct clk *clk)
81 {
82         return clk->rate;
83 }
84 EXPORT_SYMBOL(clk_get_rate);
85
86
87 static void clk_gpio27_enable(void)
88 {
89         /*
90          * First, set up the 3.6864MHz clock on GPIO 27 for the SA-1111:
91          * (SA-1110 Developer's Manual, section 9.1.2.1)
92          */
93         GAFR |= GPIO_32_768kHz;
94         GPDR |= GPIO_32_768kHz;
95         TUCR = TUCR_3_6864MHz;
96 }
97
98 static void clk_gpio27_disable(void)
99 {
100         TUCR = 0;
101         GPDR &= ~GPIO_32_768kHz;
102         GAFR &= ~GPIO_32_768kHz;
103 }
104
105 static struct clk clk_gpio27 = {
106         .name           = "SA1111_CLK",
107         .rate           = 3686400,
108         .enable         = clk_gpio27_enable,
109         .disable        = clk_gpio27_disable,
110 };
111
112 int clk_register(struct clk *clk)
113 {
114         mutex_lock(&clocks_mutex);
115         list_add(&clk->node, &clocks);
116         mutex_unlock(&clocks_mutex);
117         return 0;
118 }
119 EXPORT_SYMBOL(clk_register);
120
121 void clk_unregister(struct clk *clk)
122 {
123         mutex_lock(&clocks_mutex);
124         list_del(&clk->node);
125         mutex_unlock(&clocks_mutex);
126 }
127 EXPORT_SYMBOL(clk_unregister);
128
129 static int __init clk_init(void)
130 {
131         clk_register(&clk_gpio27);
132         return 0;
133 }
134 arch_initcall(clk_init);