[mirror_ubuntu-artful-kernel.git] / arch / arm / plat-omap / clock.c

/*
 *  linux/arch/arm/plat-omap/clock.c
 *
 *  Copyright (C) 2004 - 2008 Nokia corporation
 *  Written by Tuukka Tikkanen <tuukka.tikkanen@elektrobit.com>
 *
 *  Modified for omap shared clock framework by Tony Lindgren <tony@atomide.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */
#include <linux/version.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/list.h>
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/string.h>
#include <linux/clk.h>
#include <linux/mutex.h>
#include <linux/platform_device.h>
#include <linux/cpufreq.h>
#include <linux/debugfs.h>

#include <asm/io.h>

#include <asm/arch/clock.h>

static LIST_HEAD(clocks);
static DEFINE_MUTEX(clocks_mutex);
static DEFINE_SPINLOCK(clockfw_lock);

static struct clk_functions *arch_clock;

/*-------------------------------------------------------------------------
 * Standard clock functions defined in include/linux/clk.h
 *-------------------------------------------------------------------------*/

/*
 * Returns a clock. Note that we first try to use device id on the bus
 * and clock name. If this fails, we try to use clock name only.
 */
struct clk * clk_get(struct device *dev, const char *id)
{
	struct clk *p, *clk = ERR_PTR(-ENOENT);
	int idno;

	if (dev == NULL || dev->bus != &platform_bus_type)
		idno = -1;
	else
		idno = to_platform_device(dev)->id;

	mutex_lock(&clocks_mutex);

	list_for_each_entry(p, &clocks, node) {
		if (p->id == idno &&
		    strcmp(id, p->name) == 0 && try_module_get(p->owner)) {
			clk = p;
			goto found;
		}
	}

	list_for_each_entry(p, &clocks, node) {
		if (strcmp(id, p->name) == 0 && try_module_get(p->owner)) {
			clk = p;
			break;
		}
	}

found:
	mutex_unlock(&clocks_mutex);

	return clk;
}
EXPORT_SYMBOL(clk_get);

int clk_enable(struct clk *clk)
{
	unsigned long flags;
	int ret = 0;

	if (clk == NULL || IS_ERR(clk))
		return -EINVAL;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_enable)
		ret = arch_clock->clk_enable(clk);
	spin_unlock_irqrestore(&clockfw_lock, flags);

	return ret;
}
EXPORT_SYMBOL(clk_enable);

void clk_disable(struct clk *clk)
{
	unsigned long flags;

	if (clk == NULL || IS_ERR(clk))
		return;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (clk->usecount == 0) {
		printk(KERN_ERR "Trying disable clock %s with 0 usecount\n",
		       clk->name);
		WARN_ON(1);
		goto out;
	}

	if (arch_clock->clk_disable)
		arch_clock->clk_disable(clk);

out:
	spin_unlock_irqrestore(&clockfw_lock, flags);
}
EXPORT_SYMBOL(clk_disable);

int clk_get_usecount(struct clk *clk)
{
	unsigned long flags;
	int ret = 0;

	if (clk == NULL || IS_ERR(clk))
		return 0;

	spin_lock_irqsave(&clockfw_lock, flags);
	ret = clk->usecount;
	spin_unlock_irqrestore(&clockfw_lock, flags);

	return ret;
}
EXPORT_SYMBOL(clk_get_usecount);

unsigned long clk_get_rate(struct clk *clk)
{
	unsigned long flags;
	unsigned long ret = 0;

	if (clk == NULL || IS_ERR(clk))
		return 0;

	spin_lock_irqsave(&clockfw_lock, flags);
	ret = clk->rate;
	spin_unlock_irqrestore(&clockfw_lock, flags);

	return ret;
}
EXPORT_SYMBOL(clk_get_rate);

void clk_put(struct clk *clk)
{
	if (clk && !IS_ERR(clk))
		module_put(clk->owner);
}
EXPORT_SYMBOL(clk_put);

/*-------------------------------------------------------------------------
 * Optional clock functions defined in include/linux/clk.h
 *-------------------------------------------------------------------------*/

long clk_round_rate(struct clk *clk, unsigned long rate)
{
	unsigned long flags;
	long ret = 0;

	if (clk == NULL || IS_ERR(clk))
		return ret;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_round_rate)
		ret = arch_clock->clk_round_rate(clk, rate);
	spin_unlock_irqrestore(&clockfw_lock, flags);

	return ret;
}
EXPORT_SYMBOL(clk_round_rate);

int clk_set_rate(struct clk *clk, unsigned long rate)
{
	unsigned long flags;
	int ret = -EINVAL;

	if (clk == NULL || IS_ERR(clk))
		return ret;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_set_rate)
		ret = arch_clock->clk_set_rate(clk, rate);
	spin_unlock_irqrestore(&clockfw_lock, flags);

	return ret;
}
EXPORT_SYMBOL(clk_set_rate);

int clk_set_parent(struct clk *clk, struct clk *parent)
{
	unsigned long flags;
	int ret = -EINVAL;

	if (clk == NULL || IS_ERR(clk) || parent == NULL || IS_ERR(parent))
		return ret;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_set_parent)
		ret =  arch_clock->clk_set_parent(clk, parent);
	spin_unlock_irqrestore(&clockfw_lock, flags);

	return ret;
}
EXPORT_SYMBOL(clk_set_parent);

struct clk *clk_get_parent(struct clk *clk)
{
	unsigned long flags;
	struct clk * ret = NULL;

	if (clk == NULL || IS_ERR(clk))
		return ret;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_get_parent)
		ret = arch_clock->clk_get_parent(clk);
	spin_unlock_irqrestore(&clockfw_lock, flags);

	return ret;
}
EXPORT_SYMBOL(clk_get_parent);

/*-------------------------------------------------------------------------
 * OMAP specific clock functions shared between omap1 and omap2
 *-------------------------------------------------------------------------*/

unsigned int __initdata mpurate;

/*
 * By default we use the rate set by the bootloader.
 * You can override this with mpurate= cmdline option.
 */
static int __init omap_clk_setup(char *str)
{
	get_option(&str, &mpurate);

	if (!mpurate)
		return 1;

	if (mpurate < 1000)
		mpurate *= 1000000;

	return 1;
}
__setup("mpurate=", omap_clk_setup);

/* Used for clocks that always have same value as the parent clock */
void followparent_recalc(struct clk *clk)
{
	if (clk == NULL || IS_ERR(clk))
		return;

	clk->rate = clk->parent->rate;
	if (unlikely(clk->flags & RATE_PROPAGATES))
		propagate_rate(clk);
}

/* Propagate rate to children */
void propagate_rate(struct clk * tclk)
{
	struct clk *clkp;

	if (tclk == NULL || IS_ERR(tclk))
		return;

	list_for_each_entry(clkp, &clocks, node) {
		if (likely(clkp->parent != tclk))
			continue;
		if (likely((u32)clkp->recalc))
			clkp->recalc(clkp);
	}
}

/**
 * recalculate_root_clocks - recalculate and propagate all root clocks
 *
 * Recalculates all root clocks (clocks with no parent), which if the
 * clock's .recalc is set correctly, should also propagate their rates.
 * Called at init.
 */
void recalculate_root_clocks(void)
{
	struct clk *clkp;

	list_for_each_entry(clkp, &clocks, node) {
		if (unlikely(!clkp->parent) && likely((u32)clkp->recalc))
			clkp->recalc(clkp);
	}
}

int clk_register(struct clk *clk)
{
	if (clk == NULL || IS_ERR(clk))
		return -EINVAL;

	mutex_lock(&clocks_mutex);
	list_add(&clk->node, &clocks);
	if (clk->init)
		clk->init(clk);
	mutex_unlock(&clocks_mutex);

	return 0;
}
EXPORT_SYMBOL(clk_register);

void clk_unregister(struct clk *clk)
{
	if (clk == NULL || IS_ERR(clk))
		return;

	mutex_lock(&clocks_mutex);
	list_del(&clk->node);
	mutex_unlock(&clocks_mutex);
}
EXPORT_SYMBOL(clk_unregister);

void clk_deny_idle(struct clk *clk)
{
	unsigned long flags;

	if (clk == NULL || IS_ERR(clk))
		return;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_deny_idle)
		arch_clock->clk_deny_idle(clk);
	spin_unlock_irqrestore(&clockfw_lock, flags);
}
EXPORT_SYMBOL(clk_deny_idle);

void clk_allow_idle(struct clk *clk)
{
	unsigned long flags;

	if (clk == NULL || IS_ERR(clk))
		return;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_allow_idle)
		arch_clock->clk_allow_idle(clk);
	spin_unlock_irqrestore(&clockfw_lock, flags);
}
EXPORT_SYMBOL(clk_allow_idle);

void clk_enable_init_clocks(void)
{
	struct clk *clkp;

	list_for_each_entry(clkp, &clocks, node) {
		if (clkp->flags & ENABLE_ON_INIT)
			clk_enable(clkp);
	}
}
EXPORT_SYMBOL(clk_enable_init_clocks);

#ifdef CONFIG_CPU_FREQ
void clk_init_cpufreq_table(struct cpufreq_frequency_table **table)
{
	unsigned long flags;

	spin_lock_irqsave(&clockfw_lock, flags);
	if (arch_clock->clk_init_cpufreq_table)
		arch_clock->clk_init_cpufreq_table(table);
	spin_unlock_irqrestore(&clockfw_lock, flags);
}
EXPORT_SYMBOL(clk_init_cpufreq_table);
#endif

/*-------------------------------------------------------------------------*/

#ifdef CONFIG_OMAP_RESET_CLOCKS
/*
 * Disable any unused clocks left on by the bootloader
 */
static int __init clk_disable_unused(void)
{
	struct clk *ck;
	unsigned long flags;

	list_for_each_entry(ck, &clocks, node) {
		if (ck->usecount > 0 || (ck->flags & ALWAYS_ENABLED) ||
			ck->enable_reg == 0)
			continue;

		spin_lock_irqsave(&clockfw_lock, flags);
		if (arch_clock->clk_disable_unused)
			arch_clock->clk_disable_unused(ck);
		spin_unlock_irqrestore(&clockfw_lock, flags);
	}

	return 0;
}
late_initcall(clk_disable_unused);
#endif

int __init clk_init(struct clk_functions * custom_clocks)
{
	if (!custom_clocks) {
		printk(KERN_ERR "No custom clock functions registered\n");
		BUG();
	}

	arch_clock = custom_clocks;

	return 0;
}

#if defined(CONFIG_PM_DEBUG) && defined(CONFIG_DEBUG_FS)
/*
 *	debugfs support to trace clock tree hierarchy and attributes
 */
static struct dentry *clk_debugfs_root;

static int clk_debugfs_register_one(struct clk *c)
{
	int err;
	struct dentry *d, *child;
	struct clk *pa = c->parent;
	char s[255];
	char *p = s;

	p += sprintf(p, "%s", c->name);
	if (c->id != 0)
		sprintf(p, ":%d", c->id);
	d = debugfs_create_dir(s, pa ? pa->dent : clk_debugfs_root);
	if (IS_ERR(d))
		return PTR_ERR(d);
	c->dent = d;

	d = debugfs_create_u8("usecount", S_IRUGO, c->dent, (u8 *)&c->usecount);
	if (IS_ERR(d)) {
		err = PTR_ERR(d);
		goto err_out;
	}
	d = debugfs_create_u32("rate", S_IRUGO, c->dent, (u32 *)&c->rate);
	if (IS_ERR(d)) {
		err = PTR_ERR(d);
		goto err_out;
	}
	d = debugfs_create_x32("flags", S_IRUGO, c->dent, (u32 *)&c->flags);
	if (IS_ERR(d)) {
		err = PTR_ERR(d);
		goto err_out;
	}
	return 0;

err_out:
	d = c->dent;
	list_for_each_entry(child, &d->d_subdirs, d_u.d_child)
		debugfs_remove(child);
	debugfs_remove(c->dent);
	return err;
}

static int clk_debugfs_register(struct clk *c)
{
	int err;
	struct clk *pa = c->parent;

	if (pa && !pa->dent) {
		err = clk_debugfs_register(pa);
		if (err)
			return err;
	}

	if (!c->dent) {
		err = clk_debugfs_register_one(c);
		if (err)
			return err;
	}
	return 0;
}

static int __init clk_debugfs_init(void)
{
	struct clk *c;
	struct dentry *d;
	int err;

	d = debugfs_create_dir("clock", NULL);
	if (IS_ERR(d))
		return PTR_ERR(d);
	clk_debugfs_root = d;

	list_for_each_entry(c, &clocks, node) {
		err = clk_debugfs_register(c);
		if (err)
			goto err_out;
	}
	return 0;
err_out:
	debugfs_remove(clk_debugfs_root); /* REVISIT: Cleanup correctly */
	return err;
}
late_initcall(clk_debugfs_init);

#endif /* defined(CONFIG_PM_DEBUG) && defined(CONFIG_DEBUG_FS) */
Commit	Line	Data
1da177e4	1	/*
b9158556	2	* linux/arch/arm/plat-omap/clock.c
1da177e4	3	*
137b3ee2	4	* Copyright (C) 2004 - 2008 Nokia corporation
1da177e4 LT	5	* Written by Tuukka Tikkanen <tuukka.tikkanen@elektrobit.com>
1da177e4 LT	6	*
1a8bfa1e TL	7	* Modified for omap shared clock framework by Tony Lindgren <tony@atomide.com>
1a8bfa1e TL	8	*
1da177e4 LT	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License version 2 as
	11	* published by the Free Software Foundation.
	12	*/
1a8bfa1e	13	#include <linux/version.h>
1da177e4	14	#include <linux/kernel.h>
1a8bfa1e TL	15	#include <linux/init.h>
1a8bfa1e TL	16	#include <linux/module.h>
1da177e4 LT	17	#include <linux/list.h>
	18	#include <linux/errno.h>
	19	#include <linux/err.h>
4e57b681	20	#include <linux/string.h>
f8ce2547	21	#include <linux/clk.h>
00431707	22	#include <linux/mutex.h>
b824efae	23	#include <linux/platform_device.h>
b851cb28	24	#include <linux/cpufreq.h>
137b3ee2	25	#include <linux/debugfs.h>
1da177e4	26
bb13b5fd	27	#include <asm/io.h>
1da177e4	28
1a8bfa1e	29	#include <asm/arch/clock.h>
1da177e4	30
7df3450e	31	static LIST_HEAD(clocks);
00431707	32	static DEFINE_MUTEX(clocks_mutex);
7df3450e	33	static DEFINE_SPINLOCK(clockfw_lock);
1da177e4	34
1a8bfa1e	35	static struct clk_functions *arch_clock;
1da177e4	36
1a8bfa1e	37	/*-------------------------------------------------------------------------
f07adc59	38	* Standard clock functions defined in include/linux/clk.h
1a8bfa1e	39	-------------------------------------------------------------------------/
1da177e4	40
b824efae TL	41	/*
	42	* Returns a clock. Note that we first try to use device id on the bus
	43	* and clock name. If this fails, we try to use clock name only.
	44	*/
1a8bfa1e	45	struct clk * clk_get(struct device dev, const char id)
1da177e4 LT	46	{
1da177e4 LT	47	struct clk p, clk = ERR_PTR(-ENOENT);
b824efae TL	48	int idno;
	49
	50	if (dev == NULL \|\| dev->bus != &platform_bus_type)
	51	idno = -1;
	52	else
	53	idno = to_platform_device(dev)->id;
1da177e4	54
00431707	55	mutex_lock(&clocks_mutex);
b824efae TL	56
	57	list_for_each_entry(p, &clocks, node) {
	58	if (p->id == idno &&
	59	strcmp(id, p->name) == 0 && try_module_get(p->owner)) {
	60	clk = p;
67d4d835	61	goto found;
b824efae TL	62	}
	63	}
	64
1da177e4 LT	65	list_for_each_entry(p, &clocks, node) {
	66	if (strcmp(id, p->name) == 0 && try_module_get(p->owner)) {
	67	clk = p;
	68	break;
	69	}
	70	}
b824efae	71
67d4d835	72	found:
00431707	73	mutex_unlock(&clocks_mutex);
1da177e4 LT	74
	75	return clk;
	76	}
	77	EXPORT_SYMBOL(clk_get);
	78
1da177e4 LT	79	int clk_enable(struct clk *clk)
	80	{
	81	unsigned long flags;
1a8bfa1e	82	int ret = 0;
1da177e4	83
b824efae TL	84	if (clk == NULL \|\| IS_ERR(clk))
	85	return -EINVAL;
	86
1da177e4	87	spin_lock_irqsave(&clockfw_lock, flags);
f07adc59	88	if (arch_clock->clk_enable)
1a8bfa1e	89	ret = arch_clock->clk_enable(clk);
1da177e4	90	spin_unlock_irqrestore(&clockfw_lock, flags);
1a8bfa1e	91
1da177e4 LT	92	return ret;
	93	}
	94	EXPORT_SYMBOL(clk_enable);
	95
1da177e4 LT	96	void clk_disable(struct clk *clk)
	97	{
	98	unsigned long flags;
	99
b824efae TL	100	if (clk == NULL \|\| IS_ERR(clk))
	101	return;
	102
1da177e4	103	spin_lock_irqsave(&clockfw_lock, flags);
7cf95774 TL	104	if (clk->usecount == 0) {
	105	printk(KERN_ERR "Trying disable clock %s with 0 usecount\n",
	106	clk->name);
	107	WARN_ON(1);
	108	goto out;
	109	}
	110
f07adc59	111	if (arch_clock->clk_disable)
1a8bfa1e	112	arch_clock->clk_disable(clk);
7cf95774 TL	113
7cf95774 TL	114	out:
1da177e4 LT	115	spin_unlock_irqrestore(&clockfw_lock, flags);
	116	}
	117	EXPORT_SYMBOL(clk_disable);
	118
1da177e4 LT	119	int clk_get_usecount(struct clk *clk)
1da177e4 LT	120	{
1a8bfa1e TL	121	unsigned long flags;
1a8bfa1e TL	122	int ret = 0;
1da177e4	123
b824efae TL	124	if (clk == NULL \|\| IS_ERR(clk))
	125	return 0;
	126
1a8bfa1e TL	127	spin_lock_irqsave(&clockfw_lock, flags);
	128	ret = clk->usecount;
	129	spin_unlock_irqrestore(&clockfw_lock, flags);
1da177e4	130
1a8bfa1e	131	return ret;
1da177e4	132	}
1a8bfa1e	133	EXPORT_SYMBOL(clk_get_usecount);
1da177e4	134
1a8bfa1e	135	unsigned long clk_get_rate(struct clk *clk)
1da177e4	136	{
1a8bfa1e TL	137	unsigned long flags;
1a8bfa1e TL	138	unsigned long ret = 0;
1da177e4	139
b824efae TL	140	if (clk == NULL \|\| IS_ERR(clk))
	141	return 0;
	142
1a8bfa1e TL	143	spin_lock_irqsave(&clockfw_lock, flags);
	144	ret = clk->rate;
	145	spin_unlock_irqrestore(&clockfw_lock, flags);
1da177e4	146
1a8bfa1e	147	return ret;
1da177e4	148	}
1a8bfa1e	149	EXPORT_SYMBOL(clk_get_rate);
1da177e4	150
1a8bfa1e	151	void clk_put(struct clk *clk)
bb13b5fd	152	{
1a8bfa1e TL	153	if (clk && !IS_ERR(clk))
1a8bfa1e TL	154	module_put(clk->owner);
bb13b5fd	155	}
1a8bfa1e	156	EXPORT_SYMBOL(clk_put);
bb13b5fd	157
1a8bfa1e	158	/*-------------------------------------------------------------------------
f07adc59	159	* Optional clock functions defined in include/linux/clk.h
1a8bfa1e	160	-------------------------------------------------------------------------/
bb13b5fd	161
1da177e4 LT	162	long clk_round_rate(struct clk *clk, unsigned long rate)
1da177e4 LT	163	{
1a8bfa1e TL	164	unsigned long flags;
1a8bfa1e TL	165	long ret = 0;
1da177e4	166
b824efae TL	167	if (clk == NULL \|\| IS_ERR(clk))
	168	return ret;
	169
1a8bfa1e TL	170	spin_lock_irqsave(&clockfw_lock, flags);
	171	if (arch_clock->clk_round_rate)
	172	ret = arch_clock->clk_round_rate(clk, rate);
	173	spin_unlock_irqrestore(&clockfw_lock, flags);
1da177e4	174
1a8bfa1e	175	return ret;
1da177e4 LT	176	}
	177	EXPORT_SYMBOL(clk_round_rate);
	178
1a8bfa1e	179	int clk_set_rate(struct clk *clk, unsigned long rate)
1da177e4	180	{
1a8bfa1e	181	unsigned long flags;
b824efae TL	182	int ret = -EINVAL;
	183
	184	if (clk == NULL \|\| IS_ERR(clk))
	185	return ret;
bb13b5fd	186
1a8bfa1e TL	187	spin_lock_irqsave(&clockfw_lock, flags);
	188	if (arch_clock->clk_set_rate)
	189	ret = arch_clock->clk_set_rate(clk, rate);
	190	spin_unlock_irqrestore(&clockfw_lock, flags);
1da177e4	191
1a8bfa1e	192	return ret;
1da177e4	193	}
1a8bfa1e	194	EXPORT_SYMBOL(clk_set_rate);
1da177e4	195
1a8bfa1e	196	int clk_set_parent(struct clk clk, struct clk parent)
1da177e4	197	{
1a8bfa1e	198	unsigned long flags;
b824efae TL	199	int ret = -EINVAL;
	200
	201	if (clk == NULL \|\| IS_ERR(clk) \|\| parent == NULL \|\| IS_ERR(parent))
	202	return ret;
1da177e4	203
1a8bfa1e TL	204	spin_lock_irqsave(&clockfw_lock, flags);
	205	if (arch_clock->clk_set_parent)
	206	ret = arch_clock->clk_set_parent(clk, parent);
	207	spin_unlock_irqrestore(&clockfw_lock, flags);
1da177e4	208
1a8bfa1e	209	return ret;
1da177e4	210	}
1a8bfa1e	211	EXPORT_SYMBOL(clk_set_parent);
1da177e4	212
1a8bfa1e	213	struct clk clk_get_parent(struct clk clk)
1da177e4	214	{
1a8bfa1e TL	215	unsigned long flags;
1a8bfa1e TL	216	struct clk * ret = NULL;
1da177e4	217
b824efae TL	218	if (clk == NULL \|\| IS_ERR(clk))
	219	return ret;
	220
1a8bfa1e TL	221	spin_lock_irqsave(&clockfw_lock, flags);
	222	if (arch_clock->clk_get_parent)
	223	ret = arch_clock->clk_get_parent(clk);
	224	spin_unlock_irqrestore(&clockfw_lock, flags);
1da177e4 LT	225
	226	return ret;
	227	}
1a8bfa1e	228	EXPORT_SYMBOL(clk_get_parent);
1da177e4	229
1a8bfa1e TL	230	/*-------------------------------------------------------------------------
	231	* OMAP specific clock functions shared between omap1 and omap2
	232	-------------------------------------------------------------------------/
1da177e4	233
1a8bfa1e	234	unsigned int __initdata mpurate;
1da177e4	235
1a8bfa1e TL	236	/*
	237	* By default we use the rate set by the bootloader.
	238	* You can override this with mpurate= cmdline option.
	239	*/
	240	static int __init omap_clk_setup(char *str)
1da177e4	241	{
1a8bfa1e	242	get_option(&str, &mpurate);
1da177e4	243
1a8bfa1e TL	244	if (!mpurate)
1a8bfa1e TL	245	return 1;
1da177e4	246
1a8bfa1e TL	247	if (mpurate < 1000)
1a8bfa1e TL	248	mpurate *= 1000000;
1da177e4	249
1a8bfa1e	250	return 1;
1da177e4	251	}
1a8bfa1e	252	__setup("mpurate=", omap_clk_setup);
1da177e4	253
1a8bfa1e TL	254	/* Used for clocks that always have same value as the parent clock */
1a8bfa1e TL	255	void followparent_recalc(struct clk *clk)
1da177e4	256	{
b824efae TL	257	if (clk == NULL \|\| IS_ERR(clk))
	258	return;
	259
1a8bfa1e	260	clk->rate = clk->parent->rate;
b1465bf7 ID	261	if (unlikely(clk->flags & RATE_PROPAGATES))
b1465bf7 ID	262	propagate_rate(clk);
1da177e4 LT	263	}
1da177e4 LT	264
1a8bfa1e TL	265	/* Propagate rate to children */
1a8bfa1e TL	266	void propagate_rate(struct clk * tclk)
1da177e4	267	{
1a8bfa1e	268	struct clk *clkp;
1da177e4	269
b824efae TL	270	if (tclk == NULL \|\| IS_ERR(tclk))
	271	return;
	272
1a8bfa1e TL	273	list_for_each_entry(clkp, &clocks, node) {
	274	if (likely(clkp->parent != tclk))
	275	continue;
	276	if (likely((u32)clkp->recalc))
	277	clkp->recalc(clkp);
	278	}
1da177e4 LT	279	}
1da177e4 LT	280
6b8858a9 PW	281	/**
	282	* recalculate_root_clocks - recalculate and propagate all root clocks
	283	*
	284	* Recalculates all root clocks (clocks with no parent), which if the
	285	* clock's .recalc is set correctly, should also propagate their rates.
	286	* Called at init.
	287	*/
	288	void recalculate_root_clocks(void)
	289	{
	290	struct clk *clkp;
	291
	292	list_for_each_entry(clkp, &clocks, node) {
	293	if (unlikely(!clkp->parent) && likely((u32)clkp->recalc))
	294	clkp->recalc(clkp);
	295	}
	296	}
	297
1da177e4 LT	298	int clk_register(struct clk *clk)
1da177e4 LT	299	{
b824efae TL	300	if (clk == NULL \|\| IS_ERR(clk))
	301	return -EINVAL;
	302
00431707	303	mutex_lock(&clocks_mutex);
1da177e4 LT	304	list_add(&clk->node, &clocks);
	305	if (clk->init)
	306	clk->init(clk);
00431707	307	mutex_unlock(&clocks_mutex);
1a8bfa1e	308
1da177e4 LT	309	return 0;
	310	}
	311	EXPORT_SYMBOL(clk_register);
	312
	313	void clk_unregister(struct clk *clk)
	314	{
b824efae TL	315	if (clk == NULL \|\| IS_ERR(clk))
	316	return;
	317
00431707	318	mutex_lock(&clocks_mutex);
1da177e4	319	list_del(&clk->node);
00431707	320	mutex_unlock(&clocks_mutex);
1da177e4 LT	321	}
	322	EXPORT_SYMBOL(clk_unregister);
	323
1a8bfa1e	324	void clk_deny_idle(struct clk *clk)
bb13b5fd	325	{
1a8bfa1e TL	326	unsigned long flags;
1a8bfa1e TL	327
b824efae TL	328	if (clk == NULL \|\| IS_ERR(clk))
	329	return;
	330
1a8bfa1e TL	331	spin_lock_irqsave(&clockfw_lock, flags);
	332	if (arch_clock->clk_deny_idle)
	333	arch_clock->clk_deny_idle(clk);
	334	spin_unlock_irqrestore(&clockfw_lock, flags);
bb13b5fd	335	}
1a8bfa1e	336	EXPORT_SYMBOL(clk_deny_idle);
1da177e4	337
1a8bfa1e	338	void clk_allow_idle(struct clk *clk)
1da177e4	339	{
1a8bfa1e	340	unsigned long flags;
1da177e4	341
b824efae TL	342	if (clk == NULL \|\| IS_ERR(clk))
	343	return;
	344
1a8bfa1e TL	345	spin_lock_irqsave(&clockfw_lock, flags);
	346	if (arch_clock->clk_allow_idle)
	347	arch_clock->clk_allow_idle(clk);
	348	spin_unlock_irqrestore(&clockfw_lock, flags);
1da177e4	349	}
1a8bfa1e	350	EXPORT_SYMBOL(clk_allow_idle);
bb13b5fd	351
6b8858a9 PW	352	void clk_enable_init_clocks(void)
	353	{
	354	struct clk *clkp;
	355
	356	list_for_each_entry(clkp, &clocks, node) {
	357	if (clkp->flags & ENABLE_ON_INIT)
	358	clk_enable(clkp);
	359	}
	360	}
	361	EXPORT_SYMBOL(clk_enable_init_clocks);
	362
	363	#ifdef CONFIG_CPU_FREQ
	364	void clk_init_cpufreq_table(struct cpufreq_frequency_table **table)
	365	{
	366	unsigned long flags;
	367
	368	spin_lock_irqsave(&clockfw_lock, flags);
	369	if (arch_clock->clk_init_cpufreq_table)
	370	arch_clock->clk_init_cpufreq_table(table);
	371	spin_unlock_irqrestore(&clockfw_lock, flags);
	372	}
	373	EXPORT_SYMBOL(clk_init_cpufreq_table);
	374	#endif
	375
1a8bfa1e	376	/-------------------------------------------------------------------------/
bb13b5fd	377
90afd5cb TL	378	#ifdef CONFIG_OMAP_RESET_CLOCKS
	379	/*
	380	* Disable any unused clocks left on by the bootloader
	381	*/
	382	static int __init clk_disable_unused(void)
	383	{
	384	struct clk *ck;
	385	unsigned long flags;
	386
	387	list_for_each_entry(ck, &clocks, node) {
	388	if (ck->usecount > 0 \|\| (ck->flags & ALWAYS_ENABLED) \|\|
	389	ck->enable_reg == 0)
	390	continue;
	391
	392	spin_lock_irqsave(&clockfw_lock, flags);
	393	if (arch_clock->clk_disable_unused)
	394	arch_clock->clk_disable_unused(ck);
	395	spin_unlock_irqrestore(&clockfw_lock, flags);
	396	}
	397
	398	return 0;
	399	}
	400	late_initcall(clk_disable_unused);
	401	#endif
	402
1a8bfa1e	403	int __init clk_init(struct clk_functions * custom_clocks)
bb13b5fd	404	{
1a8bfa1e TL	405	if (!custom_clocks) {
	406	printk(KERN_ERR "No custom clock functions registered\n");
	407	BUG();
bb13b5fd TL	408	}
bb13b5fd TL	409
1a8bfa1e TL	410	arch_clock = custom_clocks;
1a8bfa1e TL	411
bb13b5fd TL	412	return 0;
bb13b5fd TL	413	}
6b8858a9	414
137b3ee2 HD	415	#if defined(CONFIG_PM_DEBUG) && defined(CONFIG_DEBUG_FS)
	416	/*
	417	* debugfs support to trace clock tree hierarchy and attributes
	418	*/
	419	static struct dentry *clk_debugfs_root;
	420
	421	static int clk_debugfs_register_one(struct clk *c)
	422	{
	423	int err;
	424	struct dentry d, child;
	425	struct clk *pa = c->parent;
	426	char s[255];
	427	char *p = s;
	428
	429	p += sprintf(p, "%s", c->name);
	430	if (c->id != 0)
	431	sprintf(p, ":%d", c->id);
	432	d = debugfs_create_dir(s, pa ? pa->dent : clk_debugfs_root);
	433	if (IS_ERR(d))
	434	return PTR_ERR(d);
	435	c->dent = d;
	436
	437	d = debugfs_create_u8("usecount", S_IRUGO, c->dent, (u8 *)&c->usecount);
	438	if (IS_ERR(d)) {
	439	err = PTR_ERR(d);
	440	goto err_out;
	441	}
	442	d = debugfs_create_u32("rate", S_IRUGO, c->dent, (u32 *)&c->rate);
	443	if (IS_ERR(d)) {
	444	err = PTR_ERR(d);
	445	goto err_out;
	446	}
	447	d = debugfs_create_x32("flags", S_IRUGO, c->dent, (u32 *)&c->flags);
	448	if (IS_ERR(d)) {
	449	err = PTR_ERR(d);
	450	goto err_out;
	451	}
	452	return 0;
	453
	454	err_out:
	455	d = c->dent;
	456	list_for_each_entry(child, &d->d_subdirs, d_u.d_child)
	457	debugfs_remove(child);
	458	debugfs_remove(c->dent);
	459	return err;
	460	}
	461
	462	static int clk_debugfs_register(struct clk *c)
	463	{
	464	int err;
	465	struct clk *pa = c->parent;
	466
	467	if (pa && !pa->dent) {
	468	err = clk_debugfs_register(pa);
	469	if (err)
	470	return err;
	471	}
	472
	473	if (!c->dent) {
	474	err = clk_debugfs_register_one(c);
	475	if (err)
	476	return err;
	477	}
	478	return 0;
479	}
480
481	static int __init clk_debugfs_init(void)
482	{
483	struct clk *c;
484	struct dentry *d;
485	int err;
486
487	d = debugfs_create_dir("clock", NULL);
488	if (IS_ERR(d))
489	return PTR_ERR(d);
490	clk_debugfs_root = d;
491
492	list_for_each_entry(c, &clocks, node) {
493	err = clk_debugfs_register(c);
494	if (err)
495	goto err_out;
496	}
497	return 0;
498	err_out:
499	debugfs_remove(clk_debugfs_root); /* REVISIT: Cleanup correctly */
500	return err;
501	}
502	late_initcall(clk_debugfs_init);
503
504	#endif /* defined(CONFIG_PM_DEBUG) && defined(CONFIG_DEBUG_FS) */