1/*
2 *  linux/arch/arm/mach-integrator/clock.c
3 *
4 *  Copyright (C) 2004 ARM Limited.
5 *  Written by Deep Blue Solutions Limited.
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 */
11#include <linux/module.h>
12#include <linux/kernel.h>
13#include <linux/list.h>
14#include <linux/errno.h>
15#include <linux/err.h>
16#include <linux/string.h>
17#include <linux/clk.h>
18#include <linux/mutex.h>
19
20#include <asm/semaphore.h>
21#include <asm/hardware/icst525.h>
22
23#include "clock.h"
24
25static LIST_HEAD(clocks);
26static DEFINE_MUTEX(clocks_mutex);
27
28struct clk *clk_get(struct device *dev, const char *id)
29{
30	struct clk *p, *clk = ERR_PTR(-ENOENT);
31
32	mutex_lock(&clocks_mutex);
33	list_for_each_entry(p, &clocks, node) {
34		if (strcmp(id, p->name) == 0 && try_module_get(p->owner)) {
35			clk = p;
36			break;
37		}
38	}
39	mutex_unlock(&clocks_mutex);
40
41	return clk;
42}
43EXPORT_SYMBOL(clk_get);
44
45void clk_put(struct clk *clk)
46{
47	module_put(clk->owner);
48}
49EXPORT_SYMBOL(clk_put);
50
51int clk_enable(struct clk *clk)
52{
53	return 0;
54}
55EXPORT_SYMBOL(clk_enable);
56
57void clk_disable(struct clk *clk)
58{
59}
60EXPORT_SYMBOL(clk_disable);
61
62unsigned long clk_get_rate(struct clk *clk)
63{
64	return clk->rate;
65}
66EXPORT_SYMBOL(clk_get_rate);
67
68long clk_round_rate(struct clk *clk, unsigned long rate)
69{
70	struct icst525_vco vco;
71
72	vco = icst525_khz_to_vco(clk->params, rate / 1000);
73	return icst525_khz(clk->params, vco) * 1000;
74}
75EXPORT_SYMBOL(clk_round_rate);
76
77int clk_set_rate(struct clk *clk, unsigned long rate)
78{
79	int ret = -EIO;
80	if (clk->setvco) {
81		struct icst525_vco vco;
82
83		vco = icst525_khz_to_vco(clk->params, rate / 1000);
84		clk->rate = icst525_khz(clk->params, vco) * 1000;
85
86		printk("Clock %s: setting VCO reg params: S=%d R=%d V=%d\n",
87			clk->name, vco.s, vco.r, vco.v);
88
89		clk->setvco(clk, vco);
90		ret = 0;
91	}
92	return 0;
93}
94EXPORT_SYMBOL(clk_set_rate);
95
96/*
97 * These are fixed clocks.
98 */
99static struct clk kmi_clk = {
100	.name	= "KMIREFCLK",
101	.rate	= 24000000,
102};
103
104static struct clk uart_clk = {
105	.name	= "UARTCLK",
106	.rate	= 14745600,
107};
108
109int clk_register(struct clk *clk)
110{
111	mutex_lock(&clocks_mutex);
112	list_add(&clk->node, &clocks);
113	mutex_unlock(&clocks_mutex);
114	return 0;
115}
116EXPORT_SYMBOL(clk_register);
117
118void clk_unregister(struct clk *clk)
119{
120	mutex_lock(&clocks_mutex);
121	list_del(&clk->node);
122	mutex_unlock(&clocks_mutex);
123}
124EXPORT_SYMBOL(clk_unregister);
125
126static int __init clk_init(void)
127{
128	clk_register(&kmi_clk);
129	clk_register(&uart_clk);
130	return 0;
131}
132arch_initcall(clk_init);
133