LXR linux/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
  30static DEFINE_SPINLOCK(clocks_lock);
  31
  32int 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}
  43EXPORT_SYMBOL(clk_enable);
  44
  45void 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}
  56EXPORT_SYMBOL(clk_disable);
  57
  58unsigned long clk_get_rate(struct clk *clk)
  59{
  60        return 15000000;
  61}
  62EXPORT_SYMBOL(clk_get_rate);
  63
  64void 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
  79void 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