text: /*
   * 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]);
  }
  