arch/arm/cpu/arm926ejs/mb86r0x/timer.c

   1 /*
   2  * (C) Copyright 2007-2008
   3  * Stelian Pop <stelian.pop@leadtechdesign.com>
   4  * Lead Tech Design <www.leadtechdesign.com>
   5  *
   6  * (C) Copyright 2010
   7  * Matthias Weisser, Graf-Syteco <weisserm@arcor.de>
   8  *
   9  * See file CREDITS for list of people who contributed to this
  10  * project.
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License as
  14  * published by the Free Software Foundation; either version 2 of
  15  * the License, or (at your option) any later version.
  16  *
  17  * This program is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with this program; if not, write to the Free Software
  24  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  25  * MA 02111-1307 USA
  26  */
  27
  28 #include <div64.h>
  29 #include <common.h>
  30 #include <asm/io.h>
  31 #include <asm/arch/hardware.h>
  32
  33 #define TIMER_LOAD_VAL  0xffffffff
  34 #define TIMER_FREQ      (CONFIG_MB86R0x_IOCLK  / 256)
  35
  36 DECLARE_GLOBAL_DATA_PTR;
  37
  38 #define timestamp gd->tbl
  39 #define lastdec gd->lastinc
  40
  41 static inline unsigned long long tick_to_time(unsigned long long tick)
  42 {
  43         tick *= CONFIG_SYS_HZ;
  44         do_div(tick, TIMER_FREQ);
  45
  46         return tick;
  47 }
  48
  49 static inline unsigned long long usec_to_tick(unsigned long long usec)
  50 {
  51         usec *= TIMER_FREQ;
  52         do_div(usec, 1000000);
  53
  54         return usec;
  55 }
  56
  57 /* nothing really to do with interrupts, just starts up a counter. */
  58 int timer_init(void)
  59 {
  60         struct mb86r0x_timer * timer = (struct mb86r0x_timer *)
  61                                         MB86R0x_TIMER_BASE;
  62         ulong ctrl = readl(&timer->control);
  63
  64         writel(TIMER_LOAD_VAL, &timer->load);
  65
  66         ctrl |= MB86R0x_TIMER_ENABLE | MB86R0x_TIMER_PRS_8S |
  67                 MB86R0x_TIMER_SIZE_32;
  68
  69         writel(ctrl, &timer->control);
  70
  71         reset_timer_masked();
  72
  73         return 0;
  74 }
  75
  76 /*
  77  * timer without interrupts
  78  */
  79 unsigned long long get_ticks(void)
  80 {
  81         struct mb86r0x_timer * timer = (struct mb86r0x_timer *)
  82                                         MB86R0x_TIMER_BASE;
  83         ulong now = readl(&timer->value);
  84
  85         if (now <= lastdec) {
  86                 /* normal mode (non roll) */
  87                 /* move stamp forward with absolut diff ticks */
  88                 timestamp += lastdec - now;
  89         } else {
  90                 /* we have rollover of incrementer */
  91                 timestamp += lastdec + TIMER_LOAD_VAL - now;
  92         }
  93         lastdec = now;
  94         return timestamp;
  95 }
  96
  97 void reset_timer_masked(void)
  98 {
  99         struct mb86r0x_timer * timer = (struct mb86r0x_timer *)
 100                                         MB86R0x_TIMER_BASE;
 101
 102         /* capture current value time */
 103         lastdec = readl(&timer->value);
 104         timestamp = 0; /* start "advancing" time stamp from 0 */
 105 }
 106
 107 ulong get_timer_masked(void)
 108 {
 109         return tick_to_time(get_ticks());
 110 }
 111
 112 void __udelay(unsigned long usec)
 113 {
 114         unsigned long long tmp;
 115         ulong tmo;
 116
 117         tmo = usec_to_tick(usec);
 118         tmp = get_ticks();                      /* get current timestamp */
 119
 120         while ((get_ticks() - tmp) < tmo)       /* loop till event */
 121                  /*NOP*/;
 122 }
 123
 124 void reset_timer(void)
 125 {
 126         reset_timer_masked();
 127 }
 128
 129 ulong get_timer(ulong base)
 130 {
 131         return get_timer_masked() - base;
 132 }
 133
 134 /*
 135  * This function is derived from PowerPC code (timebase clock frequency).
 136  * On ARM it returns the number of timer ticks per second.
 137  */
 138 ulong get_tbclk(void)
 139 {
 140         ulong tbclk;
 141
 142         tbclk = TIMER_FREQ;
 143         return tbclk;
 144 }