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/platform_device.h>
13 #include <linux/delay.h>
14
15 #include <asm/clkdev.h>
16 #include <mach/pxa2xx-regs.h>
17 #include <mach/hardware.h>
18
19 #include "devices.h"
20 #include "generic.h"
21 #include "clock.h"
22
23 static DEFINE_SPINLOCK(clocks_lock);
24
clk_enable(struct clk * clk)25 int clk_enable(struct clk *clk)
26 {
27 unsigned long flags;
28
29 spin_lock_irqsave(&clocks_lock, flags);
30 if (clk->enabled++ == 0)
31 clk->ops->enable(clk);
32 spin_unlock_irqrestore(&clocks_lock, flags);
33
34 if (clk->delay)
35 udelay(clk->delay);
36
37 return 0;
38 }
39 EXPORT_SYMBOL(clk_enable);
40
clk_disable(struct clk * clk)41 void clk_disable(struct clk *clk)
42 {
43 unsigned long flags;
44
45 WARN_ON(clk->enabled == 0);
46
47 spin_lock_irqsave(&clocks_lock, flags);
48 if (--clk->enabled == 0)
49 clk->ops->disable(clk);
50 spin_unlock_irqrestore(&clocks_lock, flags);
51 }
52 EXPORT_SYMBOL(clk_disable);
53
clk_get_rate(struct clk * clk)54 unsigned long clk_get_rate(struct clk *clk)
55 {
56 unsigned long rate;
57
58 rate = clk->rate;
59 if (clk->ops->getrate)
60 rate = clk->ops->getrate(clk);
61
62 return rate;
63 }
64 EXPORT_SYMBOL(clk_get_rate);
65
66
clk_cken_enable(struct clk * clk)67 void clk_cken_enable(struct clk *clk)
68 {
69 CKEN |= 1 << clk->cken;
70 }
71
clk_cken_disable(struct clk * clk)72 void clk_cken_disable(struct clk *clk)
73 {
74 CKEN &= ~(1 << clk->cken);
75 }
76
77 const struct clkops clk_cken_ops = {
78 .enable = clk_cken_enable,
79 .disable = clk_cken_disable,
80 };
81
clks_register(struct clk_lookup * clks,size_t num)82 void clks_register(struct clk_lookup *clks, size_t num)
83 {
84 int i;
85
86 for (i = 0; i < num; i++)
87 clkdev_add(&clks[i]);
88 }
89
clk_add_alias(char * alias,struct device * alias_dev,char * id,struct device * dev)90 int clk_add_alias(char *alias, struct device *alias_dev, char *id,
91 struct device *dev)
92 {
93 struct clk *r = clk_get(dev, id);
94 struct clk_lookup *l;
95
96 if (!r)
97 return -ENODEV;
98
99 l = clkdev_alloc(r, alias, alias_dev ? dev_name(alias_dev) : NULL);
100 clk_put(r);
101 if (!l)
102 return -ENODEV;
103 clkdev_add(l);
104 return 0;
105 }
106