178acc472SPeter Tyser /* 278acc472SPeter Tyser * (C) Copyright 2000-2009 378acc472SPeter Tyser * Wolfgang Denk, DENX Software Engineering, wd@denx.de. 478acc472SPeter Tyser * 51a459660SWolfgang Denk * SPDX-License-Identifier: GPL-2.0+ 678acc472SPeter Tyser */ 778acc472SPeter Tyser 878acc472SPeter Tyser #include <common.h> 9*c8a7ba9eSThomas Chou #include <dm.h> 10*c8a7ba9eSThomas Chou #include <errno.h> 11*c8a7ba9eSThomas Chou #include <timer.h> 1278acc472SPeter Tyser #include <watchdog.h> 138dfafddeSRob Herring #include <div64.h> 148dfafddeSRob Herring #include <asm/io.h> 1578acc472SPeter Tyser 1678acc472SPeter Tyser #ifndef CONFIG_WD_PERIOD 1778acc472SPeter Tyser # define CONFIG_WD_PERIOD (10 * 1000 * 1000) /* 10 seconds default */ 1878acc472SPeter Tyser #endif 1978acc472SPeter Tyser 208dfafddeSRob Herring DECLARE_GLOBAL_DATA_PTR; 218dfafddeSRob Herring 228dfafddeSRob Herring #ifdef CONFIG_SYS_TIMER_RATE 23fccacd3bSPavel Machek /* Returns tick rate in ticks per second */ 248dfafddeSRob Herring ulong notrace get_tbclk(void) 258dfafddeSRob Herring { 268dfafddeSRob Herring return CONFIG_SYS_TIMER_RATE; 278dfafddeSRob Herring } 288dfafddeSRob Herring #endif 298dfafddeSRob Herring 308dfafddeSRob Herring #ifdef CONFIG_SYS_TIMER_COUNTER 318dfafddeSRob Herring unsigned long notrace timer_read_counter(void) 328dfafddeSRob Herring { 338dfafddeSRob Herring #ifdef CONFIG_SYS_TIMER_COUNTS_DOWN 348dfafddeSRob Herring return ~readl(CONFIG_SYS_TIMER_COUNTER); 358dfafddeSRob Herring #else 368dfafddeSRob Herring return readl(CONFIG_SYS_TIMER_COUNTER); 378dfafddeSRob Herring #endif 388dfafddeSRob Herring } 398dfafddeSRob Herring #else 4065ba7addSRob Herring extern unsigned long __weak timer_read_counter(void); 418dfafddeSRob Herring #endif 428dfafddeSRob Herring 43*c8a7ba9eSThomas Chou #ifdef CONFIG_TIMER 44*c8a7ba9eSThomas Chou static int notrace dm_timer_init(void) 45*c8a7ba9eSThomas Chou { 46*c8a7ba9eSThomas Chou struct udevice *dev; 47*c8a7ba9eSThomas Chou int ret; 48*c8a7ba9eSThomas Chou 49*c8a7ba9eSThomas Chou if (!gd->timer) { 50*c8a7ba9eSThomas Chou ret = uclass_first_device(UCLASS_TIMER, &dev); 51*c8a7ba9eSThomas Chou if (ret) 52*c8a7ba9eSThomas Chou return ret; 53*c8a7ba9eSThomas Chou if (!dev) 54*c8a7ba9eSThomas Chou return -ENODEV; 55*c8a7ba9eSThomas Chou gd->timer = dev; 56*c8a7ba9eSThomas Chou } 57*c8a7ba9eSThomas Chou 58*c8a7ba9eSThomas Chou return 0; 59*c8a7ba9eSThomas Chou } 60*c8a7ba9eSThomas Chou 61*c8a7ba9eSThomas Chou ulong notrace get_tbclk(void) 62*c8a7ba9eSThomas Chou { 63*c8a7ba9eSThomas Chou int ret; 64*c8a7ba9eSThomas Chou 65*c8a7ba9eSThomas Chou ret = dm_timer_init(); 66*c8a7ba9eSThomas Chou if (ret) 67*c8a7ba9eSThomas Chou return ret; 68*c8a7ba9eSThomas Chou 69*c8a7ba9eSThomas Chou return timer_get_rate(gd->timer); 70*c8a7ba9eSThomas Chou } 71*c8a7ba9eSThomas Chou 72*c8a7ba9eSThomas Chou unsigned long notrace timer_read_counter(void) 73*c8a7ba9eSThomas Chou { 74*c8a7ba9eSThomas Chou unsigned long count; 75*c8a7ba9eSThomas Chou int ret; 76*c8a7ba9eSThomas Chou 77*c8a7ba9eSThomas Chou ret = dm_timer_init(); 78*c8a7ba9eSThomas Chou if (ret) 79*c8a7ba9eSThomas Chou return ret; 80*c8a7ba9eSThomas Chou 81*c8a7ba9eSThomas Chou ret = timer_get_count(gd->timer, &count); 82*c8a7ba9eSThomas Chou if (ret) 83*c8a7ba9eSThomas Chou return ret; 84*c8a7ba9eSThomas Chou 85*c8a7ba9eSThomas Chou return count; 86*c8a7ba9eSThomas Chou } 87*c8a7ba9eSThomas Chou #endif /* CONFIG_TIMER */ 88*c8a7ba9eSThomas Chou 8919ea4678SSimon Glass uint64_t __weak notrace get_ticks(void) 908dfafddeSRob Herring { 918dfafddeSRob Herring unsigned long now = timer_read_counter(); 928dfafddeSRob Herring 938dfafddeSRob Herring /* increment tbu if tbl has rolled over */ 948dfafddeSRob Herring if (now < gd->timebase_l) 958dfafddeSRob Herring gd->timebase_h++; 968dfafddeSRob Herring gd->timebase_l = now; 9719ea4678SSimon Glass return ((uint64_t)gd->timebase_h << 32) | gd->timebase_l; 988dfafddeSRob Herring } 998dfafddeSRob Herring 100fccacd3bSPavel Machek /* Returns time in milliseconds */ 10119ea4678SSimon Glass static uint64_t notrace tick_to_time(uint64_t tick) 1028dfafddeSRob Herring { 103fccacd3bSPavel Machek ulong div = get_tbclk(); 1048dfafddeSRob Herring 1058dfafddeSRob Herring tick *= CONFIG_SYS_HZ; 1068dfafddeSRob Herring do_div(tick, div); 1078dfafddeSRob Herring return tick; 1088dfafddeSRob Herring } 1098dfafddeSRob Herring 110de351d6bSDarwin Rambo int __weak timer_init(void) 111de351d6bSDarwin Rambo { 112de351d6bSDarwin Rambo return 0; 113de351d6bSDarwin Rambo } 114de351d6bSDarwin Rambo 115fccacd3bSPavel Machek /* Returns time in milliseconds */ 1168dfafddeSRob Herring ulong __weak get_timer(ulong base) 1178dfafddeSRob Herring { 1188dfafddeSRob Herring return tick_to_time(get_ticks()) - base; 1198dfafddeSRob Herring } 1208dfafddeSRob Herring 1218dfafddeSRob Herring unsigned long __weak notrace timer_get_us(void) 1228dfafddeSRob Herring { 1238dfafddeSRob Herring return tick_to_time(get_ticks() * 1000); 1248dfafddeSRob Herring } 125fccacd3bSPavel Machek 12619ea4678SSimon Glass static uint64_t usec_to_tick(unsigned long usec) 1278dfafddeSRob Herring { 12819ea4678SSimon Glass uint64_t tick = usec; 1292cd1b572SStephen Warren tick *= get_tbclk(); 1308dfafddeSRob Herring do_div(tick, 1000000); 1318dfafddeSRob Herring return tick; 1328dfafddeSRob Herring } 1338dfafddeSRob Herring 1348dfafddeSRob Herring void __weak __udelay(unsigned long usec) 1358dfafddeSRob Herring { 13619ea4678SSimon Glass uint64_t tmp; 1378dfafddeSRob Herring 138fccacd3bSPavel Machek tmp = get_ticks() + usec_to_tick(usec); /* get current timestamp */ 1398dfafddeSRob Herring 140fccacd3bSPavel Machek while (get_ticks() < tmp+1) /* loop till event */ 1418dfafddeSRob Herring /*NOP*/; 1428dfafddeSRob Herring } 1438dfafddeSRob Herring 14478acc472SPeter Tyser /* ------------------------------------------------------------------------- */ 14578acc472SPeter Tyser 14678acc472SPeter Tyser void udelay(unsigned long usec) 14778acc472SPeter Tyser { 14878acc472SPeter Tyser ulong kv; 14978acc472SPeter Tyser 15078acc472SPeter Tyser do { 15178acc472SPeter Tyser WATCHDOG_RESET(); 15278acc472SPeter Tyser kv = usec > CONFIG_WD_PERIOD ? CONFIG_WD_PERIOD : usec; 15378acc472SPeter Tyser __udelay (kv); 15478acc472SPeter Tyser usec -= kv; 15578acc472SPeter Tyser } while(usec); 15678acc472SPeter Tyser } 157c4c9fbebSAnatolij Gustschin 158c4c9fbebSAnatolij Gustschin void mdelay(unsigned long msec) 159c4c9fbebSAnatolij Gustschin { 160c4c9fbebSAnatolij Gustschin while (msec--) 161c4c9fbebSAnatolij Gustschin udelay(1000); 162c4c9fbebSAnatolij Gustschin } 163