]>
Commit | Line | Data |
---|---|---|
0b135cfc | 1 | /* |
e9d5f354 NI |
2 | * (C) Copyright 2007-2008 |
3 | * Nobobuhiro Iwamatsu <iwamatsu@nigauri.org> | |
4 | * | |
5 | * (C) Copyright 2003 | |
6 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
0b135cfc NI |
7 | * |
8 | * See file CREDITS for list of people who contributed to this | |
9 | * project. | |
10 | * | |
11 | * This program is free software; you can redistribute it and/or | |
12 | * modify it under the terms of the GNU General Public License as | |
13 | * published by the Free Software Foundation; either version 2 of | |
14 | * the License, or (at your option) any later version. | |
15 | * | |
16 | * This program is distributed in the hope that it will be useful, | |
17 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
19 | * GNU General Public License for more details. | |
20 | * | |
21 | * You should have received a copy of the GNU General Public License | |
22 | * along with this program; if not, write to the Free Software | |
23 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
24 | * MA 02111-1307 USA | |
25 | */ | |
26 | ||
27 | #include <common.h> | |
9e23fe05 | 28 | #include <asm/processor.h> |
e9d5f354 NI |
29 | #include <asm/io.h> |
30 | ||
31 | #define TMU_MAX_COUNTER (~0UL) | |
32 | static int clk_adj = 1; | |
0b135cfc NI |
33 | |
34 | static void tmu_timer_start (unsigned int timer) | |
35 | { | |
36 | if (timer > 2) | |
37 | return; | |
e9d5f354 NI |
38 | writeb(readb(TSTR) | (1 << timer), TSTR); |
39 | } | |
0b135cfc | 40 | |
e9d5f354 NI |
41 | static void tmu_timer_stop (unsigned int timer) |
42 | { | |
43 | if (timer > 2) | |
44 | return; | |
45 | writeb(readb(TSTR) & ~(1 << timer), TSTR); | |
0b135cfc NI |
46 | } |
47 | ||
48 | int timer_init (void) | |
49 | { | |
e9d5f354 NI |
50 | /* Divide clock by TMU_CLK_DIVIDER */ |
51 | u16 bit = 0; | |
1e15ff99 JCPV |
52 | |
53 | switch (TMU_CLK_DIVIDER) { | |
54 | case 1024: | |
55 | bit = 4; | |
e9d5f354 NI |
56 | break; |
57 | case 256: | |
58 | bit = 3; | |
59 | break; | |
1e15ff99 JCPV |
60 | case 64: |
61 | bit = 2; | |
e9d5f354 | 62 | break; |
1e15ff99 JCPV |
63 | case 16: |
64 | bit = 1; | |
65 | break; | |
66 | case 4: | |
e9d5f354 NI |
67 | default: |
68 | bit = 0; | |
69 | break; | |
70 | } | |
71 | writew(readw(TCR0) | bit, TCR0); | |
72 | ||
73 | /* Clock adjustment calc */ | |
1e15ff99 | 74 | clk_adj = (int)(1.0 / ((1.0 / CONFIG_SYS_HZ) * 1000000)); |
e9d5f354 NI |
75 | if (clk_adj < 1) |
76 | clk_adj = 1; | |
77 | ||
78 | tmu_timer_stop(0); | |
79 | tmu_timer_start(0); | |
0b135cfc | 80 | |
0b135cfc NI |
81 | return 0; |
82 | } | |
83 | ||
84 | unsigned long long get_ticks (void) | |
85 | { | |
e9d5f354 | 86 | return 0 - readl(TCNT0); |
0b135cfc NI |
87 | } |
88 | ||
e9d5f354 | 89 | static unsigned long get_usec (void) |
0b135cfc | 90 | { |
e9d5f354 | 91 | return (0 - readl(TCNT0)); |
0b135cfc NI |
92 | } |
93 | ||
e9d5f354 | 94 | void udelay (unsigned long usec) |
0b135cfc | 95 | { |
e9d5f354 NI |
96 | unsigned int start = get_usec(); |
97 | unsigned int end = start + (usec * clk_adj); | |
98 | ||
99 | while (get_usec() < end) | |
100 | continue; | |
0b135cfc NI |
101 | } |
102 | ||
e9d5f354 | 103 | unsigned long get_timer (unsigned long base) |
0b135cfc | 104 | { |
1e15ff99 JCPV |
105 | /* return msec */ |
106 | return ((get_usec() / clk_adj) / 1000) - base; | |
0b135cfc NI |
107 | } |
108 | ||
e9d5f354 | 109 | void set_timer (unsigned long t) |
0b135cfc | 110 | { |
e9d5f354 NI |
111 | writel((0 - t), TCNT0); |
112 | } | |
0b135cfc | 113 | |
e9d5f354 NI |
114 | void reset_timer (void) |
115 | { | |
116 | tmu_timer_stop(0); | |
117 | set_timer (0); | |
118 | tmu_timer_start(0); | |
0b135cfc NI |
119 | } |
120 | ||
121 | unsigned long get_tbclk (void) | |
122 | { | |
6d0f6bcf | 123 | return CONFIG_SYS_HZ; |
0b135cfc | 124 | } |