arch/arm/mach-w90x900/clock.c

   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
  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
  49         if (!clk)
  50                 return;
  51
  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
  61 unsigned long clk_get_rate(struct clk *clk)
  62 {
  63         return 15000000;
  64 }
  65 EXPORT_SYMBOL(clk_get_rate);
  66
  67 void nuc900_clk_enable(struct clk *clk, int enable)
  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
  82 void nuc900_subclk_enable(struct clk *clk, int enable)
  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 }