arch/sh/kernel/cpu/sh3/clock-sh7710.c

   1 /*
   2  * arch/sh/kernel/cpu/sh3/clock-sh7710.c
   3  *
   4  * SH7710 support for the clock framework
   5  *
   6  *  Copyright (C) 2005  Paul Mundt
   7  *
   8  * FRQCR parsing hacked out of arch/sh/kernel/time.c
   9  *
  10  *  Copyright (C) 1999  Tetsuya Okada & Niibe Yutaka
  11  *  Copyright (C) 2000  Philipp Rumpf <prumpf@tux.org>
  12  *  Copyright (C) 2002, 2003, 2004  Paul Mundt
  13  *  Copyright (C) 2002  M. R. Brown  <mrbrown@linux-sh.org>
  14  *
  15  * This file is subject to the terms and conditions of the GNU General Public
  16  * License.  See the file "COPYING" in the main directory of this archive
  17  * for more details.
  18  */
  19 #include <linux/init.h>
  20 #include <linux/kernel.h>
  21 #include <asm/clock.h>
  22 #include <asm/freq.h>
  23 #include <asm/io.h>
  24
  25 static int md_table[] = { 1, 2, 3, 4, 6, 8, 12 };
  26
  27 static void master_clk_init(struct clk *clk)
  28 {
  29         clk->rate *= md_table[__raw_readw(FRQCR) & 0x0007];
  30 }
  31
  32 static struct sh_clk_ops sh7710_master_clk_ops = {
  33         .init           = master_clk_init,
  34 };
  35
  36 static unsigned long module_clk_recalc(struct clk *clk)
  37 {
  38         int idx = (__raw_readw(FRQCR) & 0x0007);
  39         return clk->parent->rate / md_table[idx];
  40 }
  41
  42 static struct sh_clk_ops sh7710_module_clk_ops = {
  43         .recalc         = module_clk_recalc,
  44 };
  45
  46 static unsigned long bus_clk_recalc(struct clk *clk)
  47 {
  48         int idx = (__raw_readw(FRQCR) & 0x0700) >> 8;
  49         return clk->parent->rate / md_table[idx];
  50 }
  51
  52 static struct sh_clk_ops sh7710_bus_clk_ops = {
  53         .recalc         = bus_clk_recalc,
  54 };
  55
  56 static unsigned long cpu_clk_recalc(struct clk *clk)
  57 {
  58         int idx = (__raw_readw(FRQCR) & 0x0070) >> 4;
  59         return clk->parent->rate / md_table[idx];
  60 }
  61
  62 static struct sh_clk_ops sh7710_cpu_clk_ops = {
  63         .recalc         = cpu_clk_recalc,
  64 };
  65
  66 static struct sh_clk_ops *sh7710_clk_ops[] = {
  67         &sh7710_master_clk_ops,
  68         &sh7710_module_clk_ops,
  69         &sh7710_bus_clk_ops,
  70         &sh7710_cpu_clk_ops,
  71 };
  72
  73 void __init arch_init_clk_ops(struct sh_clk_ops **ops, int idx)
  74 {
  75         if (idx < ARRAY_SIZE(sh7710_clk_ops))
  76                 *ops = sh7710_clk_ops[idx];
  77 }
  78