|
@@ -21,16 +21,6 @@
|
|
|
|
|
|
#include <common.h>
|
|
|
|
|
|
-#define TIMER_LOAD_VAL 0xffffffff
|
|
|
-
|
|
|
-/* macro to read the 32 bit timer */
|
|
|
-#define READ_TIMER (*(volatile ulong *)(CONFIG_SYS_TIMERBASE+4))
|
|
|
-
|
|
|
-DECLARE_GLOBAL_DATA_PTR;
|
|
|
-
|
|
|
-#define timestamp gd->arch.tbl
|
|
|
-#define lastdec gd->arch.lastinc
|
|
|
-
|
|
|
#define TIMER_ENABLE (1 << 7)
|
|
|
#define TIMER_MODE_MSK (1 << 6)
|
|
|
#define TIMER_MODE_FR (0 << 6)
|
|
@@ -69,112 +59,6 @@ int timer_init (void)
|
|
|
|
|
|
*(volatile ulong *)(CONFIG_SYS_TIMERBASE + 8) = tmr_ctrl_val;
|
|
|
|
|
|
- /* init the timestamp and lastdec value */
|
|
|
- reset_timer_masked();
|
|
|
-
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-/*
|
|
|
- * timer without interrupts
|
|
|
- */
|
|
|
-ulong get_timer (ulong base)
|
|
|
-{
|
|
|
- return get_timer_masked () - base;
|
|
|
-}
|
|
|
-
|
|
|
-/* delay x useconds AND preserve advance timestamp value */
|
|
|
-void __udelay (unsigned long usec)
|
|
|
-{
|
|
|
- ulong tmo, tmp;
|
|
|
-
|
|
|
- if(usec >= 1000){ /* if "big" number, spread normalization to seconds */
|
|
|
- tmo = usec / 1000; /* start to normalize for usec to ticks per sec */
|
|
|
- tmo *= CONFIG_SYS_HZ; /* find number of "ticks" to wait to achieve target */
|
|
|
- tmo /= 1000; /* finish normalize. */
|
|
|
- }else{ /* else small number, don't kill it prior to HZ multiply */
|
|
|
- tmo = usec * CONFIG_SYS_HZ;
|
|
|
- tmo /= (1000*1000);
|
|
|
- }
|
|
|
-
|
|
|
- tmp = get_timer (0); /* get current timestamp */
|
|
|
- if( (tmo + tmp + 1) < tmp ) /* if setting this fordward will roll time stamp */
|
|
|
- reset_timer_masked (); /* reset "advancing" timestamp to 0, set lastdec value */
|
|
|
- else
|
|
|
- tmo += tmp; /* else, set advancing stamp wake up time */
|
|
|
-
|
|
|
- while (get_timer_masked () < tmo)/* loop till event */
|
|
|
- /*NOP*/;
|
|
|
-}
|
|
|
-
|
|
|
-void reset_timer_masked (void)
|
|
|
-{
|
|
|
- /* reset time */
|
|
|
- lastdec = READ_TIMER; /* capure current decrementer value time */
|
|
|
- timestamp = 0; /* start "advancing" time stamp from 0 */
|
|
|
-}
|
|
|
-
|
|
|
-ulong get_timer_masked (void)
|
|
|
-{
|
|
|
- ulong now = READ_TIMER; /* current tick value */
|
|
|
-
|
|
|
- if (lastdec >= now) { /* normal mode (non roll) */
|
|
|
- /* normal mode */
|
|
|
- timestamp += lastdec - now; /* move stamp fordward with absoulte diff ticks */
|
|
|
- } else { /* we have overflow of the count down timer */
|
|
|
- /* nts = ts + ld + (TLV - now)
|
|
|
- * ts=old stamp, ld=time that passed before passing through -1
|
|
|
- * (TLV-now) amount of time after passing though -1
|
|
|
- * nts = new "advancing time stamp"...it could also roll and cause problems.
|
|
|
- */
|
|
|
- timestamp += lastdec + TIMER_LOAD_VAL - now;
|
|
|
- }
|
|
|
- lastdec = now;
|
|
|
-
|
|
|
- return timestamp;
|
|
|
-}
|
|
|
-
|
|
|
-/* waits specified delay value and resets timestamp */
|
|
|
-void udelay_masked (unsigned long usec)
|
|
|
-{
|
|
|
- ulong tmo;
|
|
|
- ulong endtime;
|
|
|
- signed long diff;
|
|
|
-
|
|
|
- if (usec >= 1000) { /* if "big" number, spread normalization to seconds */
|
|
|
- tmo = usec / 1000; /* start to normalize for usec to ticks per sec */
|
|
|
- tmo *= CONFIG_SYS_HZ; /* find number of "ticks" to wait to achieve target */
|
|
|
- tmo /= 1000; /* finish normalize. */
|
|
|
- } else { /* else small number, don't kill it prior to HZ multiply */
|
|
|
- tmo = usec * CONFIG_SYS_HZ;
|
|
|
- tmo /= (1000*1000);
|
|
|
- }
|
|
|
-
|
|
|
- endtime = get_timer_masked () + tmo;
|
|
|
-
|
|
|
- do {
|
|
|
- ulong now = get_timer_masked ();
|
|
|
- diff = endtime - now;
|
|
|
- } while (diff >= 0);
|
|
|
-}
|
|
|
-
|
|
|
-/*
|
|
|
- * This function is derived from PowerPC code (read timebase as long long).
|
|
|
- * On ARM it just returns the timer value.
|
|
|
- */
|
|
|
-unsigned long long get_ticks(void)
|
|
|
-{
|
|
|
- return get_timer(0);
|
|
|
-}
|
|
|
-
|
|
|
-/*
|
|
|
- * This function is derived from PowerPC code (timebase clock frequency).
|
|
|
- * On ARM it returns the number of timer ticks per second.
|
|
|
- */
|
|
|
-ulong get_tbclk (void)
|
|
|
-{
|
|
|
- ulong tbclk;
|
|
|
-
|
|
|
- tbclk = CONFIG_SYS_HZ;
|
|
|
- return tbclk;
|
|
|
-}
|