[deliverable/linux.git] / arch / arm / mach-nuc93x / clock.c

/*
 * linux/arch/arm/mach-nuc93x/clock.c
 *
 * Copyright (c) 2008 Nuvoton technology corporation
 *
 * Wan ZongShun <mcuos.com@gmail.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/list.h>
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/string.h>
#include <linux/clk.h>
#include <linux/spinlock.h>
#include <linux/platform_device.h>
#include <linux/io.h>

#include <mach/hardware.h>

#include "clock.h"

static DEFINE_SPINLOCK(clocks_lock);

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

	spin_lock_irqsave(&clocks_lock, flags);
	if (clk->enabled++ == 0)
		(clk->enable)(clk, 1);
	spin_unlock_irqrestore(&clocks_lock, flags);

	return 0;
}
EXPORT_SYMBOL(clk_enable);

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

	WARN_ON(clk->enabled == 0);

	spin_lock_irqsave(&clocks_lock, flags);
	if (--clk->enabled == 0)
		(clk->enable)(clk, 0);
	spin_unlock_irqrestore(&clocks_lock, flags);
}
EXPORT_SYMBOL(clk_disable);

unsigned long clk_get_rate(struct clk *clk)
{
	return 27000000;
}
EXPORT_SYMBOL(clk_get_rate);

void nuc93x_clk_enable(struct clk *clk, int enable)
{
	unsigned int clocks = clk->cken;
	unsigned long clken;

	clken = __raw_readl(NUC93X_VA_CLKPWR);

	if (enable)
		clken |= clocks;
	else
		clken &= ~clocks;

	__raw_writel(clken, NUC93X_VA_CLKPWR);
}

void clks_register(struct clk_lookup *clks, size_t num)
{
	int i;

	for (i = 0; i < num; i++)
		clkdev_add(&clks[i]);
}
Commit	Line	Data
a62e9030	1	/*
	2	* linux/arch/arm/mach-nuc93x/clock.c
	3	*
	4	* Copyright (c) 2008 Nuvoton technology corporation
	5	*
	6	* Wan ZongShun <mcuos.com@gmail.com>
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License.
	11	*/
	12
	13	#include <linux/module.h>
	14	#include <linux/kernel.h>
	15	#include <linux/list.h>
	16	#include <linux/errno.h>
	17	#include <linux/err.h>
	18	#include <linux/string.h>
	19	#include <linux/clk.h>
	20	#include <linux/spinlock.h>
	21	#include <linux/platform_device.h>
	22	#include <linux/io.h>
	23
	24	#include <mach/hardware.h>
	25
	26	#include "clock.h"
	27
	28	static DEFINE_SPINLOCK(clocks_lock);
	29
	30	int clk_enable(struct clk *clk)
	31	{
	32	unsigned long flags;
	33
	34	spin_lock_irqsave(&clocks_lock, flags);
	35	if (clk->enabled++ == 0)
	36	(clk->enable)(clk, 1);
	37	spin_unlock_irqrestore(&clocks_lock, flags);
	38
	39	return 0;
	40	}
	41	EXPORT_SYMBOL(clk_enable);
	42
	43	void clk_disable(struct clk *clk)
	44	{
	45	unsigned long flags;
	46
	47	WARN_ON(clk->enabled == 0);
	48
	49	spin_lock_irqsave(&clocks_lock, flags);
	50	if (--clk->enabled == 0)
	51	(clk->enable)(clk, 0);
	52	spin_unlock_irqrestore(&clocks_lock, flags);
	53	}
	54	EXPORT_SYMBOL(clk_disable);
	55
	56	unsigned long clk_get_rate(struct clk *clk)
	57	{
	58	return 27000000;
	59	}
	60	EXPORT_SYMBOL(clk_get_rate);
	61
	62	void nuc93x_clk_enable(struct clk *clk, int enable)
	63	{
	64	unsigned int clocks = clk->cken;
65	unsigned long clken;
66
67	clken = __raw_readl(NUC93X_VA_CLKPWR);
68
69	if (enable)
70	clken \|= clocks;
71	else
72	clken &= ~clocks;
73
74	__raw_writel(clken, NUC93X_VA_CLKPWR);
75	}
76
77	void clks_register(struct clk_lookup *clks, size_t num)
78	{
79	int i;
80
81	for (i = 0; i < num; i++)
82	clkdev_add(&clks[i]);
83	}