]>
Commit | Line | Data |
---|---|---|
6ad43d0d NI |
1 | /* |
2 | * Copyright (C) 2007,2008 Nobobuhiro Iwamatsu <iwamatsu@nigauri.org> | |
3 | * Copyright (C) 2008 Renesas Solutions Corp. | |
4 | * | |
5 | * (C) Copyright 2003 | |
6 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
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> | |
28 | #include <asm/io.h> | |
29 | #include <asm/processor.h> | |
30 | ||
85cb052e | 31 | #define CMT_CMCSR_INIT 0x0001 /* PCLK/32 */ |
6ad43d0d NI |
32 | #define CMT_CMCSR_CALIB 0x0000 |
33 | #define CMT_MAX_COUNTER (0xFFFFFFFF) | |
34 | #define CMT_TIMER_RESET (0xFFFF) | |
35 | ||
36 | static vu_long cmt0_timer; | |
37 | ||
38 | static void cmt_timer_start(unsigned int timer) | |
39 | { | |
40 | writew(readw(CMSTR) | 0x01, CMSTR); | |
41 | } | |
42 | ||
43 | static void cmt_timer_stop(unsigned int timer) | |
44 | { | |
45 | writew(readw(CMSTR) & ~0x01, CMSTR); | |
46 | } | |
47 | ||
48 | int timer_init(void) | |
49 | { | |
50 | cmt0_timer = 0; | |
51 | /* Divide clock by 32 */ | |
52 | readw(CMCSR_0); | |
53 | writew(CMT_CMCSR_INIT, CMCSR_0); | |
54 | ||
55 | /* User Device 0 only */ | |
56 | cmt_timer_stop(0); | |
57 | set_timer(CMT_TIMER_RESET); | |
58 | cmt_timer_start(0); | |
59 | ||
60 | return 0; | |
61 | } | |
62 | ||
63 | unsigned long long get_ticks(void) | |
64 | { | |
65 | return cmt0_timer; | |
66 | } | |
67 | ||
d8bbc51c NI |
68 | static vu_long cmcnt = 0; |
69 | static unsigned long get_usec (void) | |
6ad43d0d NI |
70 | { |
71 | ulong data = readw(CMCNT_0); | |
72 | ||
73 | if (data >= cmcnt) | |
74 | cmcnt = data - cmcnt; | |
75 | else | |
76 | cmcnt = (CMT_TIMER_RESET - cmcnt) + data; | |
77 | ||
78 | if ((cmt0_timer + cmcnt) > CMT_MAX_COUNTER) | |
79 | cmt0_timer = ((cmt0_timer + cmcnt) - CMT_MAX_COUNTER); | |
80 | else | |
81 | cmt0_timer += cmcnt; | |
82 | ||
83 | cmcnt = data; | |
d8bbc51c NI |
84 | return cmt0_timer; |
85 | } | |
86 | ||
87 | /* return msec */ | |
88 | ulong get_timer(ulong base) | |
89 | { | |
85cb052e | 90 | return (get_usec() / 1000) - base; |
6ad43d0d NI |
91 | } |
92 | ||
93 | void set_timer(ulong t) | |
94 | { | |
95 | writew((u16) t, CMCOR_0); | |
96 | } | |
97 | ||
98 | void reset_timer(void) | |
99 | { | |
100 | cmt_timer_stop(0); | |
101 | set_timer(CMT_TIMER_RESET); | |
102 | cmt0_timer = 0; | |
103 | cmt_timer_start(0); | |
104 | } | |
105 | ||
106 | void udelay(unsigned long usec) | |
107 | { | |
d8bbc51c | 108 | unsigned long end = get_usec() + usec; |
6ad43d0d | 109 | |
d8bbc51c | 110 | while (get_usec() < end) |
6ad43d0d NI |
111 | continue; |
112 | } | |
113 | ||
114 | unsigned long get_tbclk(void) | |
115 | { | |
6d0f6bcf | 116 | return CONFIG_SYS_HZ; |
6ad43d0d | 117 | } |