]> git.sur5r.net Git - u-boot/blob - arch/microblaze/cpu/timer.c
microblaze: Move __udelay implementation
[u-boot] / 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
31 #ifdef CONFIG_SYS_TIMER_0
32 ulong get_timer (ulong base)
33 {
34         return (timestamp - base);
35 }
36 #else
37 ulong get_timer (ulong base)
38 {
39         return (timestamp++ - base);
40 }
41 #endif
42
43 #ifdef CONFIG_SYS_INTC_0
44 #ifdef CONFIG_SYS_TIMER_0
45 void __udelay(unsigned long usec)
46 {
47         int i;
48
49         i = get_timer(0);
50         while ((get_timer(0) - i) < (usec / 1000))
51                 ;
52 }
53 #else
54 void __udelay(unsigned long usec)
55 {
56         unsigned int i;
57
58         for (i = 0; i < (usec * CONFIG_XILINX_CLOCK_FREQ / 10000000); i++)
59                 ;
60 }
61 #endif
62
63 #ifdef CONFIG_SYS_TIMER_0
64 microblaze_timer_t *tmr = (microblaze_timer_t *) (CONFIG_SYS_TIMER_0_ADDR);
65
66 void timer_isr (void *arg)
67 {
68         timestamp++;
69         tmr->control = tmr->control | TIMER_INTERRUPT;
70 }
71
72 int timer_init (void)
73 {
74         tmr->loadreg = CONFIG_SYS_TIMER_0_PRELOAD;
75         tmr->control = TIMER_INTERRUPT | TIMER_RESET;
76         tmr->control =
77             TIMER_ENABLE | TIMER_ENABLE_INTR | TIMER_RELOAD | TIMER_DOWN_COUNT;
78         timestamp = 0;
79         install_interrupt_handler (CONFIG_SYS_TIMER_0_IRQ, timer_isr, (void *)tmr);
80         return 0;
81 }
82 #endif
83 #endif
84
85 /*
86  * This function is derived from PowerPC code (read timebase as long long).
87  * On Microblaze it just returns the timer value.
88  */
89 unsigned long long get_ticks(void)
90 {
91         return get_timer(0);
92 }
93
94 /*
95  * This function is derived from PowerPC code (timebase clock frequency).
96  * On Microblaze it returns the number of timer ticks per second.
97  */
98 ulong get_tbclk(void)
99 {
100         return CONFIG_SYS_HZ;
101 }