Make the frclock functions similar to the tsc utility functions. This way, we can call frclock functions from the framebuffer driver which will use frclock on ARM and tsc on X86. Also, frclock_64_to_micros computed seconds, not microseconds Change-Id: I6718ae0fb7db050794f6f032205923e1a32dc1ac
91 lines
2.3 KiB
C
91 lines
2.3 KiB
C
/* Some utility functions around the free running clock on ARM. The clock is
|
|
* 32-bits wide, but we provide 64-bit wrapper functions to make it look
|
|
* similar to the read_tsc functions. On hardware we could actually make use
|
|
* of the timer overflow counter, but emulator doesn't emulate it. */
|
|
|
|
#include "omap_timer_registers.h"
|
|
#include <minix/minlib.h>
|
|
#include <minix/sysutil.h>
|
|
#include <minix/type.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/types.h>
|
|
#include <assert.h>
|
|
|
|
static u64_t calib_hz = 1625000, Hz;
|
|
#define MICROHZ 1000000ULL /* number of micros per second */
|
|
#define MICROSPERTICK(h) (MICROHZ/(h)) /* number of micros per HZ tick */
|
|
|
|
int
|
|
micro_delay(u32_t micros)
|
|
{
|
|
u64_t start, delta, delta_end;
|
|
|
|
Hz = sys_hz();
|
|
|
|
/* Start of delay. */
|
|
read_frclock_64(&start);
|
|
delta_end = (calib_hz * micros) / MICROHZ;
|
|
|
|
/* If we have to wait for at least one HZ tick, use the regular
|
|
* tickdelay first. Round downwards on purpose, so the average
|
|
* half-tick we wait short (depending on where in the current tick
|
|
* we call tickdelay). We can correct for both overhead of tickdelay
|
|
* itself and the short wait in the busywait later.
|
|
*/
|
|
if (micros >= MICROSPERTICK(Hz))
|
|
tickdelay(micros*Hz/MICROHZ);
|
|
|
|
/* Wait (the rest) of the delay time using busywait. */
|
|
do {
|
|
read_frclock_64(&delta);
|
|
} while (delta_frclock_64(start, delta) < delta_end);
|
|
|
|
|
|
return 0;
|
|
}
|
|
|
|
u32_t frclock_64_to_micros(u64_t tsc)
|
|
{
|
|
return (u32_t) tsc / (calib_hz / MICROHZ);
|
|
}
|
|
|
|
void
|
|
read_frclock(u32_t *frclk)
|
|
{
|
|
extern struct minix_kerninfo *_minix_kerninfo;
|
|
volatile u32_t *frclock;
|
|
|
|
assert(frclk);
|
|
frclock = (u32_t *)((u8_t *) _minix_kerninfo->minix_frclock+OMAP3_TCRR);
|
|
*frclk = *frclock;
|
|
}
|
|
|
|
u32_t
|
|
delta_frclock(u32_t base, u32_t cur)
|
|
{
|
|
u32_t delta;
|
|
|
|
if (cur < base) {
|
|
/* We have wrapped around, so delta is base to wrapping point
|
|
* plus starting point (0) to cur. This supports wrapping once
|
|
* only. */
|
|
delta = (UINT_MAX - base) + cur;
|
|
} else {
|
|
delta = cur - base;
|
|
}
|
|
|
|
return delta;
|
|
}
|
|
|
|
void
|
|
read_frclock_64(u64_t *frclk)
|
|
{
|
|
read_frclock((u32_t *) frclk);
|
|
}
|
|
|
|
u64_t
|
|
delta_frclock_64(u64_t base, u64_t cur)
|
|
{
|
|
return (u64_t) delta_frclock((u32_t) base, (u32_t) cur);
|
|
}
|
|
|