1
2
3
4
5
6#include <common.h>
7#include <init.h>
8#include <time.h>
9#include <asm/arch/cpu.h>
10#include <asm/arch/clk.h>
11#include <asm/arch/timer.h>
12#include <asm/io.h>
13#include <linux/delay.h>
14
15static struct timer_regs *timer0 = (struct timer_regs *)TIMER0_BASE;
16static struct timer_regs *timer1 = (struct timer_regs *)TIMER1_BASE;
17static struct clk_pm_regs *clk = (struct clk_pm_regs *)CLK_PM_BASE;
18
19static void lpc32xx_timer_clock(u32 bit, int enable)
20{
21 if (enable)
22 setbits_le32(&clk->timclk_ctrl1, bit);
23 else
24 clrbits_le32(&clk->timclk_ctrl1, bit);
25}
26
27static void lpc32xx_timer_reset(struct timer_regs *timer, u32 freq)
28{
29 writel(TIMER_TCR_COUNTER_RESET, &timer->tcr);
30 writel(TIMER_TCR_COUNTER_DISABLE, &timer->tcr);
31 writel(0, &timer->tc);
32 writel(0, &timer->pr);
33
34
35 writel(TIMER_CTCR_MODE_TIMER, &timer->ctcr);
36
37
38 writel((get_periph_clk_rate() / freq) - 1, &timer->pr);
39
40
41 writel(0, &timer->mcr);
42}
43
44static void lpc32xx_timer_count(struct timer_regs *timer, int enable)
45{
46 if (enable)
47 writel(TIMER_TCR_COUNTER_ENABLE, &timer->tcr);
48 else
49 writel(TIMER_TCR_COUNTER_DISABLE, &timer->tcr);
50}
51
52int timer_init(void)
53{
54 lpc32xx_timer_clock(CLK_TIMCLK_TIMER0, 1);
55 lpc32xx_timer_reset(timer0, CONFIG_SYS_HZ);
56 lpc32xx_timer_count(timer0, 1);
57
58 return 0;
59}
60
61ulong get_timer(ulong base)
62{
63 return readl(&timer0->tc) - base;
64}
65
66void __udelay(unsigned long usec)
67{
68 lpc32xx_timer_clock(CLK_TIMCLK_TIMER1, 1);
69 lpc32xx_timer_reset(timer1, CONFIG_SYS_HZ * 1000);
70 lpc32xx_timer_count(timer1, 1);
71
72 while (readl(&timer1->tc) < usec)
73 ;
74
75 lpc32xx_timer_count(timer1, 0);
76 lpc32xx_timer_clock(CLK_TIMCLK_TIMER1, 0);
77}
78
79unsigned long long get_ticks(void)
80{
81 return get_timer(0);
82}
83
84ulong get_tbclk(void)
85{
86 return CONFIG_SYS_HZ;
87}
88