1
2
3
4
5
6
7
8#include <common.h>
9
10#include <asm/timer.h>
11#include <asm/immap.h>
12#include <asm/io.h>
13
14DECLARE_GLOBAL_DATA_PTR;
15
16static ulong timestamp;
17
18#if defined(CONFIG_SLTTMR)
19#ifndef CONFIG_SYS_UDELAY_BASE
20# error "uDelay base not defined!"
21#endif
22
23#if !defined(CONFIG_SYS_TMR_BASE) || !defined(CONFIG_SYS_INTR_BASE) || !defined(CONFIG_SYS_TMRINTR_NO) || !defined(CONFIG_SYS_TMRINTR_MASK)
24# error "TMR_BASE, INTR_BASE, TMRINTR_NO or TMRINTR_MASk not defined!"
25#endif
26extern void dtimer_intr_setup(void);
27
28void __udelay(unsigned long usec)
29{
30 slt_t *timerp = (slt_t *) (CONFIG_SYS_UDELAY_BASE);
31 u32 now, freq;
32
33
34 freq = CONFIG_SYS_TIMER_PRESCALER;
35
36
37 out_be32(&timerp->cr, 0);
38 out_be32(&timerp->tcnt, usec * freq);
39 out_be32(&timerp->cr, SLT_CR_TEN);
40
41 now = in_be32(&timerp->cnt);
42 while (now != 0)
43 now = in_be32(&timerp->cnt);
44
45 setbits_be32(&timerp->sr, SLT_SR_ST);
46 out_be32(&timerp->cr, 0);
47}
48
49void dtimer_interrupt(void *not_used)
50{
51 slt_t *timerp = (slt_t *) (CONFIG_SYS_TMR_BASE);
52
53
54 if ((CONFIG_SYS_TMRPND_REG & CONFIG_SYS_TMRINTR_MASK) == CONFIG_SYS_TMRINTR_PEND) {
55 setbits_be32(&timerp->sr, SLT_SR_ST);
56 timestamp++;
57 return;
58 }
59}
60
61int timer_init(void)
62{
63 slt_t *timerp = (slt_t *) (CONFIG_SYS_TMR_BASE);
64
65 timestamp = 0;
66
67
68 out_be32(&timerp->cr, 0);
69 out_be32(&timerp->tcnt, 0);
70
71 out_be32(&timerp->sr, SLT_SR_BE | SLT_SR_ST);
72
73
74 irq_install_handler(CONFIG_SYS_TMRINTR_NO, dtimer_interrupt, 0);
75
76
77 out_be32(&timerp->tcnt, 1000 * CONFIG_SYS_TIMER_PRESCALER);
78
79 dtimer_intr_setup();
80
81
82
83 out_be32(&timerp->cr, SLT_CR_RUN | SLT_CR_IEN | SLT_CR_TEN);
84 return 0;
85}
86
87ulong get_timer(ulong base)
88{
89 return (timestamp - base);
90}
91
92#endif
93