blob: c01eea88f7874e702ffa50af37b9d56e67d4cb63 [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 Kinga09e64f2008-08-05 16:14:15 +010015#include <mach/pxa2xx-regs.h>
16#include <mach/pxa2xx-gpio.h>
17#include <mach/hardware.h>
Russell King97d654f2006-03-15 15:54:37 +000018
Russell Kinga6dba202007-08-20 10:18:02 +010019#include "devices.h"
20#include "generic.h"
21#include "clock.h"
Russell King97d654f2006-03-15 15:54:37 +000022
23static LIST_HEAD(clocks);
Russell Kingf4b6a0a2007-05-15 16:49:02 +010024static DEFINE_MUTEX(clocks_mutex);
Russell King97d654f2006-03-15 15:54:37 +000025static DEFINE_SPINLOCK(clocks_lock);
26
Russell Kinga0dd0052008-02-17 10:35:15 +000027static struct clk *clk_lookup(struct device *dev, const char *id)
28{
29 struct clk *p;
30
31 list_for_each_entry(p, &clocks, node)
32 if (strcmp(id, p->name) == 0 && p->dev == dev)
33 return p;
34
35 return NULL;
36}
37
Russell King97d654f2006-03-15 15:54:37 +000038struct clk *clk_get(struct device *dev, const char *id)
39{
40 struct clk *p, *clk = ERR_PTR(-ENOENT);
41
Russell Kingf4b6a0a2007-05-15 16:49:02 +010042 mutex_lock(&clocks_mutex);
Russell Kinga0dd0052008-02-17 10:35:15 +000043 p = clk_lookup(dev, id);
44 if (!p)
45 p = clk_lookup(NULL, id);
46 if (p)
47 clk = p;
Russell Kingf4b6a0a2007-05-15 16:49:02 +010048 mutex_unlock(&clocks_mutex);
Russell King97d654f2006-03-15 15:54:37 +000049
Russell Kingbdb08cb2008-06-30 19:47:59 +010050 if (!IS_ERR(clk) && clk->ops == NULL)
51 clk = clk->other;
52
Russell King97d654f2006-03-15 15:54:37 +000053 return clk;
54}
55EXPORT_SYMBOL(clk_get);
56
57void clk_put(struct clk *clk)
58{
Russell King97d654f2006-03-15 15:54:37 +000059}
60EXPORT_SYMBOL(clk_put);
61
62int clk_enable(struct clk *clk)
63{
64 unsigned long flags;
65
66 spin_lock_irqsave(&clocks_lock, flags);
67 if (clk->enabled++ == 0)
Russell Kinga6dba202007-08-20 10:18:02 +010068 clk->ops->enable(clk);
Russell King97d654f2006-03-15 15:54:37 +000069 spin_unlock_irqrestore(&clocks_lock, flags);
Russell Kinga6dba202007-08-20 10:18:02 +010070
71 if (clk->delay)
72 udelay(clk->delay);
73
Russell King97d654f2006-03-15 15:54:37 +000074 return 0;
75}
76EXPORT_SYMBOL(clk_enable);
77
78void clk_disable(struct clk *clk)
79{
80 unsigned long flags;
81
82 WARN_ON(clk->enabled == 0);
83
84 spin_lock_irqsave(&clocks_lock, flags);
85 if (--clk->enabled == 0)
Russell Kinga6dba202007-08-20 10:18:02 +010086 clk->ops->disable(clk);
Russell King97d654f2006-03-15 15:54:37 +000087 spin_unlock_irqrestore(&clocks_lock, flags);
88}
89EXPORT_SYMBOL(clk_disable);
90
91unsigned long clk_get_rate(struct clk *clk)
92{
Russell Kinga6dba202007-08-20 10:18:02 +010093 unsigned long rate;
94
95 rate = clk->rate;
96 if (clk->ops->getrate)
97 rate = clk->ops->getrate(clk);
98
99 return rate;
Russell King97d654f2006-03-15 15:54:37 +0000100}
101EXPORT_SYMBOL(clk_get_rate);
102
103
Russell Kinga6dba202007-08-20 10:18:02 +0100104void clk_cken_enable(struct clk *clk)
Russell King97d654f2006-03-15 15:54:37 +0000105{
Russell Kinga6dba202007-08-20 10:18:02 +0100106 CKEN |= 1 << clk->cken;
107}
108
109void clk_cken_disable(struct clk *clk)
110{
111 CKEN &= ~(1 << clk->cken);
112}
113
114const struct clkops clk_cken_ops = {
115 .enable = clk_cken_enable,
116 .disable = clk_cken_disable,
117};
118
Russell Kinga6dba202007-08-20 10:18:02 +0100119void clks_register(struct clk *clks, size_t num)
120{
121 int i;
122
Russell Kingf4b6a0a2007-05-15 16:49:02 +0100123 mutex_lock(&clocks_mutex);
Russell Kinga6dba202007-08-20 10:18:02 +0100124 for (i = 0; i < num; i++)
125 list_add(&clks[i].node, &clocks);
Russell Kingf4b6a0a2007-05-15 16:49:02 +0100126 mutex_unlock(&clocks_mutex);
Russell King97d654f2006-03-15 15:54:37 +0000127}