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