Ingo van Lil | f0f778a | 2009-11-24 14:09:21 +0100 | [diff] [blame] | 1 | /* |
| 2 | * (C) Copyright 2000-2009 |
| 3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
| 4 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 5 | * SPDX-License-Identifier: GPL-2.0+ |
Ingo van Lil | f0f778a | 2009-11-24 14:09:21 +0100 | [diff] [blame] | 6 | */ |
| 7 | |
| 8 | #include <common.h> |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 9 | #include <dm.h> |
| 10 | #include <errno.h> |
| 11 | #include <timer.h> |
Ingo van Lil | f0f778a | 2009-11-24 14:09:21 +0100 | [diff] [blame] | 12 | #include <watchdog.h> |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 13 | #include <div64.h> |
| 14 | #include <asm/io.h> |
Ingo van Lil | f0f778a | 2009-11-24 14:09:21 +0100 | [diff] [blame] | 15 | |
| 16 | #ifndef CONFIG_WD_PERIOD |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 17 | # define CONFIG_WD_PERIOD (10 * 1000 * 1000) /* 10 seconds default */ |
Ingo van Lil | f0f778a | 2009-11-24 14:09:21 +0100 | [diff] [blame] | 18 | #endif |
| 19 | |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 20 | DECLARE_GLOBAL_DATA_PTR; |
| 21 | |
| 22 | #ifdef CONFIG_SYS_TIMER_RATE |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 23 | /* Returns tick rate in ticks per second */ |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 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 | } |
Simon Glass | 037ef5c | 2017-05-22 05:05:22 -0600 | [diff] [blame] | 39 | |
| 40 | ulong timer_get_boot_us(void) |
| 41 | { |
| 42 | ulong count = timer_read_counter(); |
| 43 | |
| 44 | #if CONFIG_SYS_TIMER_RATE == 1000000 |
| 45 | return count; |
| 46 | #elif CONFIG_SYS_TIMER_RATE > 1000000 |
| 47 | return lldiv(count, CONFIG_SYS_TIMER_RATE / 1000000); |
| 48 | #elif defined(CONFIG_SYS_TIMER_RATE) |
| 49 | return (unsigned long long)count * 1000000 / CONFIG_SYS_TIMER_RATE; |
| 50 | #else |
| 51 | /* Assume the counter is in microseconds */ |
| 52 | return count; |
| 53 | #endif |
| 54 | } |
| 55 | |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 56 | #else |
Rob Herring | 316c5c8 | 2013-11-08 08:40:43 -0600 | [diff] [blame] | 57 | extern unsigned long __weak timer_read_counter(void); |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 58 | #endif |
| 59 | |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 60 | #ifdef CONFIG_TIMER |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 61 | ulong notrace get_tbclk(void) |
| 62 | { |
Simon Glass | 32f6c17 | 2016-02-24 09:14:49 -0700 | [diff] [blame] | 63 | if (!gd->timer) { |
| 64 | #ifdef CONFIG_TIMER_EARLY |
| 65 | return timer_early_get_rate(); |
| 66 | #else |
| 67 | int ret; |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 68 | |
Simon Glass | 32f6c17 | 2016-02-24 09:14:49 -0700 | [diff] [blame] | 69 | ret = dm_timer_init(); |
| 70 | if (ret) |
| 71 | return ret; |
| 72 | #endif |
| 73 | } |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 74 | |
| 75 | return timer_get_rate(gd->timer); |
| 76 | } |
| 77 | |
Bin Meng | ab841b6 | 2015-11-24 13:31:17 -0700 | [diff] [blame] | 78 | uint64_t notrace get_ticks(void) |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 79 | { |
Bin Meng | ab841b6 | 2015-11-24 13:31:17 -0700 | [diff] [blame] | 80 | u64 count; |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 81 | int ret; |
| 82 | |
Simon Glass | 32f6c17 | 2016-02-24 09:14:49 -0700 | [diff] [blame] | 83 | if (!gd->timer) { |
| 84 | #ifdef CONFIG_TIMER_EARLY |
| 85 | return timer_early_get_count(); |
| 86 | #else |
| 87 | int ret; |
| 88 | |
| 89 | ret = dm_timer_init(); |
| 90 | if (ret) |
| 91 | return ret; |
| 92 | #endif |
| 93 | } |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 94 | |
| 95 | ret = timer_get_count(gd->timer, &count); |
| 96 | if (ret) |
| 97 | return ret; |
| 98 | |
| 99 | return count; |
| 100 | } |
Bin Meng | ab841b6 | 2015-11-24 13:31:17 -0700 | [diff] [blame] | 101 | |
| 102 | #else /* !CONFIG_TIMER */ |
Thomas Chou | fb798b1 | 2015-10-09 13:46:34 +0800 | [diff] [blame] | 103 | |
Simon Glass | 0e10316 | 2014-10-15 04:38:33 -0600 | [diff] [blame] | 104 | uint64_t __weak notrace get_ticks(void) |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 105 | { |
| 106 | unsigned long now = timer_read_counter(); |
| 107 | |
| 108 | /* increment tbu if tbl has rolled over */ |
| 109 | if (now < gd->timebase_l) |
| 110 | gd->timebase_h++; |
| 111 | gd->timebase_l = now; |
Simon Glass | 0e10316 | 2014-10-15 04:38:33 -0600 | [diff] [blame] | 112 | return ((uint64_t)gd->timebase_h << 32) | gd->timebase_l; |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 113 | } |
| 114 | |
Bin Meng | ab841b6 | 2015-11-24 13:31:17 -0700 | [diff] [blame] | 115 | #endif /* CONFIG_TIMER */ |
| 116 | |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 117 | /* Returns time in milliseconds */ |
Simon Glass | 0e10316 | 2014-10-15 04:38:33 -0600 | [diff] [blame] | 118 | static uint64_t notrace tick_to_time(uint64_t tick) |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 119 | { |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 120 | ulong div = get_tbclk(); |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 121 | |
| 122 | tick *= CONFIG_SYS_HZ; |
| 123 | do_div(tick, div); |
| 124 | return tick; |
| 125 | } |
| 126 | |
Darwin Rambo | f283e4f | 2013-12-19 15:06:12 -0800 | [diff] [blame] | 127 | int __weak timer_init(void) |
| 128 | { |
| 129 | return 0; |
| 130 | } |
| 131 | |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 132 | /* Returns time in milliseconds */ |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 133 | ulong __weak get_timer(ulong base) |
| 134 | { |
| 135 | return tick_to_time(get_ticks()) - base; |
| 136 | } |
| 137 | |
| 138 | unsigned long __weak notrace timer_get_us(void) |
| 139 | { |
| 140 | return tick_to_time(get_ticks() * 1000); |
| 141 | } |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 142 | |
Simon Glass | 0e10316 | 2014-10-15 04:38:33 -0600 | [diff] [blame] | 143 | static uint64_t usec_to_tick(unsigned long usec) |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 144 | { |
Simon Glass | 0e10316 | 2014-10-15 04:38:33 -0600 | [diff] [blame] | 145 | uint64_t tick = usec; |
Stephen Warren | ff81b48 | 2013-12-05 12:08:09 -0700 | [diff] [blame] | 146 | tick *= get_tbclk(); |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 147 | do_div(tick, 1000000); |
| 148 | return tick; |
| 149 | } |
| 150 | |
| 151 | void __weak __udelay(unsigned long usec) |
| 152 | { |
Simon Glass | 0e10316 | 2014-10-15 04:38:33 -0600 | [diff] [blame] | 153 | uint64_t tmp; |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 154 | |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 155 | tmp = get_ticks() + usec_to_tick(usec); /* get current timestamp */ |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 156 | |
Pavel Machek | cb21e37 | 2014-07-13 13:14:27 +0200 | [diff] [blame] | 157 | while (get_ticks() < tmp+1) /* loop till event */ |
Rob Herring | 5715694 | 2013-10-04 10:22:41 -0500 | [diff] [blame] | 158 | /*NOP*/; |
| 159 | } |
| 160 | |
Ingo van Lil | f0f778a | 2009-11-24 14:09:21 +0100 | [diff] [blame] | 161 | /* ------------------------------------------------------------------------- */ |
| 162 | |
| 163 | void udelay(unsigned long usec) |
| 164 | { |
| 165 | ulong kv; |
| 166 | |
| 167 | do { |
| 168 | WATCHDOG_RESET(); |
| 169 | kv = usec > CONFIG_WD_PERIOD ? CONFIG_WD_PERIOD : usec; |
| 170 | __udelay (kv); |
| 171 | usec -= kv; |
| 172 | } while(usec); |
| 173 | } |