lib/time.c

   1 /*
   2  * (C) Copyright 2000-2009
   3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 #include <common.h>
   9 #include <dm.h>
  10 #include <errno.h>
  11 #include <timer.h>
  12 #include <watchdog.h>
  13 #include <div64.h>
  14 #include <asm/io.h>
  15
  16 #ifndef CONFIG_WD_PERIOD
  17 # define CONFIG_WD_PERIOD       (10 * 1000 * 1000)      /* 10 seconds default */
  18 #endif
  19
  20 DECLARE_GLOBAL_DATA_PTR;
  21
  22 #ifdef CONFIG_SYS_TIMER_RATE
  23 /* Returns tick rate in ticks per second */
  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
  40 extern unsigned long __weak timer_read_counter(void);
  41 #endif
  42
  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
  89 uint64_t __weak notrace get_ticks(void)
  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;
  97         return ((uint64_t)gd->timebase_h << 32) | gd->timebase_l;
  98 }
  99
 100 /* Returns time in milliseconds */
 101 static uint64_t notrace tick_to_time(uint64_t tick)
 102 {
 103         ulong div = get_tbclk();
 104
 105         tick *= CONFIG_SYS_HZ;
 106         do_div(tick, div);
 107         return tick;
 108 }
 109
 110 int __weak timer_init(void)
 111 {
 112         return 0;
 113 }
 114
 115 /* Returns time in milliseconds */
 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 }
 125
 126 static uint64_t usec_to_tick(unsigned long usec)
 127 {
 128         uint64_t tick = usec;
 129         tick *= get_tbclk();
 130         do_div(tick, 1000000);
 131         return tick;
 132 }
 133
 134 void __weak __udelay(unsigned long usec)
 135 {
 136         uint64_t tmp;
 137
 138         tmp = get_ticks() + usec_to_tick(usec); /* get current timestamp */
 139
 140         while (get_ticks() < tmp+1)     /* loop till event */
 141                  /*NOP*/;
 142 }
 143
 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 }
 157
 158 void mdelay(unsigned long msec)
 159 {
 160         while (msec--)
 161                 udelay(1000);
 162 }