lib_m68k/time.c

   1 /*
   2  * (C) Copyright 2003 Josef Baumgartner <josef.baumgartner@telex.de>
   3  *
   4  * (C) Copyright 2000
   5  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   6  *
   7  * See file CREDITS for list of people who contributed to this
   8  * project.
   9  *
  10  * This program is free software; you can redistribute it and/or
  11  * modify it under the terms of the GNU General Public License as
  12  * published by the Free Software Foundation; either version 2 of
  13  * the License, or (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  23  * MA 02111-1307 USA
  24  */
  25
  26 #include <common.h>
  27
  28 #include <asm/timer.h>
  29 #include <asm/immap.h>
  30
  31 DECLARE_GLOBAL_DATA_PTR;
  32
  33 static ulong timestamp;
  34
  35 #if defined(CONFIG_MCFTMR)
  36 #ifndef CONFIG_SYS_UDELAY_BASE
  37 #       error   "uDelay base not defined!"
  38 #endif
  39
  40 #if !defined(CONFIG_SYS_TMR_BASE) || !defined(CONFIG_SYS_INTR_BASE) || !defined(CONFIG_SYS_TMRINTR_NO) || !defined(CONFIG_SYS_TMRINTR_MASK)
  41 #       error   "TMR_BASE, INTR_BASE, TMRINTR_NO or TMRINTR_MASk not defined!"
  42 #endif
  43 extern void dtimer_intr_setup(void);
  44
  45 void udelay(unsigned long usec)
  46 {
  47         volatile dtmr_t *timerp = (dtmr_t *) (CONFIG_SYS_UDELAY_BASE);
  48         uint start, now, tmp;
  49
  50         while (usec > 0) {
  51                 if (usec > 65000)
  52                         tmp = 65000;
  53                 else
  54                         tmp = usec;
  55                 usec = usec - tmp;
  56
  57                 /* Set up TIMER 3 as timebase clock */
  58                 timerp->tmr = DTIM_DTMR_RST_RST;
  59                 timerp->tcn = 0;
  60                 /* set period to 1 us */
  61                 timerp->tmr =
  62                     CONFIG_SYS_TIMER_PRESCALER | DTIM_DTMR_CLK_DIV1 | DTIM_DTMR_FRR |
  63                     DTIM_DTMR_RST_EN;
  64
  65                 start = now = timerp->tcn;
  66                 while (now < start + tmp)
  67                         now = timerp->tcn;
  68         }
  69 }
  70
  71 void dtimer_interrupt(void *not_used)
  72 {
  73         volatile dtmr_t *timerp = (dtmr_t *) (CONFIG_SYS_TMR_BASE);
  74
  75         /* check for timer interrupt asserted */
  76         if ((CONFIG_SYS_TMRPND_REG & CONFIG_SYS_TMRINTR_MASK) == CONFIG_SYS_TMRINTR_PEND) {
  77                 timerp->ter = (DTIM_DTER_CAP | DTIM_DTER_REF);
  78                 timestamp++;
  79                 return;
  80         }
  81 }
  82
  83 void timer_init(void)
  84 {
  85         volatile dtmr_t *timerp = (dtmr_t *) (CONFIG_SYS_TMR_BASE);
  86
  87         timestamp = 0;
  88
  89         timerp->tcn = 0;
  90         timerp->trr = 0;
  91
  92         /* Set up TIMER 4 as clock */
  93         timerp->tmr = DTIM_DTMR_RST_RST;
  94
  95         /* initialize and enable timer interrupt */
  96         irq_install_handler(CONFIG_SYS_TMRINTR_NO, dtimer_interrupt, 0);
  97
  98         timerp->tcn = 0;
  99         timerp->trr = 1000;     /* Interrupt every ms */
 100
 101         dtimer_intr_setup();
 102
 103         /* set a period of 1us, set timer mode to restart and enable timer and interrupt */
 104         timerp->tmr = CONFIG_SYS_TIMER_PRESCALER | DTIM_DTMR_CLK_DIV1 |
 105             DTIM_DTMR_FRR | DTIM_DTMR_ORRI | DTIM_DTMR_RST_EN;
 106 }
 107
 108 void reset_timer(void)
 109 {
 110         timestamp = 0;
 111 }
 112
 113 ulong get_timer(ulong base)
 114 {
 115         return (timestamp - base);
 116 }
 117
 118 void set_timer(ulong t)
 119 {
 120         timestamp = t;
 121 }
 122 #endif                          /* CONFIG_MCFTMR */
 123
 124 #if defined(CONFIG_MCFPIT)
 125 #if !defined(CONFIG_SYS_PIT_BASE)
 126 #       error   "CONFIG_SYS_PIT_BASE not defined!"
 127 #endif
 128
 129 static unsigned short lastinc;
 130
 131 void udelay(unsigned long usec)
 132 {
 133         volatile pit_t *timerp = (pit_t *) (CONFIG_SYS_UDELAY_BASE);
 134         uint tmp;
 135
 136         while (usec > 0) {
 137                 if (usec > 65000)
 138                         tmp = 65000;
 139                 else
 140                         tmp = usec;
 141                 usec = usec - tmp;
 142
 143                 /* Set up TIMER 3 as timebase clock */
 144                 timerp->pcsr = PIT_PCSR_OVW;
 145                 timerp->pmr = 0;
 146                 /* set period to 1 us */
 147                 timerp->pcsr |= PIT_PCSR_PRE(CONFIG_SYS_PIT_PRESCALE) | PIT_PCSR_EN;
 148
 149                 timerp->pmr = tmp;
 150                 while (timerp->pcntr > 0) ;
 151         }
 152 }
 153
 154 void timer_init(void)
 155 {
 156         volatile pit_t *timerp = (pit_t *) (CONFIG_SYS_PIT_BASE);
 157         timestamp = 0;
 158
 159         /* Set up TIMER 4 as poll clock */
 160         timerp->pcsr = PIT_PCSR_OVW;
 161         timerp->pmr = lastinc = 0;
 162         timerp->pcsr |= PIT_PCSR_PRE(CONFIG_SYS_PIT_PRESCALE) | PIT_PCSR_EN;
 163 }
 164
 165 void set_timer(ulong t)
 166 {
 167         volatile pit_t *timerp = (pit_t *) (CONFIG_SYS_PIT_BASE);
 168
 169         timestamp = 0;
 170         timerp->pmr = lastinc = 0;
 171 }
 172
 173 ulong get_timer(ulong base)
 174 {
 175         unsigned short now, diff;
 176         volatile pit_t *timerp = (pit_t *) (CONFIG_SYS_PIT_BASE);
 177
 178         now = timerp->pcntr;
 179         diff = -(now - lastinc);
 180
 181         timestamp += diff;
 182         lastinc = now;
 183         return timestamp - base;
 184 }
 185
 186 void wait_ticks(unsigned long ticks)
 187 {
 188         set_timer(0);
 189         while (get_timer(0) < ticks) ;
 190 }
 191 #endif                          /* CONFIG_MCFPIT */
 192
 193 /*
 194  * This function is derived from PowerPC code (read timebase as long long).
 195  * On M68K it just returns the timer value.
 196  */
 197 unsigned long long get_ticks(void)
 198 {
 199         return get_timer(0);
 200 }
 201
 202 unsigned long usec2ticks(unsigned long usec)
 203 {
 204         return get_timer(usec);
 205 }
 206
 207 /*
 208  * This function is derived from PowerPC code (timebase clock frequency).
 209  * On M68K it returns the number of timer ticks per second.
 210  */
 211 ulong get_tbclk(void)
 212 {
 213         ulong tbclk;
 214         tbclk = CONFIG_SYS_HZ;
 215         return tbclk;
 216 }