1 /* 2 * (C) Copyright 2007 Michal Simek 3 * 4 * Michal SIMEK <monstr@monstr.eu> 5 * 6 * SPDX-License-Identifier: GPL-2.0+ 7 */ 8 9 #include <common.h> 10 #include <asm/microblaze_timer.h> 11 #include <asm/microblaze_intc.h> 12 13 volatile int timestamp = 0; 14 microblaze_timer_t *tmr; 15 16 ulong get_timer (ulong base) 17 { 18 if (tmr) 19 return timestamp - base; 20 return timestamp++ - base; 21 } 22 23 void __udelay(unsigned long usec) 24 { 25 u32 i; 26 27 if (tmr) { 28 i = get_timer(0); 29 while ((get_timer(0) - i) < (usec / 1000)) 30 ; 31 } else { 32 for (i = 0; i < (usec * XILINX_CLOCK_FREQ / 10000000); i++) 33 ; 34 } 35 } 36 37 #ifndef CONFIG_SPL_BUILD 38 static void timer_isr(void *arg) 39 { 40 timestamp++; 41 tmr->control = tmr->control | TIMER_INTERRUPT; 42 } 43 44 int timer_init (void) 45 { 46 int irq = -1; 47 u32 preload = 0; 48 u32 ret = 0; 49 50 #if defined(CONFIG_SYS_TIMER_0_ADDR) && defined(CONFIG_SYS_INTC_0_NUM) 51 preload = XILINX_CLOCK_FREQ / CONFIG_SYS_HZ; 52 irq = CONFIG_SYS_TIMER_0_IRQ; 53 tmr = (microblaze_timer_t *) (CONFIG_SYS_TIMER_0_ADDR); 54 #endif 55 56 if (tmr && preload && irq >= 0) { 57 tmr->loadreg = preload; 58 tmr->control = TIMER_INTERRUPT | TIMER_RESET; 59 tmr->control = TIMER_ENABLE | TIMER_ENABLE_INTR |\ 60 TIMER_RELOAD | TIMER_DOWN_COUNT; 61 timestamp = 0; 62 ret = install_interrupt_handler (irq, timer_isr, (void *)tmr); 63 if (ret) 64 tmr = NULL; 65 } 66 /* No problem if timer is not found/initialized */ 67 return 0; 68 } 69 #else 70 int timer_init(void) 71 { 72 return 0; 73 } 74 #endif 75 76 /* 77 * This function is derived from PowerPC code (read timebase as long long). 78 * On Microblaze it just returns the timer value. 79 */ 80 unsigned long long get_ticks(void) 81 { 82 return get_timer(0); 83 } 84 85 /* 86 * This function is derived from PowerPC code (timebase clock frequency). 87 * On Microblaze it returns the number of timer ticks per second. 88 */ 89 ulong get_tbclk(void) 90 { 91 return CONFIG_SYS_HZ; 92 } 93