102 lines
1.9 KiB
C
102 lines
1.9 KiB
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;
|
|
|
|
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);
|
|
}
|
|
|
|
|
|
void clks_register(struct clk_lookup *clks, size_t num)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < num; i++)
|
|
clkdev_add(&clks[i]);
|
|
}
|