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> 9c8a7ba9eSThomas Chou #include <dm.h> 10c8a7ba9eSThomas Chou #include <errno.h> 11c8a7ba9eSThomas 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 43c8a7ba9eSThomas Chou #ifdef CONFIG_TIMER 44c8a7ba9eSThomas Chou static int notrace dm_timer_init(void) 45c8a7ba9eSThomas Chou { 46c8a7ba9eSThomas Chou struct udevice *dev; 47c8a7ba9eSThomas Chou int ret; 48c8a7ba9eSThomas Chou 49c8a7ba9eSThomas Chou if (!gd->timer) { 50c8a7ba9eSThomas Chou ret = uclass_first_device(UCLASS_TIMER, &dev); 51c8a7ba9eSThomas Chou if (ret) 52c8a7ba9eSThomas Chou return ret; 53c8a7ba9eSThomas Chou if (!dev) 54c8a7ba9eSThomas Chou return -ENODEV; 55c8a7ba9eSThomas Chou gd->timer = dev; 56c8a7ba9eSThomas Chou } 57c8a7ba9eSThomas Chou 58c8a7ba9eSThomas Chou return 0; 59c8a7ba9eSThomas Chou } 60c8a7ba9eSThomas Chou 61c8a7ba9eSThomas Chou ulong notrace get_tbclk(void) 62c8a7ba9eSThomas Chou { 63c8a7ba9eSThomas Chou int ret; 64c8a7ba9eSThomas Chou 65c8a7ba9eSThomas Chou ret = dm_timer_init(); 66c8a7ba9eSThomas Chou if (ret) 67c8a7ba9eSThomas Chou return ret; 68c8a7ba9eSThomas Chou 69c8a7ba9eSThomas Chou return timer_get_rate(gd->timer); 70c8a7ba9eSThomas Chou } 71c8a7ba9eSThomas Chou 72*9ca07ebbSBin Meng uint64_t notrace get_ticks(void) 73c8a7ba9eSThomas Chou { 74*9ca07ebbSBin Meng u64 count; 75c8a7ba9eSThomas Chou int ret; 76c8a7ba9eSThomas Chou 77c8a7ba9eSThomas Chou ret = dm_timer_init(); 78c8a7ba9eSThomas Chou if (ret) 79c8a7ba9eSThomas Chou return ret; 80c8a7ba9eSThomas Chou 81c8a7ba9eSThomas Chou ret = timer_get_count(gd->timer, &count); 82c8a7ba9eSThomas Chou if (ret) 83c8a7ba9eSThomas Chou return ret; 84c8a7ba9eSThomas Chou 85c8a7ba9eSThomas Chou return count; 86c8a7ba9eSThomas Chou } 87*9ca07ebbSBin Meng 88*9ca07ebbSBin Meng #else /* !CONFIG_TIMER */ 89c8a7ba9eSThomas Chou 9019ea4678SSimon Glass uint64_t __weak notrace get_ticks(void) 918dfafddeSRob Herring { 928dfafddeSRob Herring unsigned long now = timer_read_counter(); 938dfafddeSRob Herring 948dfafddeSRob Herring /* increment tbu if tbl has rolled over */ 958dfafddeSRob Herring if (now < gd->timebase_l) 968dfafddeSRob Herring gd->timebase_h++; 978dfafddeSRob Herring gd->timebase_l = now; 9819ea4678SSimon Glass return ((uint64_t)gd->timebase_h << 32) | gd->timebase_l; 998dfafddeSRob Herring } 1008dfafddeSRob Herring 101*9ca07ebbSBin Meng #endif /* CONFIG_TIMER */ 102*9ca07ebbSBin Meng 103fccacd3bSPavel Machek /* Returns time in milliseconds */ 10419ea4678SSimon Glass static uint64_t notrace tick_to_time(uint64_t tick) 1058dfafddeSRob Herring { 106fccacd3bSPavel Machek ulong div = get_tbclk(); 1078dfafddeSRob Herring 1088dfafddeSRob Herring tick *= CONFIG_SYS_HZ; 1098dfafddeSRob Herring do_div(tick, div); 1108dfafddeSRob Herring return tick; 1118dfafddeSRob Herring } 1128dfafddeSRob Herring 113de351d6bSDarwin Rambo int __weak timer_init(void) 114de351d6bSDarwin Rambo { 115de351d6bSDarwin Rambo return 0; 116de351d6bSDarwin Rambo } 117de351d6bSDarwin Rambo 118fccacd3bSPavel Machek /* Returns time in milliseconds */ 1198dfafddeSRob Herring ulong __weak get_timer(ulong base) 1208dfafddeSRob Herring { 1218dfafddeSRob Herring return tick_to_time(get_ticks()) - base; 1228dfafddeSRob Herring } 1238dfafddeSRob Herring 1248dfafddeSRob Herring unsigned long __weak notrace timer_get_us(void) 1258dfafddeSRob Herring { 1268dfafddeSRob Herring return tick_to_time(get_ticks() * 1000); 1278dfafddeSRob Herring } 128fccacd3bSPavel Machek 12919ea4678SSimon Glass static uint64_t usec_to_tick(unsigned long usec) 1308dfafddeSRob Herring { 13119ea4678SSimon Glass uint64_t tick = usec; 1322cd1b572SStephen Warren tick *= get_tbclk(); 1338dfafddeSRob Herring do_div(tick, 1000000); 1348dfafddeSRob Herring return tick; 1358dfafddeSRob Herring } 1368dfafddeSRob Herring 1378dfafddeSRob Herring void __weak __udelay(unsigned long usec) 1388dfafddeSRob Herring { 13919ea4678SSimon Glass uint64_t tmp; 1408dfafddeSRob Herring 141fccacd3bSPavel Machek tmp = get_ticks() + usec_to_tick(usec); /* get current timestamp */ 1428dfafddeSRob Herring 143fccacd3bSPavel Machek while (get_ticks() < tmp+1) /* loop till event */ 1448dfafddeSRob Herring /*NOP*/; 1458dfafddeSRob Herring } 1468dfafddeSRob Herring 14778acc472SPeter Tyser /* ------------------------------------------------------------------------- */ 14878acc472SPeter Tyser 14978acc472SPeter Tyser void udelay(unsigned long usec) 15078acc472SPeter Tyser { 15178acc472SPeter Tyser ulong kv; 15278acc472SPeter Tyser 15378acc472SPeter Tyser do { 15478acc472SPeter Tyser WATCHDOG_RESET(); 15578acc472SPeter Tyser kv = usec > CONFIG_WD_PERIOD ? CONFIG_WD_PERIOD : usec; 15678acc472SPeter Tyser __udelay (kv); 15778acc472SPeter Tyser usec -= kv; 15878acc472SPeter Tyser } while(usec); 15978acc472SPeter Tyser } 160c4c9fbebSAnatolij Gustschin 161c4c9fbebSAnatolij Gustschin void mdelay(unsigned long msec) 162c4c9fbebSAnatolij Gustschin { 163c4c9fbebSAnatolij Gustschin while (msec--) 164c4c9fbebSAnatolij Gustschin udelay(1000); 165c4c9fbebSAnatolij Gustschin } 166