|
|
|
@ -23,6 +23,7 @@ |
|
|
|
|
|
|
|
|
|
#include <common.h> |
|
|
|
|
#include <asm/arch/mx31-regs.h> |
|
|
|
|
#include <div64.h> |
|
|
|
|
|
|
|
|
|
#define TIMER_BASE 0x53f90000 /* General purpose timer 1 */ |
|
|
|
|
|
|
|
|
@ -38,24 +39,55 @@ |
|
|
|
|
#define GPTCR_CLKSOURCE_32 (4 << 6) /* Clock source */ |
|
|
|
|
#define GPTCR_TEN 1 /* Timer enable */ |
|
|
|
|
|
|
|
|
|
static ulong timestamp; |
|
|
|
|
static ulong lastinc; |
|
|
|
|
|
|
|
|
|
/* "time" is measured in 1 / CONFIG_SYS_HZ seconds, "tick" is internal timer period */ |
|
|
|
|
#ifdef CONFIG_MX31_TIMER_HIGH_PRECISION |
|
|
|
|
/* ~0.4% error - measured with stop-watch on 100s boot-delay */ |
|
|
|
|
#define TICK_TO_TIME(t) ((t) * CONFIG_SYS_HZ / CONFIG_MX31_CLK32) |
|
|
|
|
#define TIME_TO_TICK(t) ((unsigned long long)(t) * CONFIG_MX31_CLK32 / CONFIG_SYS_HZ) |
|
|
|
|
#define US_TO_TICK(t) (((unsigned long long)(t) * CONFIG_MX31_CLK32 + \ |
|
|
|
|
999999) / 1000000) |
|
|
|
|
static inline unsigned long long tick_to_time(unsigned long long tick) |
|
|
|
|
{ |
|
|
|
|
tick *= CONFIG_SYS_HZ; |
|
|
|
|
do_div(tick, CONFIG_MX31_CLK32); |
|
|
|
|
return tick; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline unsigned long long time_to_tick(unsigned long long time) |
|
|
|
|
{ |
|
|
|
|
time *= CONFIG_MX31_CLK32; |
|
|
|
|
do_div(time, CONFIG_SYS_HZ); |
|
|
|
|
return time; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline unsigned long long us_to_tick(unsigned long long us) |
|
|
|
|
{ |
|
|
|
|
us = us * CONFIG_MX31_CLK32 + 999999; |
|
|
|
|
do_div(us, 1000000); |
|
|
|
|
return us; |
|
|
|
|
} |
|
|
|
|
#else |
|
|
|
|
/* ~2% error */ |
|
|
|
|
#define TICK_PER_TIME ((CONFIG_MX31_CLK32 + CONFIG_SYS_HZ / 2) / CONFIG_SYS_HZ) |
|
|
|
|
#define US_PER_TICK (1000000 / CONFIG_MX31_CLK32) |
|
|
|
|
#define TICK_TO_TIME(t) ((t) / TICK_PER_TIME) |
|
|
|
|
#define TIME_TO_TICK(t) ((unsigned long long)(t) * TICK_PER_TIME) |
|
|
|
|
#define US_TO_TICK(t) (((t) + US_PER_TICK - 1) / US_PER_TICK) |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
static ulong timestamp; |
|
|
|
|
static ulong lastinc; |
|
|
|
|
static inline unsigned long long tick_to_time(unsigned long long tick) |
|
|
|
|
{ |
|
|
|
|
do_div(tick, TICK_PER_TIME); |
|
|
|
|
return tick; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline unsigned long long time_to_tick(unsigned long long time) |
|
|
|
|
{ |
|
|
|
|
return time * TICK_PER_TIME; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline unsigned long long us_to_tick(unsigned long long us) |
|
|
|
|
{ |
|
|
|
|
us += US_PER_TICK - 1; |
|
|
|
|
do_div(us, US_PER_TICK); |
|
|
|
|
return us; |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
/* nothing really to do with interrupts, just starts up a counter. */ |
|
|
|
|
/* The 32768Hz 32-bit timer overruns in 131072 seconds */ |
|
|
|
@ -107,7 +139,7 @@ ulong get_timer_masked (void) |
|
|
|
|
* 5 * 10^9 days... and get_ticks() * CONFIG_SYS_HZ wraps in |
|
|
|
|
* 5 * 10^6 days - long enough. |
|
|
|
|
*/ |
|
|
|
|
return TICK_TO_TIME(get_ticks()); |
|
|
|
|
return tick_to_time(get_ticks()); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
ulong get_timer (ulong base) |
|
|
|
@ -117,7 +149,7 @@ ulong get_timer (ulong base) |
|
|
|
|
|
|
|
|
|
void set_timer (ulong t) |
|
|
|
|
{ |
|
|
|
|
timestamp = TIME_TO_TICK(t); |
|
|
|
|
timestamp = time_to_tick(t); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* delay x useconds AND perserve advance timstamp value */ |
|
|
|
@ -126,7 +158,7 @@ void udelay (unsigned long usec) |
|
|
|
|
unsigned long long tmp; |
|
|
|
|
ulong tmo; |
|
|
|
|
|
|
|
|
|
tmo = US_TO_TICK(usec); |
|
|
|
|
tmo = us_to_tick(usec); |
|
|
|
|
tmp = get_ticks() + tmo; /* get current timestamp */ |
|
|
|
|
|
|
|
|
|
while (get_ticks() < tmp) /* loop till event */ |
|
|
|
|