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
28 #define SUBCLK 0x24
29
30 static DEFINE_SPINLOCK(clocks_lock);
31
clk_enable(struct clk * clk)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
clk_disable(struct clk * clk)45 void clk_disable(struct clk *clk)
46 {
47 unsigned long flags;
48
49 WARN_ON(clk->enabled == 0);
50
51 spin_lock_irqsave(&clocks_lock, flags);
52 if (--clk->enabled == 0)
53 (clk->enable)(clk, 0);
54 spin_unlock_irqrestore(&clocks_lock, flags);
55 }
56 EXPORT_SYMBOL(clk_disable);
57
clk_get_rate(struct clk * clk)58 unsigned long clk_get_rate(struct clk *clk)
59 {
60 return 15000000;
61 }
62 EXPORT_SYMBOL(clk_get_rate);
63
nuc900_clk_enable(struct clk * clk,int enable)64 void nuc900_clk_enable(struct clk *clk, int enable)
65 {
66 unsigned int clocks = clk->cken;
67 unsigned long clken;
68
69 clken = __raw_readl(W90X900_VA_CLKPWR);
70
71 if (enable)
72 clken |= clocks;
73 else
74 clken &= ~clocks;
75
76 __raw_writel(clken, W90X900_VA_CLKPWR);
77 }
78
nuc900_subclk_enable(struct clk * clk,int enable)79 void nuc900_subclk_enable(struct clk *clk, int enable)
80 {
81 unsigned int clocks = clk->cken;
82 unsigned long clken;
83
84 clken = __raw_readl(W90X900_VA_CLKPWR + SUBCLK);
85
86 if (enable)
87 clken |= clocks;
88 else
89 clken &= ~clocks;
90
91 __raw_writel(clken, W90X900_VA_CLKPWR + SUBCLK);
92 }
93