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