]>
Commit | Line | Data |
---|---|---|
83d290c5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
3eb90bad IL |
2 | /* |
3 | * (C) Copyright 2000-2009 | |
4 | * Wolfgang Denk, DENX Software Engineering, [email protected]. | |
3eb90bad IL |
5 | */ |
6 | ||
7 | #include <common.h> | |
c8a7ba9e TC |
8 | #include <dm.h> |
9 | #include <errno.h> | |
10 | #include <timer.h> | |
3eb90bad | 11 | #include <watchdog.h> |
8dfafdde RH |
12 | #include <div64.h> |
13 | #include <asm/io.h> | |
3eb90bad IL |
14 | |
15 | #ifndef CONFIG_WD_PERIOD | |
fccacd3b | 16 | # define CONFIG_WD_PERIOD (10 * 1000 * 1000) /* 10 seconds default */ |
3eb90bad IL |
17 | #endif |
18 | ||
8dfafdde RH |
19 | DECLARE_GLOBAL_DATA_PTR; |
20 | ||
21 | #ifdef CONFIG_SYS_TIMER_RATE | |
fccacd3b | 22 | /* Returns tick rate in ticks per second */ |
8dfafdde RH |
23 | ulong notrace get_tbclk(void) |
24 | { | |
25 | return CONFIG_SYS_TIMER_RATE; | |
26 | } | |
27 | #endif | |
28 | ||
29 | #ifdef CONFIG_SYS_TIMER_COUNTER | |
30 | unsigned long notrace timer_read_counter(void) | |
31 | { | |
32 | #ifdef CONFIG_SYS_TIMER_COUNTS_DOWN | |
33 | return ~readl(CONFIG_SYS_TIMER_COUNTER); | |
34 | #else | |
35 | return readl(CONFIG_SYS_TIMER_COUNTER); | |
36 | #endif | |
37 | } | |
9fb34b01 SG |
38 | |
39 | ulong timer_get_boot_us(void) | |
40 | { | |
41 | ulong count = timer_read_counter(); | |
42 | ||
43 | #if CONFIG_SYS_TIMER_RATE == 1000000 | |
44 | return count; | |
45 | #elif CONFIG_SYS_TIMER_RATE > 1000000 | |
46 | return lldiv(count, CONFIG_SYS_TIMER_RATE / 1000000); | |
47 | #elif defined(CONFIG_SYS_TIMER_RATE) | |
48 | return (unsigned long long)count * 1000000 / CONFIG_SYS_TIMER_RATE; | |
49 | #else | |
50 | /* Assume the counter is in microseconds */ | |
51 | return count; | |
52 | #endif | |
53 | } | |
54 | ||
8dfafdde | 55 | #else |
65ba7add | 56 | extern unsigned long __weak timer_read_counter(void); |
8dfafdde RH |
57 | #endif |
58 | ||
f00c2628 | 59 | #if CONFIG_IS_ENABLED(TIMER) |
c8a7ba9e TC |
60 | ulong notrace get_tbclk(void) |
61 | { | |
c95fec31 SG |
62 | if (!gd->timer) { |
63 | #ifdef CONFIG_TIMER_EARLY | |
64 | return timer_early_get_rate(); | |
65 | #else | |
66 | int ret; | |
c8a7ba9e | 67 | |
c95fec31 SG |
68 | ret = dm_timer_init(); |
69 | if (ret) | |
70 | return ret; | |
71 | #endif | |
72 | } | |
c8a7ba9e TC |
73 | |
74 | return timer_get_rate(gd->timer); | |
75 | } | |
76 | ||
9ca07ebb | 77 | uint64_t notrace get_ticks(void) |
c8a7ba9e | 78 | { |
9ca07ebb | 79 | u64 count; |
c8a7ba9e TC |
80 | int ret; |
81 | ||
c95fec31 SG |
82 | if (!gd->timer) { |
83 | #ifdef CONFIG_TIMER_EARLY | |
84 | return timer_early_get_count(); | |
85 | #else | |
86 | int ret; | |
87 | ||
88 | ret = dm_timer_init(); | |
89 | if (ret) | |
90 | return ret; | |
91 | #endif | |
92 | } | |
c8a7ba9e TC |
93 | |
94 | ret = timer_get_count(gd->timer, &count); | |
95 | if (ret) | |
96 | return ret; | |
97 | ||
98 | return count; | |
99 | } | |
9ca07ebb BM |
100 | |
101 | #else /* !CONFIG_TIMER */ | |
c8a7ba9e | 102 | |
19ea4678 | 103 | uint64_t __weak notrace get_ticks(void) |
8dfafdde RH |
104 | { |
105 | unsigned long now = timer_read_counter(); | |
106 | ||
107 | /* increment tbu if tbl has rolled over */ | |
108 | if (now < gd->timebase_l) | |
109 | gd->timebase_h++; | |
110 | gd->timebase_l = now; | |
19ea4678 | 111 | return ((uint64_t)gd->timebase_h << 32) | gd->timebase_l; |
8dfafdde RH |
112 | } |
113 | ||
9ca07ebb BM |
114 | #endif /* CONFIG_TIMER */ |
115 | ||
fccacd3b | 116 | /* Returns time in milliseconds */ |
19ea4678 | 117 | static uint64_t notrace tick_to_time(uint64_t tick) |
8dfafdde | 118 | { |
fccacd3b | 119 | ulong div = get_tbclk(); |
8dfafdde RH |
120 | |
121 | tick *= CONFIG_SYS_HZ; | |
122 | do_div(tick, div); | |
123 | return tick; | |
124 | } | |
125 | ||
de351d6b DR |
126 | int __weak timer_init(void) |
127 | { | |
128 | return 0; | |
129 | } | |
130 | ||
fccacd3b | 131 | /* Returns time in milliseconds */ |
8dfafdde RH |
132 | ulong __weak get_timer(ulong base) |
133 | { | |
134 | return tick_to_time(get_ticks()) - base; | |
135 | } | |
136 | ||
80e7e7c2 MV |
137 | static uint64_t notrace tick_to_time_us(uint64_t tick) |
138 | { | |
139 | ulong div = get_tbclk() / 1000; | |
140 | ||
141 | tick *= CONFIG_SYS_HZ; | |
142 | do_div(tick, div); | |
143 | return tick; | |
144 | } | |
145 | ||
146 | uint64_t __weak get_timer_us(uint64_t base) | |
147 | { | |
148 | return tick_to_time_us(get_ticks()) - base; | |
149 | } | |
150 | ||
8dfafdde RH |
151 | unsigned long __weak notrace timer_get_us(void) |
152 | { | |
153 | return tick_to_time(get_ticks() * 1000); | |
154 | } | |
fccacd3b | 155 | |
6a853dbc | 156 | uint64_t usec_to_tick(unsigned long usec) |
8dfafdde | 157 | { |
19ea4678 | 158 | uint64_t tick = usec; |
2cd1b572 | 159 | tick *= get_tbclk(); |
8dfafdde RH |
160 | do_div(tick, 1000000); |
161 | return tick; | |
162 | } | |
163 | ||
164 | void __weak __udelay(unsigned long usec) | |
165 | { | |
19ea4678 | 166 | uint64_t tmp; |
8dfafdde | 167 | |
fccacd3b | 168 | tmp = get_ticks() + usec_to_tick(usec); /* get current timestamp */ |
8dfafdde | 169 | |
fccacd3b | 170 | while (get_ticks() < tmp+1) /* loop till event */ |
8dfafdde RH |
171 | /*NOP*/; |
172 | } | |
173 | ||
3eb90bad IL |
174 | /* ------------------------------------------------------------------------- */ |
175 | ||
176 | void udelay(unsigned long usec) | |
177 | { | |
178 | ulong kv; | |
179 | ||
180 | do { | |
181 | WATCHDOG_RESET(); | |
182 | kv = usec > CONFIG_WD_PERIOD ? CONFIG_WD_PERIOD : usec; | |
183 | __udelay (kv); | |
184 | usec -= kv; | |
185 | } while(usec); | |
186 | } |