16260fb04SPeter Tyser /* 26260fb04SPeter Tyser * (C) Copyright 2007 Michal Simek 36260fb04SPeter Tyser * 46260fb04SPeter Tyser * Michal SIMEK <monstr@monstr.eu> 56260fb04SPeter Tyser * 6*1a459660SWolfgang Denk * SPDX-License-Identifier: GPL-2.0+ 76260fb04SPeter Tyser */ 86260fb04SPeter Tyser 96260fb04SPeter Tyser #include <common.h> 106260fb04SPeter Tyser #include <asm/microblaze_timer.h> 116260fb04SPeter Tyser #include <asm/microblaze_intc.h> 126260fb04SPeter Tyser 136260fb04SPeter Tyser volatile int timestamp = 0; 14bcbb046bSMichal Simek microblaze_timer_t *tmr; 156260fb04SPeter Tyser 166260fb04SPeter Tyser ulong get_timer (ulong base) 176260fb04SPeter Tyser { 18bcbb046bSMichal Simek if (tmr) 19bcbb046bSMichal Simek return timestamp - base; 20bcbb046bSMichal Simek return timestamp++ - base; 216260fb04SPeter Tyser } 226260fb04SPeter Tyser 23779bf42cSMichal Simek void __udelay(unsigned long usec) 24779bf42cSMichal Simek { 25bcbb046bSMichal Simek u32 i; 26779bf42cSMichal Simek 27bcbb046bSMichal Simek if (tmr) { 28779bf42cSMichal Simek i = get_timer(0); 29779bf42cSMichal Simek while ((get_timer(0) - i) < (usec / 1000)) 30779bf42cSMichal Simek ; 31bcbb046bSMichal Simek } else { 32bcbb046bSMichal Simek for (i = 0; i < (usec * XILINX_CLOCK_FREQ / 10000000); i++) 33779bf42cSMichal Simek ; 34779bf42cSMichal Simek } 35bcbb046bSMichal Simek } 36779bf42cSMichal Simek 37bcbb046bSMichal Simek static void timer_isr(void *arg) 386260fb04SPeter Tyser { 396260fb04SPeter Tyser timestamp++; 406260fb04SPeter Tyser tmr->control = tmr->control | TIMER_INTERRUPT; 416260fb04SPeter Tyser } 426260fb04SPeter Tyser 435bbcb6cfSMichal Simek int timer_init (void) 446260fb04SPeter Tyser { 45bcbb046bSMichal Simek int irq = -1; 46bcbb046bSMichal Simek u32 preload = 0; 47bcbb046bSMichal Simek u32 ret = 0; 48bcbb046bSMichal Simek 49bcbb046bSMichal Simek #if defined(CONFIG_SYS_TIMER_0_ADDR) && defined(CONFIG_SYS_INTC_0_NUM) 50bcbb046bSMichal Simek preload = XILINX_CLOCK_FREQ / CONFIG_SYS_HZ; 51bcbb046bSMichal Simek irq = CONFIG_SYS_TIMER_0_IRQ; 52bcbb046bSMichal Simek tmr = (microblaze_timer_t *) (CONFIG_SYS_TIMER_0_ADDR); 53bcbb046bSMichal Simek #endif 54bcbb046bSMichal Simek 55bcbb046bSMichal Simek if (tmr && preload && irq >= 0) { 56bcbb046bSMichal Simek tmr->loadreg = preload; 576260fb04SPeter Tyser tmr->control = TIMER_INTERRUPT | TIMER_RESET; 58bcbb046bSMichal Simek tmr->control = TIMER_ENABLE | TIMER_ENABLE_INTR |\ 59bcbb046bSMichal Simek TIMER_RELOAD | TIMER_DOWN_COUNT; 604769be21SGraeme Russ timestamp = 0; 61bcbb046bSMichal Simek ret = install_interrupt_handler (irq, timer_isr, (void *)tmr); 62bcbb046bSMichal Simek if (ret) 63bcbb046bSMichal Simek tmr = NULL; 64bcbb046bSMichal Simek } 65bcbb046bSMichal Simek 66bcbb046bSMichal Simek /* No problem if timer is not found/initialized */ 675bbcb6cfSMichal Simek return 0; 686260fb04SPeter Tyser } 69b9f0b730SStephan Linz 70b9f0b730SStephan Linz /* 71b9f0b730SStephan Linz * This function is derived from PowerPC code (read timebase as long long). 72b9f0b730SStephan Linz * On Microblaze it just returns the timer value. 73b9f0b730SStephan Linz */ 74b9f0b730SStephan Linz unsigned long long get_ticks(void) 75b9f0b730SStephan Linz { 76b9f0b730SStephan Linz return get_timer(0); 77b9f0b730SStephan Linz } 78b9f0b730SStephan Linz 79b9f0b730SStephan Linz /* 80b9f0b730SStephan Linz * This function is derived from PowerPC code (timebase clock frequency). 81b9f0b730SStephan Linz * On Microblaze it returns the number of timer ticks per second. 82b9f0b730SStephan Linz */ 83b9f0b730SStephan Linz ulong get_tbclk(void) 84b9f0b730SStephan Linz { 85b9f0b730SStephan Linz return CONFIG_SYS_HZ; 86b9f0b730SStephan Linz } 87