[mirror_ubuntu-artful-kernel.git] / arch / arm / mach-w90x900 / clock.c

/*
 * linux/arch/arm/mach-w90x900/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"

#define SUBCLK 0x24

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;

	if (!clk)
		return;

	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 15000000;
}
EXPORT_SYMBOL(clk_get_rate);

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

	clken = __raw_readl(W90X900_VA_CLKPWR);

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

	__raw_writel(clken, W90X900_VA_CLKPWR);
}

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

	clken = __raw_readl(W90X900_VA_CLKPWR + SUBCLK);

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

	__raw_writel(clken, W90X900_VA_CLKPWR + SUBCLK);
}

/* dummy functions, should not be called */
long clk_round_rate(struct clk *clk, unsigned long rate)
{
	WARN_ON(clk);
	return 0;
}
EXPORT_SYMBOL(clk_round_rate);

int clk_set_rate(struct clk *clk, unsigned long rate)
{
	WARN_ON(clk);
	return 0;
}
EXPORT_SYMBOL(clk_set_rate);

int clk_set_parent(struct clk *clk, struct clk *parent)
{
	WARN_ON(clk);
	return 0;
}
EXPORT_SYMBOL(clk_set_parent);

struct clk *clk_get_parent(struct clk *clk)
{
	WARN_ON(clk);
	return NULL;
}
EXPORT_SYMBOL(clk_get_parent);
Commit	Line	Data
0e4a34bb	1	/*
	2	* linux/arch/arm/mach-w90x900/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
db58e90f	28	#define SUBCLK 0x24
db58e90f	29
0e4a34bb	30	static DEFINE_SPINLOCK(clocks_lock);
	31
	32	int clk_enable(struct clk *clk)
	33	{
	34	unsigned long flags;
	35
	36	spin_lock_irqsave(&clocks_lock, flags);
	37	if (clk->enabled++ == 0)
	38	(clk->enable)(clk, 1);
	39	spin_unlock_irqrestore(&clocks_lock, flags);
	40
	41	return 0;
	42	}
	43	EXPORT_SYMBOL(clk_enable);
	44
	45	void clk_disable(struct clk *clk)
	46	{
	47	unsigned long flags;
	48
e1ffaa55 MY	49	if (!clk)
	50	return;
	51
0e4a34bb	52	WARN_ON(clk->enabled == 0);
	53
	54	spin_lock_irqsave(&clocks_lock, flags);
	55	if (--clk->enabled == 0)
	56	(clk->enable)(clk, 0);
	57	spin_unlock_irqrestore(&clocks_lock, flags);
	58	}
	59	EXPORT_SYMBOL(clk_disable);
	60
58b5369e	61	unsigned long clk_get_rate(struct clk *clk)
	62	{
	63	return 15000000;
	64	}
	65	EXPORT_SYMBOL(clk_get_rate);
	66
35c9221a	67	void nuc900_clk_enable(struct clk *clk, int enable)
0e4a34bb	68	{
	69	unsigned int clocks = clk->cken;
	70	unsigned long clken;
	71
	72	clken = __raw_readl(W90X900_VA_CLKPWR);
	73
	74	if (enable)
	75	clken \|= clocks;
	76	else
	77	clken &= ~clocks;
	78
	79	__raw_writel(clken, W90X900_VA_CLKPWR);
	80	}
	81
35c9221a	82	void nuc900_subclk_enable(struct clk *clk, int enable)
db58e90f	83	{
	84	unsigned int clocks = clk->cken;
	85	unsigned long clken;
	86
	87	clken = __raw_readl(W90X900_VA_CLKPWR + SUBCLK);
	88
	89	if (enable)
	90	clken \|= clocks;
	91	else
	92	clken &= ~clocks;
	93
	94	__raw_writel(clken, W90X900_VA_CLKPWR + SUBCLK);
	95	}
bd7fefe1 AB	96
	97	/* dummy functions, should not be called */
	98	long clk_round_rate(struct clk *clk, unsigned long rate)
	99	{
	100	WARN_ON(clk);
	101	return 0;
	102	}
	103	EXPORT_SYMBOL(clk_round_rate);
	104
	105	int clk_set_rate(struct clk *clk, unsigned long rate)
	106	{
	107	WARN_ON(clk);
	108	return 0;
	109	}
	110	EXPORT_SYMBOL(clk_set_rate);
	111
	112	int clk_set_parent(struct clk clk, struct clk parent)
	113	{
	114	WARN_ON(clk);
	115	return 0;
	116	}
	117	EXPORT_SYMBOL(clk_set_parent);
	118
	119	struct clk clk_get_parent(struct clk clk)
	120	{
	121	WARN_ON(clk);
	122	return NULL;
	123	}
	124	EXPORT_SYMBOL(clk_get_parent);