microblaze: Read information about timer/interrupts from DT

[people/ms/u-boot.git] / arch / microblaze / cpu / timer.c

diff --git a/arch/microblaze/cpu/timer.c b/arch/microblaze/cpu/timer.c
index 3960bbb08a84a3003255972937bbaf05e1e24d1b..c0fc7c0f3ca189cabfd2ff378a824d40e71cdd3a 100644 (file)
--- a/arch/microblaze/cpu/timer.c
+++ b/arch/microblaze/cpu/timer.c
@@ -7,9 +7,12 @@
  */
 
 #include <common.h>
+#include <fdtdec.h>
 #include <asm/microblaze_timer.h>
 #include <asm/microblaze_intc.h>
 
+DECLARE_GLOBAL_DATA_PTR;
+
 volatile int timestamp = 0;
 microblaze_timer_t *tmr;
 
@@ -29,8 +32,10 @@ void __udelay(unsigned long usec)
                while ((get_timer(0) - i) < (usec / 1000))
                        ;
        } else {
+#ifndef CONFIG_OF_CONTROL
                for (i = 0; i < (usec * XILINX_CLOCK_FREQ / 10000000); i++)
                        ;
+#endif
        }
 }
 
@@ -47,12 +52,44 @@ int timer_init (void)
        u32 preload = 0;
        u32 ret = 0;
 
+#ifdef CONFIG_OF_CONTROL
+       const void *blob = gd->fdt_blob;
+       int node = 0;
+       u32 cell[2];
+
+       debug("TIMER: Initialization\n");
+
+       node = fdt_node_offset_by_compatible(blob, node,
+                               "xlnx,xps-timer-1.00.a");
+       if (node != -1) {
+               fdt_addr_t base = fdtdec_get_addr(blob, node, "reg");
+               if (base == FDT_ADDR_T_NONE)
+                       return -1;
+
+               debug("TIMER: Base addr %lx\n", base);
+               tmr = (microblaze_timer_t *)base;
+
+               ret = fdtdec_get_int_array(blob, node, "interrupts",
+                                           cell, ARRAY_SIZE(cell));
+               if (ret)
+                       return ret;
+
+               irq = cell[0];
+               debug("TIMER: IRQ %x\n", irq);
+
+               preload = fdtdec_get_int(blob, node, "clock-frequency", 0);
+               preload /= CONFIG_SYS_HZ;
+       } else {
+               return node;
+       }
+
+#else
 #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
-
+#endif
        if (tmr && preload && irq >= 0) {
                tmr->loadreg = preload;
                tmr->control = TIMER_INTERRUPT | TIMER_RESET;