blob: 09bb05a24d331b0f023a149024278952e0e89054 [file] [log] [blame]
Ingo van Lil3eb90ba2009-11-24 14:09:21 +01001/*
2 * (C) Copyright 2000-2009
3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4 *
Wolfgang Denk1a459662013-07-08 09:37:19 +02005 * SPDX-License-Identifier: GPL-2.0+
Ingo van Lil3eb90ba2009-11-24 14:09:21 +01006 */
7
8#include <common.h>
9#include <watchdog.h>
Rob Herring8dfafdd2013-10-04 10:22:41 -050010#include <div64.h>
11#include <asm/io.h>
Ingo van Lil3eb90ba2009-11-24 14:09:21 +010012
Rob Herring2108f4c2013-10-04 08:40:03 -050013#if CONFIG_SYS_HZ != 1000
14#warning "CONFIG_SYS_HZ must be 1000 and should not be defined by platforms"
15#endif
16
Ingo van Lil3eb90ba2009-11-24 14:09:21 +010017#ifndef CONFIG_WD_PERIOD
18# define CONFIG_WD_PERIOD (10 * 1000 * 1000) /* 10 seconds default*/
19#endif
20
Rob Herring8dfafdd2013-10-04 10:22:41 -050021DECLARE_GLOBAL_DATA_PTR;
22
23#ifdef CONFIG_SYS_TIMER_RATE
24ulong notrace get_tbclk(void)
25{
26 return CONFIG_SYS_TIMER_RATE;
27}
28#endif
29
30#ifdef CONFIG_SYS_TIMER_COUNTER
31unsigned 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
Rob Herring65ba7ad2013-11-08 08:40:43 -060040extern unsigned long __weak timer_read_counter(void);
Rob Herring8dfafdd2013-10-04 10:22:41 -050041#endif
42
43unsigned long long __weak notrace get_ticks(void)
44{
45 unsigned long now = timer_read_counter();
46
47 /* increment tbu if tbl has rolled over */
48 if (now < gd->timebase_l)
49 gd->timebase_h++;
50 gd->timebase_l = now;
51 return ((unsigned long long)gd->timebase_h << 32) | gd->timebase_l;
52}
53
Daniel Schwierzeckd770f392013-11-09 00:30:14 +010054static unsigned long long notrace tick_to_time(uint64_t tick)
Rob Herring8dfafdd2013-10-04 10:22:41 -050055{
56 unsigned int div = get_tbclk();
57
58 tick *= CONFIG_SYS_HZ;
59 do_div(tick, div);
60 return tick;
61}
62
63ulong __weak get_timer(ulong base)
64{
65 return tick_to_time(get_ticks()) - base;
66}
67
68unsigned long __weak notrace timer_get_us(void)
69{
70 return tick_to_time(get_ticks() * 1000);
71}
72static unsigned long long usec_to_tick(unsigned long usec)
73{
Daniel Schwierzeckd770f392013-11-09 00:30:14 +010074 uint64_t tick = usec * get_tbclk();
Rob Herring8dfafdd2013-10-04 10:22:41 -050075 usec *= get_tbclk();
76 do_div(tick, 1000000);
77 return tick;
78}
79
80void __weak __udelay(unsigned long usec)
81{
82 unsigned long long tmp;
83 ulong tmo;
84
85 tmo = usec_to_tick(usec);
86 tmp = get_ticks() + tmo; /* get current timestamp */
87
88 while (get_ticks() < tmp) /* loop till event */
89 /*NOP*/;
90}
91
Ingo van Lil3eb90ba2009-11-24 14:09:21 +010092/* ------------------------------------------------------------------------- */
93
94void udelay(unsigned long usec)
95{
96 ulong kv;
97
98 do {
99 WATCHDOG_RESET();
100 kv = usec > CONFIG_WD_PERIOD ? CONFIG_WD_PERIOD : usec;
101 __udelay (kv);
102 usec -= kv;
103 } while(usec);
104}
Anatolij Gustschinc4c9fbe2011-10-12 02:31:39 +0000105
106void mdelay(unsigned long msec)
107{
108 while (msec--)
109 udelay(1000);
110}