1 /* SPDX-License-Identifier: GPL-2.0 */
2 #ifndef ASM_VDSO_GETTIMEOFDAY_H
3 #define ASM_VDSO_GETTIMEOFDAY_H
4
5 #define VDSO_HAS_TIME 1
6
7 #define VDSO_HAS_CLOCK_GETRES 1
8
9 #include <asm/timex.h>
10 #include <asm/unistd.h>
11 #include <asm/vdso.h>
12 #include <linux/compiler.h>
13
14 #define vdso_calc_delta __arch_vdso_calc_delta
__arch_vdso_calc_delta(u64 cycles,u64 last,u64 mask,u32 mult)15 static __always_inline u64 __arch_vdso_calc_delta(u64 cycles, u64 last, u64 mask, u32 mult)
16 {
17 return (cycles - last) * mult;
18 }
19
__arch_get_vdso_data(void)20 static __always_inline const struct vdso_data *__arch_get_vdso_data(void)
21 {
22 return _vdso_data;
23 }
24
__arch_get_hw_counter(s32 clock_mode,const struct vdso_data * vd)25 static inline u64 __arch_get_hw_counter(s32 clock_mode, const struct vdso_data *vd)
26 {
27 const struct vdso_data *vdso = __arch_get_vdso_data();
28 u64 adj, now;
29
30 now = get_tod_clock();
31 adj = vdso->arch_data.tod_steering_end - now;
32 if (unlikely((s64) adj > 0))
33 now += (vdso->arch_data.tod_steering_delta < 0) ? (adj >> 15) : -(adj >> 15);
34 return now;
35 }
36
37 static __always_inline
clock_gettime_fallback(clockid_t clkid,struct __kernel_timespec * ts)38 long clock_gettime_fallback(clockid_t clkid, struct __kernel_timespec *ts)
39 {
40 register unsigned long r1 __asm__("r1") = __NR_clock_gettime;
41 register unsigned long r2 __asm__("r2") = (unsigned long)clkid;
42 register void *r3 __asm__("r3") = ts;
43
44 asm ("svc 0\n" : "+d" (r2) : "d" (r1), "d" (r3) : "cc", "memory");
45 return r2;
46 }
47
48 static __always_inline
gettimeofday_fallback(register struct __kernel_old_timeval * tv,register struct timezone * tz)49 long gettimeofday_fallback(register struct __kernel_old_timeval *tv,
50 register struct timezone *tz)
51 {
52 register unsigned long r1 __asm__("r1") = __NR_gettimeofday;
53 register unsigned long r2 __asm__("r2") = (unsigned long)tv;
54 register void *r3 __asm__("r3") = tz;
55
56 asm ("svc 0\n" : "+d" (r2) : "d" (r1), "d" (r3) : "cc", "memory");
57 return r2;
58 }
59
60 static __always_inline
clock_getres_fallback(clockid_t clkid,struct __kernel_timespec * ts)61 long clock_getres_fallback(clockid_t clkid, struct __kernel_timespec *ts)
62 {
63 register unsigned long r1 __asm__("r1") = __NR_clock_getres;
64 register unsigned long r2 __asm__("r2") = (unsigned long)clkid;
65 register void *r3 __asm__("r3") = ts;
66
67 asm ("svc 0\n" : "+d" (r2) : "d" (r1), "d" (r3) : "cc", "memory");
68 return r2;
69 }
70
71 #endif
72