1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * (C) Copyright 2007 Michal Simek
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * Michal SIMEK <monstr@monstr.eu>
5*4882a593Smuzhiyun *
6*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
7*4882a593Smuzhiyun */
8*4882a593Smuzhiyun
9*4882a593Smuzhiyun #include <common.h>
10*4882a593Smuzhiyun #include <fdtdec.h>
11*4882a593Smuzhiyun #include <asm/microblaze_timer.h>
12*4882a593Smuzhiyun #include <asm/microblaze_intc.h>
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun DECLARE_GLOBAL_DATA_PTR;
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun volatile int timestamp = 0;
17*4882a593Smuzhiyun microblaze_timer_t *tmr;
18*4882a593Smuzhiyun
get_timer(ulong base)19*4882a593Smuzhiyun ulong get_timer (ulong base)
20*4882a593Smuzhiyun {
21*4882a593Smuzhiyun if (tmr)
22*4882a593Smuzhiyun return timestamp - base;
23*4882a593Smuzhiyun return timestamp++ - base;
24*4882a593Smuzhiyun }
25*4882a593Smuzhiyun
__udelay(unsigned long usec)26*4882a593Smuzhiyun void __udelay(unsigned long usec)
27*4882a593Smuzhiyun {
28*4882a593Smuzhiyun u32 i;
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun if (tmr) {
31*4882a593Smuzhiyun i = get_timer(0);
32*4882a593Smuzhiyun while ((get_timer(0) - i) < (usec / 1000))
33*4882a593Smuzhiyun ;
34*4882a593Smuzhiyun }
35*4882a593Smuzhiyun }
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun #ifndef CONFIG_SPL_BUILD
timer_isr(void * arg)38*4882a593Smuzhiyun static void timer_isr(void *arg)
39*4882a593Smuzhiyun {
40*4882a593Smuzhiyun timestamp++;
41*4882a593Smuzhiyun tmr->control = tmr->control | TIMER_INTERRUPT;
42*4882a593Smuzhiyun }
43*4882a593Smuzhiyun
timer_init(void)44*4882a593Smuzhiyun int timer_init (void)
45*4882a593Smuzhiyun {
46*4882a593Smuzhiyun int irq = -1;
47*4882a593Smuzhiyun u32 preload = 0;
48*4882a593Smuzhiyun u32 ret = 0;
49*4882a593Smuzhiyun const void *blob = gd->fdt_blob;
50*4882a593Smuzhiyun int node = 0;
51*4882a593Smuzhiyun u32 cell[2];
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun debug("TIMER: Initialization\n");
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun node = fdt_node_offset_by_compatible(blob, node,
56*4882a593Smuzhiyun "xlnx,xps-timer-1.00.a");
57*4882a593Smuzhiyun if (node != -1) {
58*4882a593Smuzhiyun fdt_addr_t base = fdtdec_get_addr(blob, node, "reg");
59*4882a593Smuzhiyun if (base == FDT_ADDR_T_NONE)
60*4882a593Smuzhiyun return -1;
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun debug("TIMER: Base addr %lx\n", base);
63*4882a593Smuzhiyun tmr = (microblaze_timer_t *)base;
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun ret = fdtdec_get_int_array(blob, node, "interrupts",
66*4882a593Smuzhiyun cell, ARRAY_SIZE(cell));
67*4882a593Smuzhiyun if (ret)
68*4882a593Smuzhiyun return ret;
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun irq = cell[0];
71*4882a593Smuzhiyun debug("TIMER: IRQ %x\n", irq);
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun preload = fdtdec_get_int(blob, node, "clock-frequency", 0);
74*4882a593Smuzhiyun preload /= CONFIG_SYS_HZ;
75*4882a593Smuzhiyun } else {
76*4882a593Smuzhiyun return node;
77*4882a593Smuzhiyun }
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun if (tmr && preload && irq >= 0) {
80*4882a593Smuzhiyun tmr->loadreg = preload;
81*4882a593Smuzhiyun tmr->control = TIMER_INTERRUPT | TIMER_RESET;
82*4882a593Smuzhiyun tmr->control = TIMER_ENABLE | TIMER_ENABLE_INTR |\
83*4882a593Smuzhiyun TIMER_RELOAD | TIMER_DOWN_COUNT;
84*4882a593Smuzhiyun timestamp = 0;
85*4882a593Smuzhiyun ret = install_interrupt_handler (irq, timer_isr, (void *)tmr);
86*4882a593Smuzhiyun if (ret)
87*4882a593Smuzhiyun tmr = NULL;
88*4882a593Smuzhiyun }
89*4882a593Smuzhiyun /* No problem if timer is not found/initialized */
90*4882a593Smuzhiyun return 0;
91*4882a593Smuzhiyun }
92*4882a593Smuzhiyun #else
timer_init(void)93*4882a593Smuzhiyun int timer_init(void)
94*4882a593Smuzhiyun {
95*4882a593Smuzhiyun return 0;
96*4882a593Smuzhiyun }
97*4882a593Smuzhiyun #endif
98*4882a593Smuzhiyun
99*4882a593Smuzhiyun /*
100*4882a593Smuzhiyun * This function is derived from PowerPC code (read timebase as long long).
101*4882a593Smuzhiyun * On Microblaze it just returns the timer value.
102*4882a593Smuzhiyun */
get_ticks(void)103*4882a593Smuzhiyun unsigned long long get_ticks(void)
104*4882a593Smuzhiyun {
105*4882a593Smuzhiyun return get_timer(0);
106*4882a593Smuzhiyun }
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun /*
109*4882a593Smuzhiyun * This function is derived from PowerPC code (timebase clock frequency).
110*4882a593Smuzhiyun * On Microblaze it returns the number of timer ticks per second.
111*4882a593Smuzhiyun */
get_tbclk(void)112*4882a593Smuzhiyun ulong get_tbclk(void)
113*4882a593Smuzhiyun {
114*4882a593Smuzhiyun return CONFIG_SYS_HZ;
115*4882a593Smuzhiyun }
116