93 lines
1.8 KiB
C
93 lines
1.8 KiB
C
/*
|
|
* (C) Copyright 2007 Michal Simek
|
|
*
|
|
* Michal SIMEK <monstr@monstr.eu>
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/microblaze_timer.h>
|
|
#include <asm/microblaze_intc.h>
|
|
|
|
volatile int timestamp = 0;
|
|
microblaze_timer_t *tmr;
|
|
|
|
ulong get_timer (ulong base)
|
|
{
|
|
if (tmr)
|
|
return timestamp - base;
|
|
return timestamp++ - base;
|
|
}
|
|
|
|
void __udelay(unsigned long usec)
|
|
{
|
|
u32 i;
|
|
|
|
if (tmr) {
|
|
i = get_timer(0);
|
|
while ((get_timer(0) - i) < (usec / 1000))
|
|
;
|
|
} else {
|
|
for (i = 0; i < (usec * XILINX_CLOCK_FREQ / 10000000); i++)
|
|
;
|
|
}
|
|
}
|
|
|
|
#ifndef CONFIG_SPL_BUILD
|
|
static void timer_isr(void *arg)
|
|
{
|
|
timestamp++;
|
|
tmr->control = tmr->control | TIMER_INTERRUPT;
|
|
}
|
|
|
|
int timer_init (void)
|
|
{
|
|
int irq = -1;
|
|
u32 preload = 0;
|
|
u32 ret = 0;
|
|
|
|
#if defined(CONFIG_SYS_TIMER_0_ADDR) && defined(CONFIG_SYS_INTC_0_NUM)
|
|
preload = XILINX_CLOCK_FREQ / CONFIG_SYS_HZ;
|
|
irq = CONFIG_SYS_TIMER_0_IRQ;
|
|
tmr = (microblaze_timer_t *) (CONFIG_SYS_TIMER_0_ADDR);
|
|
#endif
|
|
|
|
if (tmr && preload && irq >= 0) {
|
|
tmr->loadreg = preload;
|
|
tmr->control = TIMER_INTERRUPT | TIMER_RESET;
|
|
tmr->control = TIMER_ENABLE | TIMER_ENABLE_INTR |\
|
|
TIMER_RELOAD | TIMER_DOWN_COUNT;
|
|
timestamp = 0;
|
|
ret = install_interrupt_handler (irq, timer_isr, (void *)tmr);
|
|
if (ret)
|
|
tmr = NULL;
|
|
}
|
|
/* No problem if timer is not found/initialized */
|
|
return 0;
|
|
}
|
|
#else
|
|
int timer_init(void)
|
|
{
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* This function is derived from PowerPC code (read timebase as long long).
|
|
* On Microblaze 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 Microblaze it returns the number of timer ticks per second.
|
|
*/
|
|
ulong get_tbclk(void)
|
|
{
|
|
return CONFIG_SYS_HZ;
|
|
}
|