diff options
| author | Tom Rini <trini@konsulko.com> | 2022-06-17 09:35:28 -0400 |
|---|---|---|
| committer | Tom Rini <trini@konsulko.com> | 2022-06-17 09:35:28 -0400 |
| commit | f0843e0c0ab2c05da81b89b2c0ce7955510aff8a (patch) | |
| tree | c23bf4390e489d06061ad840b83083973a76d21e /arch/arm/mach-socfpga/timer_s10.c | |
| parent | ee4b80a6e276c433f1c59669b7fec47d6146ceaf (diff) | |
| parent | 32e0379143b433e29d76404f5f4c279067e48853 (diff) | |
Merge commit '32e0379143b433e29d76404f5f4c279067e48853' of https://github.com/tienfong/uboot_mainline
Diffstat (limited to 'arch/arm/mach-socfpga/timer_s10.c')
| -rw-r--r-- | arch/arm/mach-socfpga/timer_s10.c | 34 |
1 files changed, 33 insertions, 1 deletions
diff --git a/arch/arm/mach-socfpga/timer_s10.c b/arch/arm/mach-socfpga/timer_s10.c index 7d5598e1a3a..84b13ce9d3a 100644 --- a/arch/arm/mach-socfpga/timer_s10.c +++ b/arch/arm/mach-socfpga/timer_s10.c @@ -1,11 +1,12 @@ // SPDX-License-Identifier: GPL-2.0 /* - * Copyright (C) 2017-2018 Intel Corporation <www.intel.com> + * Copyright (C) 2017-2022 Intel Corporation <www.intel.com> * */ #include <common.h> #include <init.h> +#include <div64.h> #include <asm/io.h> #include <asm/arch/timer.h> @@ -26,3 +27,34 @@ int timer_init(void) #endif return 0; } + +__always_inline u64 __get_time_stamp(void) +{ + u64 cntpct; + + isb(); + asm volatile("mrs %0, cntpct_el0" : "=r" (cntpct)); + + return cntpct; +} + +__always_inline uint64_t __usec_to_tick(unsigned long usec) +{ + u64 tick = usec; + u64 cntfrq; + + asm volatile("mrs %0, cntfrq_el0" : "=r" (cntfrq)); + tick *= cntfrq; + do_div(tick, 1000000); + + return tick; +} + +__always_inline void __udelay(unsigned long usec) +{ + /* get current timestamp */ + u64 tmp = __get_time_stamp() + __usec_to_tick(usec); + + while (__get_time_stamp() < tmp + 1) /* loop till event */ + ; +}
\ No newline at end of file |