arch/microblaze/cpu/timer.c

   1 /*
   2  * (C) Copyright 2007 Michal Simek
   3  *
   4  * Michal  SIMEK <monstr@monstr.eu>
   5  *
   6  * See file CREDITS for list of people who contributed to this
   7  * project.
   8  *
   9  * This program is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU General Public License as
  11  * published by the Free Software Foundation; either version 2 of
  12  * the License, or (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22  * MA 02111-1307 USA
  23  */
  24
  25 #include <common.h>
  26 #include <asm/microblaze_timer.h>
  27 #include <asm/microblaze_intc.h>
  28
  29 volatile int timestamp = 0;
  30 microblaze_timer_t *tmr;
  31
  32 ulong get_timer (ulong base)
  33 {
  34         if (tmr)
  35                 return timestamp - base;
  36         return timestamp++ - base;
  37 }
  38
  39 void __udelay(unsigned long usec)
  40 {
  41         u32 i;
  42
  43         if (tmr) {
  44                 i = get_timer(0);
  45                 while ((get_timer(0) - i) < (usec / 1000))
  46                         ;
  47         } else {
  48                 for (i = 0; i < (usec * XILINX_CLOCK_FREQ / 10000000); i++)
  49                         ;
  50         }
  51 }
  52
  53 static void timer_isr(void *arg)
  54 {
  55         timestamp++;
  56         tmr->control = tmr->control | TIMER_INTERRUPT;
  57 }
  58
  59 int timer_init (void)
  60 {
  61         int irq = -1;
  62         u32 preload = 0;
  63         u32 ret = 0;
  64
  65 #if defined(CONFIG_SYS_TIMER_0_ADDR) && defined(CONFIG_SYS_INTC_0_NUM)
  66         preload = XILINX_CLOCK_FREQ / CONFIG_SYS_HZ;
  67         irq = CONFIG_SYS_TIMER_0_IRQ;
  68         tmr = (microblaze_timer_t *) (CONFIG_SYS_TIMER_0_ADDR);
  69 #endif
  70
  71         if (tmr && preload && irq >= 0) {
  72                 tmr->loadreg = preload;
  73                 tmr->control = TIMER_INTERRUPT | TIMER_RESET;
  74                 tmr->control = TIMER_ENABLE | TIMER_ENABLE_INTR |\
  75                                         TIMER_RELOAD | TIMER_DOWN_COUNT;
  76                 timestamp = 0;
  77                 ret = install_interrupt_handler (irq, timer_isr, (void *)tmr);
  78                 if (ret)
  79                         tmr = NULL;
  80         }
  81
  82         /* No problem if timer is not found/initialized */
  83         return 0;
  84 }
  85
  86 /*
  87  * This function is derived from PowerPC code (read timebase as long long).
  88  * On Microblaze it just returns the timer value.
  89  */
  90 unsigned long long get_ticks(void)
  91 {
  92         return get_timer(0);
  93 }
  94
  95 /*
  96  * This function is derived from PowerPC code (timebase clock frequency).
  97  * On Microblaze it returns the number of timer ticks per second.
  98  */
  99 ulong get_tbclk(void)
 100 {
 101         return CONFIG_SYS_HZ;
 102 }