blob: a3e0e1989a6b55dd0873a6c9a61f55516b322173 [file] [log] [blame]
Russell King97d654f2006-03-15 15:54:37 +00001/*
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>
Russell Kinga6dba202007-08-20 10:18:02 +010012#include <linux/platform_device.h>
13#include <linux/delay.h>
Russell King97d654f2006-03-15 15:54:37 +000014
Russell King8c3abc72008-11-08 20:25:21 +000015#include <asm/clkdev.h>
Russell Kinga09e64f2008-08-05 16:14:15 +010016#include <mach/pxa2xx-regs.h>
17#include <mach/pxa2xx-gpio.h>
18#include <mach/hardware.h>
Russell King97d654f2006-03-15 15:54:37 +000019
Russell Kinga6dba202007-08-20 10:18:02 +010020#include "devices.h"
21#include "generic.h"
22#include "clock.h"
Russell King97d654f2006-03-15 15:54:37 +000023
Russell King97d654f2006-03-15 15:54:37 +000024static DEFINE_SPINLOCK(clocks_lock);
25
Russell King97d654f2006-03-15 15:54:37 +000026int clk_enable(struct clk *clk)
27{
28 unsigned long flags;
29
30 spin_lock_irqsave(&clocks_lock, flags);
31 if (clk->enabled++ == 0)
Russell Kinga6dba202007-08-20 10:18:02 +010032 clk->ops->enable(clk);
Russell King97d654f2006-03-15 15:54:37 +000033 spin_unlock_irqrestore(&clocks_lock, flags);
Russell Kinga6dba202007-08-20 10:18:02 +010034
35 if (clk->delay)
36 udelay(clk->delay);
37
Russell King97d654f2006-03-15 15:54:37 +000038 return 0;
39}
40EXPORT_SYMBOL(clk_enable);
41
42void 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)
Russell Kinga6dba202007-08-20 10:18:02 +010050 clk->ops->disable(clk);
Russell King97d654f2006-03-15 15:54:37 +000051 spin_unlock_irqrestore(&clocks_lock, flags);
52}
53EXPORT_SYMBOL(clk_disable);
54
55unsigned long clk_get_rate(struct clk *clk)
56{
Russell Kinga6dba202007-08-20 10:18:02 +010057 unsigned long rate;
58
59 rate = clk->rate;
60 if (clk->ops->getrate)
61 rate = clk->ops->getrate(clk);
62
63 return rate;
Russell King97d654f2006-03-15 15:54:37 +000064}
65EXPORT_SYMBOL(clk_get_rate);
66
67
Russell Kinga6dba202007-08-20 10:18:02 +010068void clk_cken_enable(struct clk *clk)
Russell King97d654f2006-03-15 15:54:37 +000069{
Russell Kinga6dba202007-08-20 10:18:02 +010070 CKEN |= 1 << clk->cken;
71}
72
73void clk_cken_disable(struct clk *clk)
74{
75 CKEN &= ~(1 << clk->cken);
76}
77
78const struct clkops clk_cken_ops = {
79 .enable = clk_cken_enable,
80 .disable = clk_cken_disable,
81};
82
Russell King8c3abc72008-11-08 20:25:21 +000083void clks_register(struct clk_lookup *clks, size_t num)
Russell Kinga6dba202007-08-20 10:18:02 +010084{
85 int i;
86
Russell Kinga6dba202007-08-20 10:18:02 +010087 for (i = 0; i < num; i++)
Russell King8c3abc72008-11-08 20:25:21 +000088 clkdev_add(&clks[i]);
Russell King97d654f2006-03-15 15:54:37 +000089}
Ian Molton5fedd0a2008-07-25 12:02:31 +010090
91int clk_add_alias(char *alias, struct device *alias_dev, char *id,
92 struct device *dev)
93{
Russell King8c3abc72008-11-08 20:25:21 +000094 struct clk *r = clk_get(dev, id);
95 struct clk_lookup *l;
Ian Molton5fedd0a2008-07-25 12:02:31 +010096
97 if (!r)
98 return -ENODEV;
99
Russell King8c3abc72008-11-08 20:25:21 +0000100 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);
Ian Molton5fedd0a2008-07-25 12:02:31 +0100105 return 0;
106}