git.sur5r.net Git - u-boot/blob - arch/arm/cpu/lh7a40x/timer.c

   1 /*
   2  * (C) Copyright 2002
   3  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
   4  * Marius Groeger <mgroeger@sysgo.de>
   5  *
   6  * (C) Copyright 2002
   7  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
   8  * Alex Zuepke <azu@sysgo.de>
   9  *
  10  * (C) Copyright 2002
  11  * Gary Jennejohn, DENX Software Engineering, <garyj@denx.de>
  12  *
  13  * See file CREDITS for list of people who contributed to this
  14  * project.
  15  *
  16  * This program is free software; you can redistribute it and/or
  17  * modify it under the terms of the GNU General Public License as
  18  * published by the Free Software Foundation; either version 2 of
  19  * the License, or (at your option) any later version.
  20  *
  21  * This program is distributed in the hope that it will be useful,
  22  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  23  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  24  * GNU General Public License for more details.
  25  *
  26  * You should have received a copy of the GNU General Public License
  27  * along with this program; if not, write to the Free Software
  28  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  29  * MA 02111-1307 USA
  30  */
  31
  32 #include <common.h>
  33 #include <lh7a40x.h>
  34
  35 static ulong timer_load_val = 0;
  36
  37 /* macro to read the 16 bit timer */
  38 static inline ulong READ_TIMER(void)
  39 {
  40         lh7a40x_timers_t* timers = LH7A40X_TIMERS_PTR;
  41         lh7a40x_timer_t* timer = &timers->timer1;
  42
  43         return (timer->value & 0x0000ffff);
  44 }
  45
  46 static ulong timestamp;
  47 static ulong lastdec;
  48
  49 int timer_init (void)
  50 {
  51         lh7a40x_timers_t* timers = LH7A40X_TIMERS_PTR;
  52         lh7a40x_timer_t* timer = &timers->timer1;
  53
  54         /* a periodic timer using the 508kHz source */
  55         timer->control = (TIMER_PER | TIMER_CLK508K);
  56
  57         if (timer_load_val == 0) {
  58                 /*
  59                  * 10ms period with 508.469kHz clock = 5084
  60                  */
  61                 timer_load_val = CONFIG_SYS_HZ/100;
  62         }
  63
  64         /* load value for 10 ms timeout */
  65         lastdec = timer->load = timer_load_val;
  66
  67         /* auto load, start timer */
  68         timer->control = timer->control | TIMER_EN;
  69         timestamp = 0;
  70
  71         return (0);
  72 }
  73
  74 /*
  75  * timer without interrupts
  76  */
  77 ulong get_timer (ulong base)
  78 {
  79         return (get_timer_masked() - base);
  80 }
  81
  82 void __udelay (unsigned long usec)
  83 {
  84         ulong tmo,tmp;
  85
  86         /* normalize */
  87         if (usec >= 1000) {
  88                 tmo = usec / 1000;
  89                 tmo *= CONFIG_SYS_HZ;
  90                 tmo /= 1000;
  91         }
  92         else {
  93                 if (usec > 1) {
  94                         tmo = usec * CONFIG_SYS_HZ;
  95                         tmo /= (1000*1000);
  96                 }
  97                 else
  98                         tmo = 1;
  99         }
 100
 101         /* check for rollover during this delay */
 102         tmp = get_timer (0);
 103         if ((tmp + tmo) < tmp )
 104                 reset_timer_masked();  /* timer would roll over */
 105         else
 106                 tmo += tmp;
 107
 108         while (get_timer_masked () < tmo);
 109 }
 110
 111 void reset_timer_masked (void)
 112 {
 113         /* reset time */
 114         lastdec = READ_TIMER();
 115         timestamp = 0;
 116 }
 117
 118 ulong get_timer_masked (void)
 119 {
 120         ulong now = READ_TIMER();
 121
 122         if (lastdec >= now) {
 123                 /* normal mode */
 124                 timestamp += (lastdec - now);
 125         } else {
 126                 /* we have an overflow ... */
 127                 timestamp += ((lastdec + timer_load_val) - now);
 128         }
 129         lastdec = now;
 130
 131         return timestamp;
 132 }
 133
 134 void udelay_masked (unsigned long usec)
 135 {
 136         ulong tmo;
 137         ulong endtime;
 138         signed long diff;
 139
 140         /* normalize */
 141         if (usec >= 1000) {
 142                 tmo = usec / 1000;
 143                 tmo *= CONFIG_SYS_HZ;
 144                 tmo /= 1000;
 145         } else {
 146                 if (usec > 1) {
 147                         tmo = usec * CONFIG_SYS_HZ;
 148                         tmo /= (1000*1000);
 149                 } else {
 150                         tmo = 1;
 151                 }
 152         }
 153
 154         endtime = get_timer_masked () + tmo;
 155
 156         do {
 157                 ulong now = get_timer_masked ();
 158                 diff = endtime - now;
 159         } while (diff >= 0);
 160 }
 161
 162 /*
 163  * This function is derived from PowerPC code (read timebase as long long).
 164  * On ARM it just returns the timer value.
 165  */
 166 unsigned long long get_ticks(void)
 167 {
 168         return get_timer(0);
 169 }
 170
 171 /*
 172  * This function is derived from PowerPC code (timebase clock frequency).
 173  * On ARM it returns the number of timer ticks per second.
 174  */
 175 ulong get_tbclk (void)
 176 {
 177         ulong tbclk;
 178
 179         tbclk = timer_load_val * 100;
 180
 181         return tbclk;
 182 }