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 <watchdog.h>
  10 #include <div64.h>
  11 #include <asm/io.h>
  12
  13 #if CONFIG_SYS_HZ != 1000
  14 #warning "CONFIG_SYS_HZ must be 1000 and should not be defined by platforms"
  15 #endif
  16
  17 #ifndef CONFIG_WD_PERIOD
  18 # define CONFIG_WD_PERIOD       (10 * 1000 * 1000)      /* 10 seconds default*/
  19 #endif
  20
  21 DECLARE_GLOBAL_DATA_PTR;
  22
  23 #ifdef CONFIG_SYS_TIMER_RATE
  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 unsigned 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
  54 static unsigned long long notrace tick_to_time(uint64_t tick)
  55 {
  56         unsigned int div = get_tbclk();
  57
  58         tick *= CONFIG_SYS_HZ;
  59         do_div(tick, div);
  60         return tick;
  61 }
  62
  63 int __weak timer_init(void)
  64 {
  65         return 0;
  66 }
  67
  68 ulong __weak get_timer(ulong base)
  69 {
  70         return tick_to_time(get_ticks()) - base;
  71 }
  72
  73 unsigned long __weak notrace timer_get_us(void)
  74 {
  75         return tick_to_time(get_ticks() * 1000);
  76 }
  77 static unsigned long long usec_to_tick(unsigned long usec)
  78 {
  79         uint64_t tick = usec;
  80         tick *= get_tbclk();
  81         do_div(tick, 1000000);
  82         return tick;
  83 }
  84
  85 void __weak __udelay(unsigned long usec)
  86 {
  87         unsigned long long tmp;
  88         ulong tmo;
  89
  90         tmo = usec_to_tick(usec);
  91         tmp = get_ticks() + tmo;        /* get current timestamp */
  92
  93         while (get_ticks() < tmp)       /* loop till event */
  94                  /*NOP*/;
  95 }
  96
  97 /* ------------------------------------------------------------------------- */
  98
  99 void udelay(unsigned long usec)
 100 {
 101         ulong kv;
 102
 103         do {
 104                 WATCHDOG_RESET();
 105                 kv = usec > CONFIG_WD_PERIOD ? CONFIG_WD_PERIOD : usec;
 106                 __udelay (kv);
 107                 usec -= kv;
 108         } while(usec);
 109 }
 110
 111 void mdelay(unsigned long msec)
 112 {
 113         while (msec--)
 114                 udelay(1000);
 115 }