]>
Commit | Line | Data |
---|---|---|
52f69f81 VZ |
1 | /* |
2 | * Copyright (C) 2011 Vladimir Zapolskiy <[email protected]> | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License | |
6 | * as published by the Free Software Foundation; either version 2 | |
7 | * of the License, or (at your option) any later version. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 | * GNU General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License | |
15 | * along with this program; if not, write to the Free Software | |
16 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | |
17 | * MA 02110-1301, USA. | |
18 | */ | |
19 | ||
20 | #include <common.h> | |
21 | #include <asm/arch/cpu.h> | |
22 | #include <asm/arch/clk.h> | |
23 | #include <asm/arch/timer.h> | |
24 | #include <asm/io.h> | |
25 | ||
26 | static struct timer_regs *timer0 = (struct timer_regs *)TIMER0_BASE; | |
27 | static struct timer_regs *timer1 = (struct timer_regs *)TIMER1_BASE; | |
28 | static struct clk_pm_regs *clk = (struct clk_pm_regs *)CLK_PM_BASE; | |
29 | ||
30 | static void lpc32xx_timer_clock(u32 bit, int enable) | |
31 | { | |
32 | if (enable) | |
33 | setbits_le32(&clk->timclk_ctrl1, bit); | |
34 | else | |
35 | clrbits_le32(&clk->timclk_ctrl1, bit); | |
36 | } | |
37 | ||
38 | static void lpc32xx_timer_reset(struct timer_regs *timer, u32 freq) | |
39 | { | |
40 | writel(TIMER_TCR_COUNTER_RESET, &timer->tcr); | |
41 | writel(TIMER_TCR_COUNTER_DISABLE, &timer->tcr); | |
42 | writel(0, &timer->tc); | |
43 | writel(0, &timer->pr); | |
44 | ||
45 | /* Count mode is every rising PCLK edge */ | |
46 | writel(TIMER_CTCR_MODE_TIMER, &timer->ctcr); | |
47 | ||
48 | /* Set prescale counter value */ | |
49 | writel((get_periph_clk_rate() / freq) - 1, &timer->pr); | |
50 | } | |
51 | ||
52 | static void lpc32xx_timer_count(struct timer_regs *timer, int enable) | |
53 | { | |
54 | if (enable) | |
55 | writel(TIMER_TCR_COUNTER_ENABLE, &timer->tcr); | |
56 | else | |
57 | writel(TIMER_TCR_COUNTER_DISABLE, &timer->tcr); | |
58 | } | |
59 | ||
60 | int timer_init(void) | |
61 | { | |
62 | lpc32xx_timer_clock(CLK_TIMCLK_TIMER0, 1); | |
63 | lpc32xx_timer_reset(timer0, CONFIG_SYS_HZ); | |
64 | lpc32xx_timer_count(timer0, 1); | |
65 | ||
66 | return 0; | |
67 | } | |
68 | ||
69 | ulong get_timer(ulong base) | |
70 | { | |
71 | return readl(&timer0->tc) - base; | |
72 | } | |
73 | ||
74 | void __udelay(unsigned long usec) | |
75 | { | |
76 | lpc32xx_timer_clock(CLK_TIMCLK_TIMER1, 1); | |
77 | lpc32xx_timer_reset(timer1, CONFIG_SYS_HZ * 1000); | |
78 | lpc32xx_timer_count(timer1, 1); | |
79 | ||
80 | while (readl(&timer1->tc) < usec) | |
81 | /* NOP */; | |
82 | ||
83 | lpc32xx_timer_count(timer1, 0); | |
84 | lpc32xx_timer_clock(CLK_TIMCLK_TIMER1, 0); | |
85 | } | |
86 | ||
87 | unsigned long long get_ticks(void) | |
88 | { | |
89 | return get_timer(0); | |
90 | } | |
91 | ||
92 | ulong get_tbclk(void) | |
93 | { | |
94 | return CONFIG_SYS_HZ; | |
95 | } |